From a1de0a98dc4254e3aa3ce75399f3b83ba6e6187b Mon Sep 17 00:00:00 2001
From: Stanley Huang <stanleyhuangyc@gmail.com>
Date: Tue, 13 Oct 2015 13:17:45 +1100
Subject: Add test sketch for OBD-II I2C Adapter
---
.../OBD/examples/obd_i2c_test/obd_i2c_test.ino | 103 +++++++++++++++++++++
1 file changed, 103 insertions(+)
create mode 100644 libraries/OBD/examples/obd_i2c_test/obd_i2c_test.ino
(limited to 'libraries/OBD')
diff --git a/libraries/OBD/examples/obd_i2c_test/obd_i2c_test.ino b/libraries/OBD/examples/obd_i2c_test/obd_i2c_test.ino
new file mode 100644
index 0000000..3888474
--- /dev/null
+++ b/libraries/OBD/examples/obd_i2c_test/obd_i2c_test.ino
@@ -0,0 +1,103 @@
+#include <Arduino.h>
+#include <Wire.h>
+#include <OBD.h>
+#include <I2Cdev.h>
+#include <MPU9150.h>
+
+COBDI2C obd;
+MPU6050 accelgyro;
+
+void testOut()
+{
+ static const char PROGMEM cmds[][6] = {"ATZ\r", "ATL1\r", "ATRV\r", "0100\r", "010C\r", "0902\r"};
+ char buf[OBD_RECV_BUF_SIZE];
+
+ for (byte i = 0; i < sizeof(cmds) / sizeof(cmds[0]); i++) {
+ char cmd[6];
+ memcpy_P(cmd, cmds[i], sizeof(cmd));
+ Serial.print("Sending ");
+ Serial.println(cmd);
+ if (obd.sendCommand(cmd, buf)) {
+ char *p = strstr(buf, cmd);
+ if (p)
+ p += strlen(cmd);
+ else
+ p = buf;
+ while (*p == '\r') p++;
+ while (*p) {
+ Serial.write(*p);
+ if (*p == '\r' && *(p + 1) != '\r')
+ Serial.write('\n');
+ p++;
+ }
+ } else {
+ Serial.println("Timeout");
+ }
+ delay(500);
+ }
+ Serial.println();
+}
+
+void readMEMS()
+{
+ int16_t ax, ay, az;
+ int16_t gx, gy, gz;
+ int temp;
+
+ accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
+ temp = accelgyro.getTemperature();
+
+ // display MEMS data
+ Serial.print("ACC=");
+ Serial.print(ax);
+ Serial.write('/');
+ Serial.print(ay);
+ Serial.write('/');
+ Serial.println(az);
+
+ Serial.print("GYRO=");
+ Serial.print(gx);
+ Serial.write('/');
+ Serial.print(gy);
+ Serial.write('/');
+ Serial.println(gz);
+}
+
+void showECUCap()
+{
+ static const byte PROGMEM pidlist[] = {PID_ENGINE_LOAD, PID_COOLANT_TEMP, PID_FUEL_PRESSURE, PID_INTAKE_MAP, PID_RPM, PID_SPEED, PID_TIMING_ADVANCE, PID_INTAKE_TEMP, PID_MAF_FLOW, PID_THROTTLE, PID_AUX_INPUT,
+ PID_EGR_ERROR, PID_COMMANDED_EVAPORATIVE_PURGE, PID_FUEL_LEVEL, PID_CONTROL_MODULE_VOLTAGE, PID_ABSOLUTE_ENGINE_LOAD, PID_AMBIENT_TEMP, PID_COMMANDED_THROTTLE_ACTUATOR, PID_ETHANOL_FUEL,
+ PID_FUEL_RAIL_PRESSURE, PID_HYBRID_BATTERY_PERCENTAGE, PID_ENGINE_OIL_TEMP, PID_FUEL_INJECTION_TIMING, PID_ENGINE_FUEL_RATE, PID_ENGINE_TORQUE_DEMANDED, PID_ENGINE_TORQUE_PERCENTAGE};
+
+ bool scanned = false;
+ for (byte i = 0; i < sizeof(pidlist) / sizeof(pidlist[0]); i++) {
+ byte pid = pgm_read_byte(pidlist + i);
+ bool valid = obd.isValidPID(pid);
+ Serial.print('0');
+ Serial.print((int)pid | 0x100, HEX);
+ Serial.print('=');
+ if (valid) {
+ int value;
+ if (obd.read(pid, value)) {
+ byte n = Serial.println(value);
+ }
+ } else {
+ Serial.println('X');
+ }
+ }
+}
+
+void setup() {
+ Serial.begin(115200);
+ delay(500);
+ Wire.begin();
+ accelgyro.initialize();
+ testOut();
+ Serial.println("Init...");
+ while (!obd.init());
+}
+
+void loop() {
+ showECUCap();
+ readMEMS();
+}
--
cgit v1.2.3