/************************************************************************* * Freematics Data Logger Class * Distributed under GPL v2.0 * Written by Stanley Huang * Visit http://freematics.com for more information *************************************************************************/ #define FORMAT_BIN 0 #define FORMAT_TEXT 1 typedef struct { uint32_t time; uint16_t pid; uint8_t flags; uint8_t checksum; float value[3]; } LOG_DATA_COMM; #define PID_GPS_LATITUDE 0xA #define PID_GPS_LONGITUDE 0xB #define PID_GPS_ALTITUDE 0xC #define PID_GPS_SPEED 0xD #define PID_GPS_HEADING 0xE #define PID_GPS_SAT_COUNT 0xF #define PID_GPS_TIME 0x10 #define PID_GPS_DATE 0x11 #define PID_ACC 0x20 #define PID_GYRO 0x21 #define PID_COMPASS 0x22 #define PID_MEMS_TEMP 0x23 #define PID_BATTERY_VOLTAGE 0x24 #define PID_DATA_SIZE 0x80 #define FILE_NAME_FORMAT "DAT%05d.CSV" #define FILE_PATH "/DATA/" #if ENABLE_DATA_OUT #if USE_SOFTSERIAL SoftwareSerial SerialRF(A2, A3); #elif defined(RF_SERIAL) #define SerialRF RF_SERIAL #else #define SerialRF Serial #endif #endif #if ENABLE_DATA_LOG static File sdfile; #endif typedef struct { uint8_t pid; char name[3]; } PID_NAME; const PID_NAME pidNames[] PROGMEM = { {PID_ACC, {'A','C','C'}}, {PID_GYRO, {'G','Y','R'}}, {PID_COMPASS, {'M','A','G'}}, {PID_GPS_LATITUDE, {'L','A','T'}}, {PID_GPS_LONGITUDE, {'L','N','G'}}, {PID_GPS_ALTITUDE, {'A','L','T'}}, {PID_GPS_SPEED, {'S','P','D'}}, {PID_GPS_HEADING, {'C','R','S'}}, {PID_GPS_SAT_COUNT, {'S','A','T'}}, {PID_GPS_TIME, {'U','T','C'}}, {PID_GPS_DATE, {'D','T','E'}}, {PID_BATTERY_VOLTAGE, {'B','A','T'}}, {PID_DATA_SIZE, {'D','A','T'}}, }; class CDataLogger { public: CDataLogger() { m_lastDataTime = 0; #if ENABLE_DATA_CACHE cacheBytes = 0; #endif } void initSender() { #if ENABLE_DATA_OUT SerialRF.begin(STREAM_BAUDRATE); #endif } byte genTimestamp(char* buf, bool absolute) { byte n; if (absolute || dataTime >= m_lastDataTime + 60000) { // absolute timestamp n = sprintf(buf, "#%lu,", dataTime); } else { // incremental timestamp n = sprintf(buf, "%u,", (unsigned int)(dataTime - m_lastDataTime)); } return n; } void record(const char* buf, byte len) { #if ENABLE_DATA_LOG #if STREAM_FORMAT == FORMAT_BIN dataSize += sdfile.write(buf, len); #else char tmp[12]; byte n = genTimestamp(tmp, dataSize == 0); dataSize += sdfile.write(tmp, n); dataSize += sdfile.write(buf, len); sdfile.println(); dataSize += 3; #endif #endif m_lastDataTime = dataTime; } void dispatch(const char* buf, byte len) { #if ENABLE_DATA_CACHE if (cacheBytes + len < MAX_CACHE_SIZE - 10) { cacheBytes += genTimestamp(cache + cacheBytes, cacheBytes == 0); memcpy(cache + cacheBytes, buf, len); cacheBytes += len; cache[cacheBytes++] = '\n'; cache[cacheBytes] = 0; } #endif #if ENABLE_DATA_OUT SerialRF.write(buf, len); SerialRF.println(); #endif } void logData(const char* buf, byte len) { #if ENABLE_DATA_OUT #if STREAM_FORMAT != FORMAT_BIN dispatch(buf, len); #endif #endif record(buf, len); } void logData(uint16_t pid) { char buf[8]; byte len = translatePIDName(pid, buf); #if ENABLE_DATA_OUT #if STREAM_FORMAT != FORMAT_BIN dispatch(buf, len); #endif #endif record(buf, len); } void logData(uint16_t pid, int16_t value) { char buf[16]; byte n = translatePIDName(pid, buf); byte len = sprintf(buf + n, "%d", value) + n; #if STREAM_FORMAT == FORMAT_BIN LOG_DATA_COMM ld = {dataTime, pid, 1, 0, value}; ld.checksum = getChecksum((char*)&ld, 12); dispatch((const char*)&ld, 12); #else dispatch(buf, len); #endif record(buf, len); } void logData(uint16_t pid, int32_t value) { char buf[20]; byte n = translatePIDName(pid, buf); byte len = sprintf(buf + n, "%ld", value) + n; #if ENABLE_DATA_OUT #if STREAM_FORMAT == FORMAT_BIN LOG_DATA_COMM ld = {dataTime, pid, 1, 0, value}; ld.checksum = getChecksum((char*)&ld, 12); dispatch((const char*)&ld, 12); #else dispatch(buf, len); #endif #endif record(buf, len); } void logData(uint16_t pid, uint32_t value) { char buf[20]; byte n = translatePIDName(pid, buf); byte len = sprintf(buf + n, "%lu", value) + n; #if STREAM_FORMAT == FORMAT_BIN LOG_DATA_COMM ld = {dataTime, pid, 1, 0, value}; ld.checksum = getChecksum((char*)&ld, 12); dispatch((const char*)&ld, 12); #else dispatch(buf, len); #endif record(buf, len); } void logData(uint16_t pid, int values[]) { char buf[24]; byte n = translatePIDName(pid, buf); byte len = sprintf(buf + n, "%d,%d,%d", values[0], values[1], values[2]) + n; #if STREAM_FORMAT == FORMAT_BIN LOG_DATA_COMM ld = {dataTime, pid, 3, 0, {values[0], values[1], values[2]}}; ld.checksum = getChecksum((char*)&ld, 20); dispatch((const char*)&ld, 20); #else dispatch(buf, len); #endif record(buf, len); } #if ENABLE_DATA_LOG uint16_t openFile(uint16_t logFlags = 0, uint32_t dateTime = 0) { uint16_t fileIndex; char filename[24] = FILE_PATH; dataSize = 0; if (SD.exists(filename)) { for (fileIndex = 1; fileIndex; fileIndex++) { sprintf(filename + sizeof(FILE_PATH) - 1, FILE_NAME_FORMAT, fileIndex); if (!SD.exists(filename)) { break; } } if (fileIndex == 0) return 0; } else { SD.mkdir(filename); fileIndex = 1; sprintf(filename + sizeof(FILE_PATH) - 1, FILE_NAME_FORMAT, 1); } sdfile = SD.open(filename, FILE_WRITE); if (!sdfile) { return 0; } m_lastDataTime = dateTime; return fileIndex; } void closeFile() { sdfile.close(); } void flushFile() { sdfile.flush(); } #endif uint32_t dataTime; uint32_t dataSize; #if ENABLE_DATA_CACHE char cache[MAX_CACHE_SIZE]; int cacheBytes; #endif private: byte getChecksum(char* buffer, byte len) { uint8_t checksum = 0; for (byte i = 0; i < len; i++) { checksum ^= buffer[i]; } return checksum; } byte translatePIDName(uint16_t pid, char* text) { #if STREAM_FORMAT == FORMAT_TEXT && USE_FRIENDLY_PID_NAME for (uint16_t n = 0; n < sizeof(pidNames) / sizeof(pidNames[0]); n++) { uint16_t id = pgm_read_byte(&pidNames[n].pid); if (pid == id) { memcpy_P(text, pidNames[n].name, 3); text[3] = ','; return 4; } } #endif return sprintf(text, "%X,", pid); } uint32_t m_lastDataTime; };