Moved to Freematics repository

3 files changed, 0 insertions, 881 deletions

diff --git a/telelogger/config.h b/telelogger/config.h
deleted file mode 100644
index 38d3b9c..0000000
--- a/telelogger/config.h
+++ /dev/null
@@ -1,48 +0,0 @@
-#ifndef CONFIG_H_INCLUDED
-#define CONFIG_H_INCLUDED
-
-/**************************************
-* Data logging/streaming out
-**************************************/
-#define ENABLE_DATA_OUT 1
-#define ENABLE_DATA_LOG 0
-#define USE_SOFTSERIAL 1
-
-#define STREAM_BAUDRATE 9600
-#define DELAY_AFTER_SENDING 10
-
-//this defines the format of log file
-#define LOG_FORMAT FORMAT_TEXT
-#define STREAM_FORMAT FORMAT_TEXT
-
-// change this to your own URL
-#define SERVER_URL "http://live.freematics.com/test"
-
-/**************************************
-* Accelerometer & Gyro
-**************************************/
-//#define USE_MPU6050 1
-#define USE_MPU9150 1
-#define ACC_DATA_RATIO 160
-#define GYRO_DATA_RATIO 256
-#define COMPASS_DATA_RATIO 8
-
-/**************************************
-* Timeout/interval options
-**************************************/
-#define OBD_MIN_INTERVAL 100 /* ms */
-#define ACC_DATA_INTERVAL 200 /* ms */
-#define GPS_DATA_INTERVAL 200 /* ms */
-
-/**************************************
-* Choose SD pin here
-**************************************/
-#define SD_CS_PIN 10 // SD breakout
-
-/**************************************
-* Other options
-**************************************/
-//#define DEBUG 1
-#define DEBUG_BAUDRATE 9600
-
-#endif // CONFIG_H_INCLUDED
diff --git a/telelogger/datalogger.h b/telelogger/datalogger.h
deleted file mode 100644
index fc2a329..0000000
--- a/telelogger/datalogger.h
+++ /dev/null
@@ -1,252 +0,0 @@
-#define FORMAT_BIN 0
-#define FORMAT_CSV 1
-#define FORMAT_TEXT 2
-
-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"
-
-#if ENABLE_DATA_OUT
-
-#if USE_SOFTSERIAL
-SoftwareSerial SerialRF(A2, A3);
-#else
-#define SerialRF Serial
-#endif
-
-#endif
-
-#if ENABLE_DATA_LOG
-static File sdfile;
-#endif
-
-typedef struct {
-    uint16_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','O','N'}},
-{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, {'T','M','E'}},
-{PID_GPS_DATE, {'D','T','E'}},
-{PID_BATTERY_VOLTAGE, {'B','A','T'}},
-{PID_DATA_SIZE, {'D','A','T'}},
-};
-
-static const char* idstr = "FREEMATICS_V3\r";
-
-class CDataLogger {
-public:
-    void initSender()
-    {
-#if ENABLE_DATA_OUT
-        SerialRF.begin(STREAM_BAUDRATE);
-        SerialRF.print(idstr);
-#endif
-#if ENABLE_DATA_LOG
-    m_lastDataTime = 0;
-#endif
-    }
-    void recordData(const char* buf)
-    {
-#if ENABLE_DATA_LOG
-        dataSize += sdfile.print(dataTime - m_lastDataTime);
-        sdfile.write(',');
-        dataSize += sdfile.print(buf);
-        dataSize ++;
-        m_lastDataTime = dataTime;
-#endif
-    }
-    void logData(char c)
-    {
-#if ENABLE_DATA_LOG
-        if (c >= ' ') {
-            sdfile.write(c);
-            dataSize++;
-        }
-#else
-        SerialRF.write(c);
-#endif
-    }
-    void logData(uint16_t pid, int value)
-    {
-        char buf[16];
-#if STREAM_FORMAT == FORMAT_TEXT
-        sprintf(buf + translatePIDName(pid, buf), "%d\r", value);
-#else
-        sprintf(buf, "%X,%d\r", pid, value);
-#endif
-#if ENABLE_DATA_OUT
-#if STREAM_FORMAT == FORMAT_BIN
-        LOG_DATA_COMM ld = {dataTime, pid, 1, 0, value};
-        ld.checksum = getChecksum((char*)&ld, 12);
-        SerialRF.write((uint8_t*)&ld, 12);
-#else
-        SerialRF.print(buf);
-#endif
-        delay(DELAY_AFTER_SENDING);
-#endif
-        recordData(buf);
-    }
-    void logData(uint16_t pid, int32_t value)
-    {
-        char buf[20];
-#if STREAM_FORMAT == FORMAT_TEXT
-        sprintf(buf + translatePIDName(pid, buf), "%ld\r", value);
-#else
-        sprintf(buf, "%X,%ld\r", pid, value);
-#endif
-#if ENABLE_DATA_OUT
-#if STREAM_FORMAT == FORMAT_BIN
-        LOG_DATA_COMM ld = {dataTime, pid, 1, 0, value};
-        ld.checksum = getChecksum((char*)&ld, 12);
-        SerialRF.write((uint8_t*)&ld, 12);
-#else
-        SerialRF.print(buf);
-#endif
-        delay(DELAY_AFTER_SENDING);
-#endif
-        recordData(buf);
-    }
-    void logData(uint16_t pid, uint32_t value)
-    {
-        char buf[20];
-#if STREAM_FORMAT == FORMAT_TEXT
-        sprintf(buf + translatePIDName(pid, buf), "%lu\r", value);
-#else
-        sprintf(buf, "%X,%lu\r", pid, value);
-#endif
-#if ENABLE_DATA_OUT
-#if STREAM_FORMAT == FORMAT_BIN
-        LOG_DATA_COMM ld = {dataTime, pid, 1, 0, value};
-        ld.checksum = getChecksum((char*)&ld, 12);
-        SerialRF.write((uint8_t*)&ld, 12);
-#else
-        SerialRF.print(buf);
-#endif
-#endif
-        delay(DELAY_AFTER_SENDING);
-        recordData(buf);
-    }
-    void logData(uint16_t pid, int value1, int value2, int value3)
-    {
-        char buf[24];
-#if STREAM_FORMAT == FORMAT_TEXT
-        sprintf(buf + translatePIDName(pid, buf), "%d,%d,%d\r", value1, value2, value3);
-#else
-        sprintf(buf, "%X,%d,%d,%d\r", pid, value1, value2, value3);
-#endif
-#if ENABLE_DATA_OUT
-#if STREAM_FORMAT == FORMAT_BIN
-        LOG_DATA_COMM ld = {dataTime, pid, 3, 0, {value1, value2, value3}};
-        ld.checksum = getChecksum((char*)&ld, 20);
-        SerialRF.write((uint8_t*)&ld, 20);
-#else
-        SerialRF.print(buf);
-#endif
-        delay(DELAY_AFTER_SENDING);
-#endif
-        recordData(buf);
-    }
-#if ENABLE_DATA_LOG
-    uint16_t openFile(uint16_t logFlags = 0, uint32_t dateTime = 0)
-    {
-        uint16_t fileIndex;
-        char filename[24] = "/FRMATICS";
-
-        pinMode(SS, OUTPUT);
-        SD.begin(SD_CS_PIN);
-
-        if (SD.exists(filename)) {
-            for (fileIndex = 1; fileIndex; fileIndex++) {
-                sprintf(filename + 9, FILE_NAME_FORMAT, fileIndex);
-                if (!SD.exists(filename)) {
-                    break;
-                }
-            }
-            if (fileIndex == 0)
-                return 0;
-        } else {
-            SD.mkdir(filename);
-            fileIndex = 1;
-            sprintf(filename + 9, FILE_NAME_FORMAT, 1);
-        }
-
-        sdfile = SD.open(filename, FILE_WRITE);
-        if (!sdfile) {
-            return 0;
-        }
-
-        dataSize = sdfile.print(idstr);
-        m_lastDataTime = dateTime;
-        return fileIndex;
-    }
-    void closeFile()
-    {
-        sdfile.close();
-    }
-    void flushFile()
-    {
-        sdfile.flush();
-    }
-#endif
-    uint32_t dataTime;
-    uint32_t dataSize;
-private:
-    byte getChecksum(char* buffer, byte len)
-    {
-        uint8_t checksum = 0;
-        for (byte i = 0; i < len; i++) {
-          checksum ^= buffer[i];
-        }
-        return checksum;
-    }
-#if STREAM_FORMAT == FORMAT_TEXT
-    byte translatePIDName(uint16_t pid, char* text)
-    {
-        for (uint16_t n = 0; n < sizeof(pidNames) / sizeof(pidNames[0]); n++) {
-            uint16_t id = pgm_read_word(&pidNames[n].pid);
-            if (pid == id) {
-                memcpy_P(text, pidNames[n].name, 3);
-                text[3] = '=';
-                return 4;
-            }
-        }
-        return sprintf(text, "%X=", pid);
-    }
-#endif
-#if ENABLE_DATA_LOG
-    uint32_t m_lastDataTime;
-#endif
-};
diff --git a/telelogger/telelogger.ino b/telelogger/telelogger.ino
deleted file mode 100644
index 05d2866..0000000
--- a/telelogger/telelogger.ino
+++ /dev/null
@@ -1,581 +0,0 @@
-/******************************************************************************
-* Vehicle Telematics Remote Data Logger Sketch (SIM900/GPRS)
-* Developed by Stanley Huang <stanleyhuangyc@gmail.com>
-* Distributed under GPL v2.0
-* 
-* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
-* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
-* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
-* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
-* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
-* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
-* THE SOFTWARE.
-******************************************************************************/
-
-#include <Arduino.h>
-#include <Wire.h>
-#include <OBD.h>
-#if ENABLE_DATA_LOG
-#include <SD.h>
-#endif
-#include <I2Cdev.h>
-#include <MPU9150.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_READY 0x4
-#define STATE_MEMS_READY 0x8
-#define STATE_SLEEPING 0x20
-
-static uint32_t lastFileSize = 0;
-static uint16_t fileIndex = 0;
-static uint32_t startTime = 0;
-static uint32_t lastGPSAccess = 0;
-static uint32_t lastGPSTime = 0;
-static uint32_t lastGPSTimeSent = 0;
-static uint32_t dataCount = 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};
-
-static int pidValueTier1[sizeof(pidTier1)];
-static int pidValueTier2[sizeof(pidTier2)];
-static int pidValueTier3[sizeof(pidTier3)];
-
-#if USE_MPU6050 || USE_MPU9150
-static int16_t ax = 0, ay = 0, az = 0;
-static int16_t gx = 0, gy = 0, gz = 0;
-#if USE_MPU9150
-static int16_t mx = 0, my = 0, mz = 0;
-#endif
-static int temp = 0;
-#endif
-
-static GPS_DATA gd = {0};
-
-#define TIER_NUM1 sizeof(pidTier1)
-#define TIER_NUM2 sizeof(pidTier2)
-#define TIER_NUM3 sizeof(pidTier3)
-
-byte pidValue[TIER_NUM1];
-
-#if USE_MPU6050 || USE_MPU9150
-MPU6050 accelgyro;
-static uint32_t lastMemsDataTime = 0;
-#endif
-
-#define sim Serial
-#define GSM_ON              6
-#define GSM_RESET           7
-
-char gpsline[OBD_RECV_BUF_SIZE] = {0};
-
-typedef enum {
-    HTTP_DISABLED = 0,
-    HTTP_READY,
-    HTTP_CONNECTING,
-    HTTP_READING,
-    HTTP_ERROR,
-} HTTP_STATES;
-
-class CGPRS {
-public:
-    CGPRS():httpState(HTTP_DISABLED) {}
-    bool init()
-    {
-        sim.begin(9600);
-        pinMode(GSM_ON, OUTPUT);
-        pinMode(GSM_RESET, OUTPUT);
-
-        if (sendCommand("ATE0")) {
-            digitalWrite(GSM_RESET, HIGH);
-            delay(1000);
-            // generate turn on pulse
-            digitalWrite(GSM_RESET, LOW);
-            delay(100);
-            sendCommand("ATE0");
-            return true;
-        } else {
-            for (byte n = 0; n < 5; n++) {
-              digitalWrite(GSM_ON, HIGH);
-              delay(1000);
-              // generate turn on pulse
-              digitalWrite(GSM_ON, LOW);
-              delay(3000);
-              if (sendCommand("ATE0"))
-                return true;
-            }
-            return false;
-        }
-    }
-    bool setup(const char* apn)
-    {
-        while (sendCommand("AT+CREG?", "+CREG: 0,1", "+CREG: 0,5", 2000) == 0);
-        sendCommand("AT+CSQ");
-        sendCommand("AT+CGATT?");
-
-        if (!sendCommand("AT+SAPBR=3,1,\"Contype\",\"GPRS\""))
-            return false;
-
-        sim.print("AT+SAPBR=3,1,\"APN\",\"");
-        sim.print(apn);
-        sim.println('\"');
-        if (!sendCommand(0))
-            return false;
-
-        while (!sendCommand("AT+SAPBR=1,1"));
-        return true;
-    }
-    bool getOperatorName()
-    {
-        // display operator name
-        if (sendCommand("AT+COPS?", "OK\r", "ERROR\r") == 1) {
-            char *p = strstr(response, ",\"");
-            if (p) {
-                p += 2;
-                char *s = strchr(p, '\"');
-                if (s) *s = 0;
-                strcpy(response, p);
-                return true;
-            }
-        }
-        return false;
-    }
-    void httpUninit()
-    {
-      sendCommand("AT+HTTPTERM");
-    }
-
-    bool httpInit()
-    {
-      if  (!sendCommand("AT+HTTPINIT", 10000) || !sendCommand("AT+HTTPPARA=\"CID\",1", 5000)) {
-        httpState = HTTP_DISABLED;
-        return false;
-      }
-      httpState = HTTP_READY;
-      return true;
-    }
-    bool httpConnect(const char* url, const char* args = 0)
-    {
-        // Sets url
-        sim.print("AT+HTTPPARA=\"URL\",\"");
-        sim.print(url);
-        if (args) {
-            sim.print('?');
-            sim.print(args);
-        }
-
-        sim.println('\"');
-        if (sendCommand(0))
-        {
-            // Starts GET action
-            sim.println("AT+HTTPACTION=0");
-            httpState = HTTP_CONNECTING;
-            bytesRecv = 0;
-            checkTimer = millis();
-        } else {
-            httpState = HTTP_ERROR;
-        }
-        return false;
-    }
-    byte httpIsConnected()
-    {
-        byte ret = checkResponse("+HTTPACTION:0,200", "+HTTPACTION:0,6", 10000);
-        if (ret == 1) {
-            return 1;
-        } else if (ret >= 2) {
-            httpState = HTTP_ERROR;
-        }
-        return false;
-    }
-    void httpRead()
-    {
-        sim.println("AT+HTTPREAD");
-        httpState = HTTP_READING;
-        bytesRecv = 0;
-        checkTimer = millis();
-    }
-    bool httpIsRead()
-    {
-        byte ret = checkResponse("+HTTPREAD:", "Error", 10000) == 1;
-        if (ret == 1) {
-            bytesRecv = 0;
-            sendCommand(0);
-            byte n = atoi(response);
-            char *p = strchr(response, '\n');
-            if (p) memmove(response, p + 1, n);
-            response[n] = 0;
-            return 1;
-        } else if (ret >= 2) {
-            httpState = HTTP_ERROR;
-        }
-        return false;
-    }
-    char response[256];
-    byte bytesRecv;
-    byte httpState;
-    uint32_t checkTimer;
-private:
-    byte checkResponse(const char* expected1, const char* expected2 = 0, unsigned int timeout = 2000)
-    {
-        while (sim.available()) {
-            char c = sim.read();
-            if (bytesRecv >= sizeof(response) - 1) {
-                // buffer full, discard first half
-                bytesRecv = sizeof(response) / 2 - 1;
-                memcpy(response, response + sizeof(response) / 2, bytesRecv);
-            }
-            response[bytesRecv++] = c;
-            response[bytesRecv] = 0;
-            if (strstr(response, expected1)) {
-                return 1;
-            }
-            if (expected2 && strstr(response, expected2)) {
-                return 2;
-            }
-        }
-        return (millis() - checkTimer < timeout) ? 0 : 3;
-    }
-    byte sendCommand(const char* cmd, unsigned int timeout = 2000, const char* expected = 0)
-    {
-      if (cmd) {
-        while (sim.available()) sim.read();
-        sim.println(cmd);
-      }
-      uint32_t t = millis();
-      byte n = 0;
-      do {
-        if (sim.available()) {
-          char c = sim.read();
-          if (n >= sizeof(response) - 1) {
-            // buffer full, discard first half
-            n = sizeof(response) / 2 - 1;
-            memcpy(response, response + sizeof(response) / 2, n);
-          }
-          response[n++] = c;
-          response[n] = 0;
-          if (strstr(response, expected ? expected : "OK\r")) {
-           return n;
-          }
-        }
-      } while (millis() - t < timeout);
-      return 0;
-    }
-    byte sendCommand(const char* cmd, const char* expected1, const char* expected2, unsigned int timeout = 2000)
-    {
-      if (cmd) {
-        while (sim.available()) sim.read();
-        sim.println(cmd);
-      }
-      uint32_t t = millis();
-      byte n = 0;
-      do {
-        if (sim.available()) {
-          char c = sim.read();
-          if (n >= sizeof(response) - 1) {
-            // buffer full, discard first half
-            n = sizeof(response) / 2 - 1;
-            memcpy(response, response + sizeof(response) / 2, n);
-          }
-          response[n++] = c;
-          response[n] = 0;
-          if (strstr(response, expected1)) {
-           return 1;
-          }
-          if (strstr(response, expected2)) {
-           return 2;
-          }
-        }
-      } while (millis() - t < timeout);
-      return 0;
-    }
-};
-
-class COBDLogger : public COBDI2C, public CDataLogger
-{
-public:
-    COBDLogger():state(0) {}
-    void setup()
-    {
-        SerialRF.print("#GPRS...");
-        if (gprs.init()) {
-            SerialRF.println("OK");
-        } else {
-            SerialRF.println(gprs.response);
-        }
-
-        SerialRF.print("#OBD..");
-        do {
-            SerialRF.print('.');
-        } while (!init());
-        SerialRF.println("OK");
-
-        state |= STATE_OBD_READY;
-
-#if USE_MPU6050 || USE_MPU9150
-        Wire.begin();
-        accelgyro.initialize();
-        if (accelgyro.testConnection()) state |= STATE_MEMS_READY;
-#endif
-
-        SerialRF.print("#GPS...");
-        if (initGPS()) {
-            SerialRF.println("OK");
-            state |= STATE_GPS_READY;
-        } else {
-            SerialRF.println("N/A");
-        }
-        delay(3000);
-
-#if ENABLE_DATA_LOG
-        uint16_t index = openFile();
-        if (index) {
-            SerialRF.print("#SD File:");
-            SerialRF.println(index);
-            state |= STATE_SD_READY;
-        } else {
-            SerialRF.print("#No SD");
-            state &= ~STATE_SD_READY;
-        }
-#endif
-
-        SerialRF.print("#Network...");
-        if (gprs.setup("connect")) {
-            SerialRF.println("OK");
-        } else {
-            SerialRF.print(gprs.response);
-        }
-        if (gprs.getOperatorName()) {
-            SerialRF.print('#');
-            SerialRF.println(gprs.response);
-        }
-        // init HTTP
-        SerialRF.print("#HTTP...");
-        while (!gprs.httpInit()) {
-          SerialRF.print('.');
-          gprs.httpUninit();
-          delay(1000);
-        }
-        delay(3000);
-    }
-    void loop()
-    {
-        static byte index = 0;
-        static byte index2 = 0;
-        static byte index3 = 0;
-        uint32_t start = millis();
-
-        // poll OBD-II PIDs
-        pidValueTier1[index] = logOBDData(pidTier1[index]);
-        if (++index == TIER_NUM1) {
-            index = 0;
-            if (index2 == TIER_NUM2) {
-                index2 = 0;
-                pidValueTier3[index] = logOBDData(pidTier3[index3]);
-                index3 = (index3 + 1) % TIER_NUM3;
-            } else {
-                pidValueTier2[index2] = logOBDData(pidTier2[index2]);
-                index2++;
-            }
-        }
-
-        if (state & STATE_GPS_READY) {
-            if (millis() - lastGPSAccess > GPS_DATA_INTERVAL) {
-                logGPSData();
-                lastGPSAccess = millis();
-            }
-        }
-
-#if ENABLE_DATA_LOG
-        // flush SD data every 1KB
-        if (dataSize - lastFileSize >= 1024) {
-            flushFile();
-            lastFileSize = dataSize;
-            // display logged data size
-            SerialRF.print("#Log Size:");
-            SerialRF.println(dataSize);
-        }
-#endif
-
-        if (errors >= 2) {
-            reconnect();
-        }
-
-#ifdef OBD_MIN_INTERVAL
-        while (millis() - start < OBD_MIN_INTERVAL) {
-            dataIdleLoop();
-        }
-#endif
-    }
-private:
-    void dataIdleLoop()
-    {
-        switch (gprs.httpState) {
-        case HTTP_READY:
-            {
-                // generate URL
-                char *p = gprs.response;
-                p += sprintf(p, "C=%lu&", ++dataCount);
-                for (byte n = 0; n < sizeof(pidTier1); n++) {
-                    p += sprintf(p, "%x=%d&", pidTier1[n], pidValueTier1[n]);
-                }
-                p += sprintf(p, "A=%d,%d,%d&G=%d,%d,%d&M=%d,%d,%d", ax, ay, az, gx, gy, gz, mx, my, mz);
-                //p += sprintf(p, "&T=%d", temp);
-                if (gd.time && gd.time != lastGPSTimeSent) {
-                    p += sprintf(p, "&GPS=%lu,%ld,%ld,%d,%d,%d", gd.time, gd.lat, gd.lon, gd.alt / 100, (int)gd.speed, gd.sat);
-                    lastGPSTimeSent = gd.time;
-                }
-
-                #if 0
-                char *q = strchr(gpsline, ',');
-                if (q) {
-                    char *s = strchr(q, '\r');
-                    if (s) *s = 0;
-                    strcat(p, q + 1);
-                }
-                #endif
-                gprs.httpConnect(SERVER_URL, gprs.response);
-            }
-            break;
-        case HTTP_CONNECTING:
-            if (gprs.httpIsConnected()) {
-                gprs.httpRead();
-            }
-            break;
-        case HTTP_READING:
-            if (gprs.httpIsRead()) {
-                SerialRF.print("#HTTP:");
-                SerialRF.println(gprs.response);
-                // ready for next connection
-                gprs.httpState = HTTP_READY;
-            }
-            break;
-        case HTTP_ERROR:
-            SerialRF.println("#HTTP ERROR");
-            // re-initialize HTTP
-            /*
-            gprs.httpUninit();
-            if (gprs.httpInit())
-                gprs.httpState = HTTP_READY;
-            */
-            gprs.httpState = HTTP_READY;
-            break;
-        }
-#if USE_MPU6050 || USE_MPU9150
-        if (state & STATE_MEMS_READY) {
-            processMEMS();
-        }
-#endif
-    }
-#if USE_MPU6050 || USE_MPU9150
-    void processMEMS()
-    {
-        if (dataTime - lastMemsDataTime < ACC_DATA_INTERVAL) {
-            return;
-        }
-
-    #if USE_MPU9150
-        accelgyro.getMotion9(&ax, &ay, &az, &gx, &gy, &gz, &mx, &my, &mz);
-    #else
-        accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
-    #endif
-
-        dataTime = millis();
-
-        temp = accelgyro.getTemperature();
-
-        ax /= ACC_DATA_RATIO;
-        ay /= ACC_DATA_RATIO;
-        az /= ACC_DATA_RATIO;
-        gx /= GYRO_DATA_RATIO;
-        gy /= GYRO_DATA_RATIO;
-        gz /= GYRO_DATA_RATIO;
-    #if USE_MPU9150
-        mx /= COMPASS_DATA_RATIO;
-        my /= COMPASS_DATA_RATIO;
-        mz /= COMPASS_DATA_RATIO;
-    #endif
-
-        // log x/y/z of accelerometer
-        logData(PID_ACC, ax, ay, az);
-        // log x/y/z of gyro meter
-        logData(PID_GYRO, gx, gy, gz);
-    #if USE_MPU9150
-        // log x/y/z of compass
-        logData(PID_COMPASS, mx, my, mz);
-    #endif
-        logData(PID_MEMS_TEMP, temp);
-
-        lastMemsDataTime = dataTime;
-    }
-#endif
-    int logOBDData(byte pid)
-    {
-        int value = 0;
-        // send a query to OBD adapter for specified OBD-II pid
-        if (read(pid, value)) {
-            dataTime = millis();
-            // log data to SD card
-            logData(0x100 | pid, value);
-        }
-        return value;
-    }
-    bool logGPSData()
-    {
-        if (getGPSData(&gd) && gd.lat && gd.lon && gd.time != lastGPSTime) {
-            logData(PID_GPS_TIME, gd.time);
-            logData(PID_GPS_ALTITUDE, gd.lat);
-            logData(PID_GPS_LONGITUDE, gd.lon);
-            logData(PID_GPS_ALTITUDE, gd.alt);
-            lastGPSTime = gd.time;
-            return true;
-        }
-        return false;
-    }
-    void reconnect()
-    {
-#if ENABLE_DATA_LOG
-        closeFile();
-#endif
-        SerialRF.println("#Sleeping");
-        startTime = millis();
-        state &= ~STATE_OBD_READY;
-        state |= STATE_SLEEPING;
-        //digitalWrite(SD_CS_PIN, LOW);
-        for (uint16_t i = 0; ; i++) {
-            if (init()) {
-                int value;
-                if (read(PID_RPM, value) && value > 0)
-                    break;
-            }
-        }
-        SerialRF.println("#Resuming");
-        state &= ~STATE_SLEEPING;
-        fileIndex++;
-        recover();
-        setup();
-    }
-    byte state;
-    CGPRS gprs;
-};
-
-static COBDLogger logger;
-
-void setup()
-{
-    logger.begin();
-    logger.initSender();
-    logger.setup();
-}
-
-void loop()
-{
-    logger.loop();
-}