#ifndef __MYOBD_H
#define __MYOBD_H
#include <OBD.h>

#include <MyLCD.h>
extern MyLCD lcd;

class MyOBD : public COBDI2C {
  public:
  int debug;
  MyOBD() {
    debug=0;
  }
  void write(const char* 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);
    if (this->debug) lcd.print(">>>"); lcd.println(buffer);
    return res;
  }
  /* Fake OBD for testing
  int i;
  MyOBD() {
    i=0;
  }
  byte begin() {
    delay(500);
    return 1;
  }
  bool init() {
    delay(500);
    return ++i>4;
  }
  bool readPID(byte pid, int& result) {
    result=millis();
    if ( result%1000 == 0 ) { this->errors++; }
    return true;
  }
  byte readDTC(uint16_t codes[], byte maxCodes = 1) {
    codes[0]=6002;
    codes[1]=6032;
    codes[2]=12;
    return 4;
  }
  */
};
#endif