1 files changed, 138 insertions, 0 deletions
diff --git a/megalogger/datalogger.h b/megalogger/datalogger.h
new file mode 100644
index 0000000..c711709
--- /dev/null
+++ b/megalogger/datalogger.h
@@ -0,0 +1,138 @@
+// configurations
+#define ENABLE_DATA_OUT 1
+#define ENABLE_DATA_LOG 1
+
+typedef struct {
+    uint32_t /*DWORD*/ time;
+    uint16_t /*WORD*/ pid;
+    uint8_t /*BYTE*/ flags;
+    uint8_t /*BYTE*/ checksum;
+    float value;
+} LOG_DATA;
+
+typedef struct {
+    uint32_t /*DWORD*/ time;
+    uint16_t /*WORD*/ pid;
+    uint8_t /*BYTE*/ flags;
+    uint8_t /*BYTE*/ checksum;
+    float value[3];
+} LOG_DATA_COMM;
+
+#define PID_GPS_COORDINATES 0xF00A
+#define PID_GPS_ALTITUDE 0xF00C
+#define PID_GPS_SPEED 0xF00D
+#define PID_GPS_HEADING 0xF00E
+#define PID_GPS_SAT_COUNT 0xF00F
+#define PID_GPS_TIME 0xF010
+
+#define PID_ACC 0xF020
+#define PID_GYRO 0xF021
+
+#define FILE_NAME_FORMAT "DAT%05d.LOG"
+
+#if ENABLE_DATA_OUT
+#if defined(__AVR_ATmega2560__) || defined(__AVR_ATmega1280__)
+    SoftwareSerial mySerial(A8, A9); /* for BLE Shield on MEGA*/
+#elif defined(__AVR_ATmega644P__)
+    SoftwareSerial mySerial(9, 10); /* for Microduino */
+#else
+    SoftwareSerial mySerial(A2, A3); /* for BLE Shield on UNO*/
+#endif
+#endif
+
+class CDataLogger {
+public:
+    void initSender()
+    {
+#if ENABLE_DATA_OUT
+        mySerial.begin(9600);
+#endif
+    }
+    void logData(uint16_t pid, float value)
+    {
+        LOG_DATA_COMM ld = {dataTime, pid, 1, 0, value};
+        ld.checksum = getChecksum((char*)&ld, 12);
+#if ENABLE_DATA_OUT
+        mySerial.write((uint8_t*)&ld, 12);
+#endif
+#if ENABLE_DATA_LOG
+        sdfile.write((uint8_t*)&ld, 12);
+#endif
+        dataSize += 12;
+    }
+    void logData(uint16_t pid, float value1, float value2)
+    {
+        LOG_DATA_COMM ld = {dataTime, pid, 2, 0, {value1, value2}};
+        ld.checksum = getChecksum((char*)&ld, 16);
+#if ENABLE_DATA_OUT
+        mySerial.write((uint8_t*)&ld, 16);
+#endif
+#if ENABLE_DATA_LOG
+        sdfile.write((uint8_t*)&ld, 16);
+#endif
+        dataSize += 16;
+    }
+    void logData(uint16_t pid, float value1, float value2, float value3)
+    {
+        LOG_DATA_COMM ld = {dataTime, pid, 3, 0, {value1, value2, value3}};
+        ld.checksum = getChecksum((char*)&ld, 20);
+#if ENABLE_DATA_OUT
+        mySerial.write((uint8_t*)&ld, 20);
+#endif
+#if ENABLE_DATA_LOG
+        sdfile.write((uint8_t*)&ld, 20);
+#endif
+        dataSize += 20;
+    }
+#if ENABLE_DATA_LOG
+    bool openFile(uint16_t index)
+    {
+        char filename[13];
+        sprintf(filename, FILE_NAME_FORMAT, index);
+        sdfile = SD.open(filename, FILE_WRITE);
+        if (!sdfile) {
+            return false;
+        }
+
+        uint32_t d;
+        d = 'UDUS';
+        sdfile.write((uint8_t*)&d, 4); // id
+        d = 256;
+        sdfile.write((uint8_t*)&d, 4); // offset
+        sdfile.write((uint8_t)0x10); // VER
+        sdfile.write((uint8_t)0);
+        sdfile.write((uint8_t)0);
+        sdfile.write((uint8_t)0);
+        d = 0;
+        sdfile.write((uint8_t*)&d, 4); // date
+        sdfile.write((uint8_t*)&d, 4); // time
+        for (byte i = 0; i < 256 - 20; i++)
+            sdfile.write((uint8_t)0);
+
+        dataSize = 256;
+        return true;
+    }
+    void closeFile()
+    {
+        sdfile.close();
+    }
+    void flushFile()
+    {
+        sdfile.flush();
+    }
+#endif
+    uint32_t dataTime;
+    uint32_t dataSize;
+private:
+    static byte getChecksum(char* buffer, byte len)
+    {
+        uint8_t checksum = 0;
+        for (byte i = 0; i < len; i++) {
+          checksum ^= buffer[i];
+        }
+        return checksum;
+    }
+#if ENABLE_DATA_LOG
+    File sdfile;
+#endif
+};