MyOBD : make debug runtime-controllable, lpo.ino: wait(20s) before readPID loopHEADmaster

1 files changed, 7 insertions, 2 deletions

diff --git a/lpo/MyOBD.h b/lpo/MyOBD.h
index f2124c3..0f3004d 100644
--- a/lpo/MyOBD.h
+++ b/lpo/MyOBD.h
@@ -7,13 +7,18 @@ extern MyLCD lcd;
 
 class MyOBD : public COBDI2C {
   public:
+  int debug;
+  MyOBD() {
+    debug=0;
+  }
   void write(const char* s) {
-    lcd.print("<<<"); lcd.println(s);
+    if (this->debug) lcd.print("<<<"); lcd.println(s);
     COBDI2C::write(s);
   }
   byte receive(char* buffer, byte bufsize, int timeout) {
     byte res = COBDI2C::receive(buffer,bufsize, timeout);
-    lcd.print(">>>"); lcd.println(buffer);
+    if (this->debug) lcd.print(">>>"); lcd.println(buffer);
+    return res;
   }
   /* Fake OBD for testing
   int i;