diff options
Diffstat (limited to 'nanologger/nanologger.ino')
| -rw-r--r-- | nanologger/nanologger.ino | 401 |
1 files changed, 401 insertions, 0 deletions
diff --git a/nanologger/nanologger.ino b/nanologger/nanologger.ino new file mode 100644 index 0000000..48891b9 --- /dev/null +++ b/nanologger/nanologger.ino @@ -0,0 +1,401 @@ +/************************************************************************* +* Arduino GPS/OBD-II/G-Force Data Logger +* Distributed under GPL v2.0 +* Copyright (c) 2013 Stanley Huang <stanleyhuangyc@gmail.com> +* All rights reserved. +*************************************************************************/ + +#include <Arduino.h> +#include <Wire.h> +#include <OBD.h> +#include <SPI.h> +#include <SD.h> +#include <MPU6050.h> +#include "MicroLCD.h" +#include "images.h" +#include "config.h" +#if USE_SOFTSERIAL +#include <SoftwareSerial.h> +#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 byte pidTier1[]= {PID_RPM, PID_SPEED, PID_ENGINE_LOAD, PID_THROTTLE}; +static byte pidTier2[] = {PID_INTAKE_MAP, PID_MAF_FLOW, PID_TIMING_ADVANCE}; +static byte pidTier3[] = {PID_COOLANT_TEMP, PID_INTAKE_TEMP, PID_AMBIENT_TEMP, PID_FUEL_LEVEL}; + +#define TIER_NUM1 sizeof(pidTier1) +#define TIER_NUM2 sizeof(pidTier2) +#define TIER_NUM3 sizeof(pidTier3) + +class COBDLogger : public COBD, public CDataLogger +{ +public: + COBDLogger():state(0) {} + void setup() + { +#if USE_GPS + lastGPSDataTime = 0; +#endif + showStates(); + +#if USE_MPU6050 + Wire.begin(); + if (MPU6050_init() == 0) { + state |= STATE_ACC_READY; + showStates(); + } +#endif + + do { + showStates(); + } while (!init()); + + state |= STATE_OBD_READY; + + showStates(); + + uint16_t flags = FLAG_CAR | FLAG_OBD; + if (state & STATE_GPS_FOUND) flags |= FLAG_GPS; + if (state & STATE_ACC_READY) flags |= FLAG_ACC; +#if ENABLE_DATA_LOG + uint16_t index = openFile(LOG_TYPE_DEFAULT, flags); + lcd.setFont(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 + +#ifndef MEMORY_SAVING + //showECUCap(); + //delay(1000); +#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; + logOBDData(pidTier3[index3]); + index3 = (index3 + 1) % TIER_NUM3; + } else { + logOBDData(pidTier2[index2++]); + } + } + + // display distance travelled (GPS) + char buf[10]; + sprintf(buf, "%4ukm", (uint16_t)(distance / 1000)); + lcd.setFont(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.setFont(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: +#if USE_MPU6050 + void processAccelerometer() + { + accel_t_gyro_union data; + MPU6050_readout(&data); + dataTime = millis(); + // log x/y/z of accelerometer + logData(PID_ACC, data.value.x_accel, data.value.y_accel, data.value.z_accel); + //showGForce(data.value.y_accel); + // log x/y/z of gyro meter + logData(PID_GYRO, data.value.x_gyro, data.value.y_gyro, data.value.z_gyro); + } +#endif + void logOBDData(byte pid) + { + int value; + // send a query to OBD adapter for specified OBD-II pid + if (read(pid, value)) { + dataTime = millis(); + showLoggerData(pid, value); + // log data to SD card + logData(0x100 | pid, value); + } + + // if OBD response is very fast, go on processing other data for a while + } +#ifndef MEMORY_SAVING + void showECUCap() + { + char buffer[24]; + byte pidlist[] = {PID_RPM, PID_SPEED, PID_THROTTLE, PID_ENGINE_LOAD, PID_CONTROL_MODULE_VOLTAGE, PID_MAF_FLOW, PID_INTAKE_MAP, PID_FUEL_LEVEL, PID_FUEL_PRESSURE, PID_COOLANT_TEMP, PID_INTAKE_TEMP, PID_AMBIENT_TEMP, PID_TIMING_ADVANCE, PID_BAROMETRIC}; + const char* namelist[] = {"RPM", "SPEED", "THROTTLE", "ENG.LOAD", "CTRL VOLT", "MAF", "MAP", "FUEL LV.", "FUEL PRE.", "COOLANT", "INTAKE","AMBIENT", "IGNITION", "BARO"}; + byte i = 0; + lcd.clear(); + lcd.setFont(FONT_SIZE_SMALL); + for (; i < sizeof(pidlist) / sizeof(pidlist[0]) / 2; i++) { + lcd.setCursor(0, i); + sprintf(buffer, "%s:%c", namelist[i], isValidPID(pidlist[i]) ? 'Y' : 'N'); + lcd.print(buffer); + } + for (byte row = 0; i < sizeof(pidlist) / sizeof(pidlist[0]); i++, row++) { + lcd.setCursor(64, row); + sprintf(buffer, "%s:%c", namelist[i], isValidPID(pidlist[i]) ? 'Y' : 'N'); + lcd.print(buffer); + } + } +#endif + void reconnect() + { +#if ENABLE_DATA_LOG + closeFile(); +#endif + lcd.clear(); + lcd.setFont(FONT_SIZE_MEDIUM); + lcd.print("Reconnecting"); + startTime = millis(); + state &= ~(STATE_OBD_READY | STATE_ACC_READY); + state |= STATE_SLEEPING; + //digitalWrite(SD_CS_PIN, LOW); + for (int i = 0; !init(); i++) { + if (i == 10) lcd.clear(); + } + state &= ~STATE_SLEEPING; + fileIndex++; + write('\r'); + setup(); + } + byte state; + + void showTickCross(bool yes) + { + lcd.draw(yes ? tick : cross, 16, 16); + } + // screen layout related stuff + void showStates() + { + lcd.setFont(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.setFont(FONT_SIZE_XLARGE); + lcd.printInt((unsigned int)value % 10000, 4); + break; + case PID_SPEED: + if (lastSpeed != value) { + lcd.setCursor(0, 0); + lcd.setFont(FONT_SIZE_XLARGE); + lcd.printInt((unsigned int)value % 1000, 3); + lastSpeed = value; + } + break; + case PID_THROTTLE: + lcd.setCursor(24, 5); + lcd.setFont(FONT_SIZE_SMALL); + lcd.printInt(value % 100, 3); + break; + case PID_INTAKE_TEMP: + if (value < 1000) { + lcd.setCursor(102, 5); + lcd.setFont(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.setFont(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.setFont(FONT_SIZE_MEDIUM); + lcd.println("NanoLogger"); + + logger.begin(); + logger.initSender(); + +#if ENABLE_DATA_LOG + lcd.setFont(FONT_SIZE_MEDIUM); + lcd.setCursor(0, 2); + logger.checkSD(); +#else + lcd.clear(); +#endif + logger.setup(); +} + +void loop() +{ + logger.loop(); +} |