summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
Diffstat
-rw-r--r--samples/test_obd_i2c/test_obd_i2c.ino144
-rw-r--r--samples/test_obd_uart/test_obd_uart.ino382
2 files changed, 0 insertions, 526 deletions
diff --git a/samples/test_obd_i2c/test_obd_i2c.ino b/samples/test_obd_i2c/test_obd_i2c.ino
deleted file mode 100644
index 7d78004..0000000
--- a/samples/test_obd_i2c/test_obd_i2c.ino
+++ /dev/null
@@ -1,144 +0,0 @@
-#include <Arduino.h>
-#include <Wire.h>
-#include <OBD.h>
-#include <MPU6050.h>
-#include <SPI.h>
-
-#define CON Serial
-
-bool hasAAC = false;
-
-COBDI2C obd;
-
-bool initACC()
-{
- if (MPU6050_init() != 0)
- return false;
- return true;
-
-}
-void processACC()
-{
- accel_t_gyro_union data;
- MPU6050_readout(&data);
- CON.print('[');
- CON.print(millis());
- CON.print(']');
- // log x/y/z of accelerometer
- CON.print(" AX=");
- CON.print(data.value.x_accel);
- CON.print(" AY=");
- CON.print(data.value.y_accel);
- CON.print(" AZ=");
- CON.println(data.value.z_accel);
- // log x/y/z of gyro meter
- CON.print('[');
- CON.print(millis());
- CON.print(']');
- CON.print(" GX=");
- CON.print(data.value.x_gyro);
- CON.print(" GY=");
- CON.print(data.value.y_gyro);
- CON.print(" GZ=");
- CON.println(data.value.z_gyro);
-}
-
-void setup()
-{
- CON.begin(115200);
- //lcd.begin();
-
- CON.println("OBD TESTER");
-
- obd.begin();
-
- hasAAC = initACC();
- if (hasAAC)
- CON.println("MPU6050 detected");
-
- for (;;) {
- CON.println("Connecting...");
- if (obd.init()) break;
- delay(1000);
- }
- CON.println("Connected");
-
- obd.gpsStart(38400);
-
- //obd.btInit(9600);
-}
-
-byte getChecksum(char* buffer, byte len)
-{
- uint8_t checksum = 0;
- for (byte i = 0; i < len; i++) {
- checksum ^= buffer[i];
- }
- return checksum;
-}
-
-typedef struct {
- uint32_t time;
- uint16_t pid;
- uint8_t flags;
- uint8_t checksum;
- float value;
-} LOG_DATA;
-
-void sendData(uint16_t pid, int value)
-{
- LOG_DATA ld = {millis(), pid, 1, 0, value};
- ld.checksum = getChecksum((char*)&ld, sizeof(LOG_DATA));
- obd.btSend((byte*)&ld, sizeof(LOG_DATA));
-}
-
-void loop()
-{
- int value;
-
- //lcd.setCursor(0, 8);
-
- CON.print('[');
- CON.print(millis());
- CON.print(']');
- if (obd.read(PID_RPM, value, false)) {
- //sendData(0x100 | PID_RPM, value);
- CON.print(" RPM:");
- CON.print(value);
- }
- if (obd.read(PID_SPEED, value, false)) {
- //sendData(0x100 | PID_SPEED, value);
- CON.print(" SPD:");
- CON.print(value);
- }
- if (obd.read(PID_THROTTLE, value, false)) {
- //sendData(0x100 | PID_THROTTLE, value);
- CON.print(" THR:");
- CON.print(value);
- }
- CON.println("");
- if (hasAAC) {
- processACC();
- }
- //delay(500);
-
- GPS_DATA gpsdata;
- if (obd.gpsQuery(&gpsdata)) {
- CON.print('[');
- CON.print(millis());
- CON.print(']');
- CON.print(" LAT:");
- CON.print(gpsdata.lat, 6);
- CON.print(" LON:");
- CON.print(gpsdata.lon, 6);
- CON.print(" ALT:");
- CON.print(gpsdata.alt, 1);
- CON.print(" SAT:");
- CON.print(gpsdata.sat);
- CON.print(" AGE:");
- CON.print(gpsdata.age);
- CON.print(" TIME:");
- CON.println(gpsdata.time);
- }
- //delay(500);
-}
diff --git a/samples/test_obd_uart/test_obd_uart.ino b/samples/test_obd_uart/test_obd_uart.ino
deleted file mode 100644
index ba7ad62..0000000
--- a/samples/test_obd_uart/test_obd_uart.ino
+++ /dev/null
@@ -1,382 +0,0 @@
-#include <Arduino.h>
-#include <Wire.h>
-#include <SPI.h>
-#include <MultiLCD.h>
-#include <TinyGPS.h>
-#include <OBD.h>
-#include <MPU6050.h>
-
-#define INIT_CMD_COUNT 4
-#define MAX_CMD_LEN 6
-
-// GPS logging can only be enabled when there is additional hardware serial UART
-#if defined(__AVR_ATmega2560__) || defined(__AVR_ATmega1280__)
-#define GPSUART Serial3
-#elif defined(__AVR_ATmega644P__)
-#define GPSUART Serial1
-#endif
-
-#define GPS_BAUDRATE 38400 /* bps */
-
-#ifdef GPSUART
-TinyGPS gps;
-#endif // GPSUART
-
-int MPU6050_read(int start, uint8_t *buffer, int size);
-
-char initcmd[INIT_CMD_COUNT][MAX_CMD_LEN] = {"ATZ\r","ATE0\r","ATL1\r","0902\r"};
-
-//SoftwareSerial softSerial(2, 3); // RX, TX
-
-unsigned int adc_key_val[5] ={30, 150, 360, 535, 760 };
-int NUM_KEYS = 5;
-int adc_key_in;
-char key=-1;
-char oldkey=-1;
-
-byte index = 0;
-uint16_t pid = 0x0111;
-
-bool hasMPU6050 = false;
-
-//create object to control an LCD.
-//LCD_SSD1306 lcd;
-//LCD_PCD8544 lcd;
-//LCD_ILI9325D lcd;
-LCD_ILI9341 lcd;
-
-#ifdef GPSUART
-void ShowGPSData()
-{
- // parsed GPS data is ready
- char buf[32];
- unsigned long fix_age;
-
- unsigned long date, time;
- gps.get_datetime(&date, &time, &fix_age);
- sprintf(buf, "TIME: %08ld", time);
- lcd.setCursor(0, 6);
- lcd.print(buf);
-
- long lat, lon;
- gps.get_position(&lat, &lon, &fix_age);
- // display LAT/LON if screen is big enough
- lcd.setCursor(0, 7);
- if (((unsigned int)millis() / 1000) & 1)
- sprintf(buf, "LAT: %d.%5ld ", (int)(lat / 100000), lat % 100000);
- else
- sprintf(buf, "LON: %d.%5ld ", (int)(lon / 100000), lon % 100000);
- lcd.print(buf);
-}
-#endif
-
-class COBDTester : public COBD
-{
-public:
- bool Init(bool passive = false)
- {
- unsigned long currentMillis;
- unsigned char n;
- char prompted;
- char buffer[128];
-
- for (unsigned char i = 0; i < INIT_CMD_COUNT; i++) {
- write(initcmd[i]);
- n = 0;
- prompted = 0;
- currentMillis = millis();
- for (;;) {
- if (available()) {
- char c = read();
- if (c == '>') {
- buffer[n] = 0;
- prompted++;
- } else if (n < sizeof(buffer) - 1) {
- buffer[n++] = c;
- lcd.write(c);
- }
- } else if (prompted) {
- break;
- } else {
- unsigned long elapsed = millis() - currentMillis;
- if (elapsed > OBD_TIMEOUT_SHORT) {
- // init timeout
- //WriteData("\r");
- lcd.println("Timeout!");
- if (i == 0) return false;
- i--;
- break;
- }
- }
- }
- delay(500);
- }
-
- //while (digitalRead(8) != 0);
- lcd.clear();
- lcd.println("VIN:");
-
- // parse VIN
- char *p;
- lcd.println(buffer);
- if (p = strchr(buffer, ':')) {;
- byte *q = vin;
- p += 10;
- memset(vin, '-', sizeof(vin));
- while (*p == ' ') {
- p++;
- if (*(p + 1) == ':') {
- p += 2;
- continue;
- }
- *(q++) = hex2uint8(p);
- p += 2;
- }
- }
- for (byte i = 0; i < sizeof(vin); i++) {
- lcd.write(vin[i]);
- }
- delay(5000);
-
- char* data;
- memset(pidmap, 0, sizeof(pidmap));
- lcd.clear();
- for (byte i = 0; i < 4; i++) {
- sprintf(buffer, "PIDs [%02x-%02x]", i * 0x20 + 1, i * 0x20 + 0x20);
- lcd.println(buffer);
- byte pid = i * 0x20;
- sendQuery(pid);
- data = getResponse(pid, buffer);
- if (!data) break;
- lcd.println(buffer);
- delay(500);
- data--;
- for (byte n = 0; n < 4; n++) {
- if (data[n * 3] != ' ')
- break;
- pidmap[i * 4 + n] = hex2uint8(data + n * 3 + 1);
- }
- }
- delay(2000);
-
- errors = 0;
- return true;
- }
- void SendQuery()
- {
- char buf[17];
- switch (index) {
- case 0:
- sprintf(buf, "[%04X]", pid);
- break;
- case 1:
- sprintf(buf, "%03X[%01X]", pid >> 4, pid & 0xf);
- break;
- case 2:
- sprintf(buf, "%02X[%01X]%01X", pid >> 8, (pid >> 4) & 0xf, pid & 0xf);
- break;
- case 3:
- sprintf(buf, "%01X[%01X]%02X", pid >> 12, (pid >> 8) & 0xf, pid & 0xff);
- break;
- case 4:
- sprintf(buf, "[%01X]%03X", pid >> 12, pid & 0xfff);
- break;
- }
-
- lcd.setCursor(0, 0);
- lcd.print(buf);
-
- dataMode = (byte)(pid >> 8);
- sendQuery((byte)pid);
- }
- void Recover()
- {
- write('\r');
- }
- void Loop()
- {
- int value;
- char buffer[OBD_RECV_BUF_SIZE];
- bool gpsReady = false;
-
- // issue a query for specified OBD-II pid
- SendQuery();
-
- do {
-#ifdef GPSUART
- // while waiting for response, test GPS
- unsigned long start = millis();
- while (GPSUART.available() && millis() - start < 100) {
- if (gps.encode(GPSUART.read())) {
- gpsReady = true;
- }
- }
-#endif
- } while (!available());
-
-#ifdef GPSUART
- if (gpsReady)
- ShowGPSData();
-#endif
-
- // check OBD response
- buffer[0] = 0;
- byte curpid = (byte)pid;
- char* data = getResponse(curpid, buffer);
- lcd.setCursor(6, 0);
- if (!data) {
- lcd.setCursor(0, 2);
- lcd.print("Error");
- // try recover next time
- Recover();
- } else {
- char *p = buffer;
- while (*p && *p < ' ') p++;
- for (char *q = p; *q; q++) {
- if (*q < ' ') *q = ' ';
- }
- lcd.setCursor(0, 2);
- lcd.print(p);
- lcd.setCursor(7 * 9, 0);
- sprintf(buffer, "%d", normalizeData(curpid, data));
- lcd.print(buffer);
- }
- }
-};
-
-COBDTester obd;
-
-// Convert ADC value to key number
-char get_key(unsigned int input)
-{
- char k;
- for (k = 0; k < NUM_KEYS; k++) {
- if (input < adc_key_val[k])
- return k;
- }
- return -1;
-}
-
-void testMPU6050()
-{
- int error;
- float dT;
- accel_t_gyro_union accel_t_gyro;
-
- // Read the raw values.
- // Read 14 bytes at once,
- // containing acceleration, temperature and gyro.
- // With the default settings of the MPU-6050,
- // there is no filter enabled, and the values
- // are not very stable.
-
- error = MPU6050_read (MPU6050_ACCEL_XOUT_H, (uint8_t *) &accel_t_gyro, sizeof(accel_t_gyro));
- if (error != 0) {
- lcd.setCursor(0, 4);
- lcd.print("MPU6050 N/A");
- return;
- }
-
-
- // Swap all high and low bytes.
- // After this, the registers values are swapped,
- // so the structure name like x_accel_l does no
- // longer contain the lower byte.
- uint8_t swap;
- #define SWAP(x,y) swap = x; x = y; y = swap
-
- SWAP (accel_t_gyro.reg.x_accel_h, accel_t_gyro.reg.x_accel_l);
- SWAP (accel_t_gyro.reg.y_accel_h, accel_t_gyro.reg.y_accel_l);
- SWAP (accel_t_gyro.reg.z_accel_h, accel_t_gyro.reg.z_accel_l);
- SWAP (accel_t_gyro.reg.t_h, accel_t_gyro.reg.t_l);
- SWAP (accel_t_gyro.reg.x_gyro_h, accel_t_gyro.reg.x_gyro_l);
- SWAP (accel_t_gyro.reg.y_gyro_h, accel_t_gyro.reg.y_gyro_l);
- SWAP (accel_t_gyro.reg.z_gyro_h, accel_t_gyro.reg.z_gyro_l);
-
-
- // Print the raw acceleration values
-
- char buf[20];
- dT = ( (float) accel_t_gyro.value.temperature + 12412.0) / 340.0;
- sprintf(buf, "%d %d %d %d ",
- (int)dT,
- accel_t_gyro.value.x_accel / 128,
- accel_t_gyro.value.y_accel / 128,
- accel_t_gyro.value.z_accel / 128);
- //Serial.println(buf);
- lcd.setCursor(0, 4);
- lcd.print(buf);
-}
-
-void ShowECUCap()
-{
- char buffer[24];
- byte pidlist[] = {PID_RPM, PID_SPEED, PID_THROTTLE, PID_ENGINE_LOAD, 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", "MAF", "MAP", "FUEL LV.", "FUEL PRE.", "COOLANT", "INTAKE","AMBIENT", "IGNITION", "BARO"};
- byte i = 0;
- lcd.clear();
- for (; i < sizeof(pidlist) / sizeof(pidlist[0]) / 2; i++) {
- lcd.setCursor(0, i);
- sprintf(buffer, "%s:%c", namelist[i], obd.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], obd.isValidPID(pidlist[i]) ? 'Y' : 'N');
- lcd.print(buffer);
- }
-}
-
-void setup()
-{
- Wire.begin();
- lcd.begin();
-#ifdef GPSUART
- GPSUART.begin(GPS_BAUDRATE);
-#endif
-
- obd.begin();
-
- pinMode(8, INPUT);
-
- do {
- lcd.setCursor(0, 0);
- lcd.println("Init MPU6050...");
-
- hasMPU6050 = MPU6050_init() == 0;
- if (hasMPU6050) {
- unsigned long t = millis();
- do {
- testMPU6050();
- delay(100);
- } while (millis() - t <= 1000);
- }
- delay(1000);
-
-#ifdef GPSUART
- if (GPSUART.available()) {
- lcd.println("Init GPS... ");
- delay(1000);
- }
-#endif
- lcd.println("Init OBD... ");
- if (hasMPU6050) {
- testMPU6050();
- }
- delay(500);
- } while(!obd.Init());
-
- ShowECUCap();
- delay(3000);
- lcd.clear();
-}
-
-void loop()
-{
- obd.Loop();
-
- // test MPU6050
- if (hasMPU6050) {
- testMPU6050();
- }
-}
generated by cgit v1.2.3 (git 2.39.1) at 2024-11-01 04:30:25 +0000