diff options
Diffstat (limited to 'megaloggerHD')
| -rw-r--r-- | megaloggerHD/megaloggerHD.ino | 23 |
1 files changed, 17 insertions, 6 deletions
diff --git a/megaloggerHD/megaloggerHD.ino b/megaloggerHD/megaloggerHD.ino index 7d32709..efc5f71 100644 --- a/megaloggerHD/megaloggerHD.ino +++ b/megaloggerHD/megaloggerHD.ino @@ -574,15 +574,11 @@ void reconnect() state &= ~(STATE_OBD_READY | STATE_GUI_ON); //digitalWrite(SD_CS_PIN, LOW); for (;;) { - if (!obd.init()) - continue; - - int value; - if (obd.readPID(PID_RPM, value)) + if (obd.init()) break; obd.sleep(); - Narcoleptic.delay(4000); + Narcoleptic.delay(10000); } // re-initialize state |= STATE_OBD_READY; @@ -731,8 +727,23 @@ void setup() lcd.print("VIN:"); lcd.setColor(RGB16_YELLOW); lcd.println(buf); + lcd.println(); } + uint16_t dtc[6]; + int num = obd.readDTC(dtc, sizeof(dtc) / sizeof(dtc[0])); + lcd.setColor(RGB16_WHITE); + lcd.print(num); + lcd.println(" DTC found"); + if (num > 0) { + lcd.setColor(RGB16_YELLOW); + for (byte i = 0; i < num; i++) { + lcd.print(dtc[i], HEX); + lcd.print(' '); + } + } + lcd.println(); + showECUCap(); lcd.setCursor(0, 28); lcd.setColor(RGB16_YELLOW); |