/************************************************************************* * Arduino GPS/OBD-II/G-Force Data Logger * Distributed under GPL v2.0 * Copyright (c) 2013 Stanley Huang * All rights reserved. *************************************************************************/ #include #include #include #include #include #include #include "images.h" #include "config.h" #if USE_SOFTSERIAL #include #endif #include "datalogger.h" // logger states #define STATE_SD_READY 0x1 #define STATE_OBD_READY 0x2 #define STATE_GPS_FOUND 0x4 #define STATE_GPS_READY 0x8 #define STATE_ACC_READY 0x10 #define STATE_SLEEPING 0x20 static uint32_t lastFileSize = 0; static int lastSpeed = -1; static int speed = 0; static uint32_t distance = 0; static uint16_t fileIndex = 0; static uint32_t startTime = 0; static uint8_t lastPid = 0; static int lastValue = 0; static byte pidTier1[]= {PID_RPM, PID_SPEED, PID_ENGINE_LOAD, PID_THROTTLE}; static byte pidTier2[] = {PID_INTAKE_MAP, PID_MAF_FLOW, PID_TIMING_ADVANCE}; #define TIER_NUM1 sizeof(pidTier1) #define TIER_NUM2 sizeof(pidTier2) byte pidValue[TIER_NUM1]; class COBDLogger : public COBD, public CDataLogger { public: COBDLogger():state(0) {} void setup() { showStates(); do { showStates(); } while (!init()); state |= STATE_OBD_READY; showStates(); #if ENABLE_DATA_LOG uint16_t index = openFile(); lcd.setFontSize(FONT_SIZE_SMALL); lcd.setCursor(86, 0); if (index) { lcd.write('['); lcd.setFlags(FLAG_PAD_ZERO); lcd.printInt(index, 5); lcd.setFlags(0); lcd.write(']'); } else { lcd.print("NO LOG"); } delay(100); #endif #if ENABLE_DATA_LOG // open file for logging if (!(state & STATE_SD_READY)) { if (checkSD()) { state |= STATE_SD_READY; showStates(); } } #endif initScreen(); } void loop() { static byte index = 0; static byte index2 = 0; static byte index3 = 0; // poll OBD-II PIDs logOBDData(pidTier1[index++]); if (index == TIER_NUM1) { index = 0; if (index2 == TIER_NUM2) { index2 = 0; } else { logOBDData(pidTier2[index2++]); } } // display distance travelled (GPS) char buf[10]; sprintf(buf, "%4ukm", (uint16_t)(distance / 1000)); lcd.setFontSize(FONT_SIZE_SMALL); lcd.setCursor(92, 6); lcd.print(buf); #if USE_MPU6050 if (state & STATE_ACC_READY) { processAccelerometer(); } #endif #if ENABLE_DATA_LOG // flush SD data every 1KB if (dataSize - lastFileSize >= 1024) { flushFile(); lastFileSize = dataSize; // display logged data size char buf[7]; sprintf(buf, "%4uKB", (int)(dataSize >> 10)); lcd.setFontSize(FONT_SIZE_SMALL); lcd.setCursor(92, 7); lcd.print(buf); } #endif if (errors >= 2) { reconnect(); } } #if ENABLE_DATA_LOG bool checkSD() { Sd2Card card; SdVolume volume; state &= ~STATE_SD_READY; pinMode(SS, OUTPUT); if (card.init(SPI_FULL_SPEED, SD_CS_PIN)) { const char* type; lcd.print("SD"); switch(card.type()) { case SD_CARD_TYPE_SD1: type = "1"; break; case SD_CARD_TYPE_SD2: type = "2"; break; case SD_CARD_TYPE_SDHC: type = "HC"; break; default: type = "x"; } lcd.print(type); lcd.write(' '); if (!volume.init(card)) { lcd.print("No FAT"); return false; } uint32_t volumesize = volume.blocksPerCluster(); volumesize >>= 1; // 512 bytes per block volumesize *= volume.clusterCount(); volumesize >>= 10; lcd.print((int)((volumesize + 511) / 1000)); lcd.print("GB"); } else { lcd.print("SD "); lcd.draw(cross, 16, 16); return false; } if (!SD.begin(SD_CS_PIN)) { lcd.print("Bad"); return false; } state |= STATE_SD_READY; return true; } #endif void initScreen() { initLoggerScreen(); } private: void dataIdleLoop() { if (lastPid) { showLoggerData(lastPid, lastValue); lastPid = 0; } } int logOBDData(byte pid) { int value = 0; // send a query to OBD adapter for specified OBD-II pid if (readPID(pid, value)) { dataTime = millis(); // log data to SD card logData(0x100 | pid, value); lastValue = value; lastPid = pid; } return value; } void reconnect() { #if ENABLE_DATA_LOG closeFile(); #endif lcd.clear(); lcd.setFontSize(FONT_SIZE_MEDIUM); lcd.print("Reconnecting"); startTime = millis(); state &= ~(STATE_OBD_READY | STATE_ACC_READY); state |= STATE_SLEEPING; //digitalWrite(SD_CS_PIN, LOW); for (uint16_t i = 0; ; i++) { if (i == 5) { lcd.backlight(false); lcd.clear(); } if (init()) { int value; if (readPID(PID_RPM, value) && value > 0) break; } } state &= ~STATE_SLEEPING; fileIndex++; setup(); } byte state; void showTickCross(bool yes) { lcd.draw(yes ? tick : cross, 16, 16); } // screen layout related stuff void showStates() { lcd.setFontSize(FONT_SIZE_MEDIUM); lcd.setCursor(0, 4); lcd.print("OBD "); showTickCross(state & STATE_OBD_READY); lcd.setCursor(0, 6); lcd.print("ACC "); showTickCross(state & STATE_ACC_READY); } void showLoggerData(byte pid, int value) { char buf[8]; switch (pid) { case PID_RPM: lcd.setCursor(64, 0); lcd.setFontSize(FONT_SIZE_XLARGE); lcd.printInt((unsigned int)value % 10000, 4); break; case PID_SPEED: if (lastSpeed != value) { lcd.setCursor(0, 0); lcd.setFontSize(FONT_SIZE_XLARGE); lcd.printInt((unsigned int)value % 1000, 3); lastSpeed = value; } break; case PID_THROTTLE: lcd.setCursor(24, 5); lcd.setFontSize(FONT_SIZE_SMALL); lcd.printInt(value % 100, 3); break; case PID_INTAKE_TEMP: if (value < 1000) { lcd.setCursor(102, 5); lcd.setFontSize(FONT_SIZE_SMALL); lcd.printInt(value, 3); } break; } } #if USE_MPU6050 void showGForce(int g) { byte n; /* 0~1.5g -> 0~8 */ g /= 85 * 25; lcd.setFont(FONT_SIZE_SMALL); lcd.setCursor(0, 3); if (g == 0) { lcd.clearLine(1); } else if (g < 0 && g >= -10) { for (n = 0; n < 10 + g; n++) { lcd.write(' '); } for (; n < 10; n++) { lcd.write('<'); } lcd.print(" "); } else if (g > 0 && g < 10) { lcd.print(" "); for (n = 0; n < g; n++) { lcd.write('>'); } for (; n < 10; n++) { lcd.write(' '); } } } #endif void initLoggerScreen() { lcd.clear(); lcd.backlight(true); lcd.setFontSize(FONT_SIZE_SMALL); lcd.setCursor(24, 3); lcd.print("km/h"); lcd.setCursor(110, 3); lcd.print("rpm"); lcd.setCursor(0, 5); lcd.print("THR: %"); lcd.setCursor(80, 5); lcd.print("AIR: C"); } }; static COBDLogger logger; void setup() { lcd.begin(); lcd.setFontSize(FONT_SIZE_MEDIUM); lcd.println("NanoLogger"); logger.begin(); logger.initSender(); #if ENABLE_DATA_LOG lcd.setFontSize(FONT_SIZE_MEDIUM); lcd.setCursor(0, 2); logger.checkSD(); #endif logger.setup(); } void loop() { logger.loop(); }