 {
   switch (cmd) {
     case 0:
+      if(debug == true) {Serial.println("Requesting PID_RPM");}
       send_OBD_cmd(PID_RPM);
       break;
     case 1:
+      if(debug == true) {Serial.println("Requesting PID_SPEED");}
       send_OBD_cmd(PID_SPEED);
       break;
     case 2:
+      if(debug == true) {Serial.println("Requesting PID_FUEL_LEVEL");}
       send_OBD_cmd(PID_FUEL_LEVEL);
       break;
     case 3:
+      if(debug == true) {Serial.println("Requesting PID_DISTANCE");}
       send_OBD_cmd(PID_DISTANCE);
       break;
     case 4:
+      if(debug == true) {Serial.println("Requesting PID_THROTTLE");}
       send_OBD_cmd(PID_THROTTLE);
       break;
   }

    Serial.println(msg);
    delay(50);
    checkIncommingCmd( msg.toInt() );
  }
  bt.flush();
}

void readOBD()
{
  if (obd.available() > 0) {
    String msg; // string to store entire command line
    delay(1000); // wait 1 sec to give time enough for the serial to receive all the stream


#include <TinyGPS++.h>
#include <SoftwareSerial.h>

boolean debug = true;

// Bluetooth Serial parameters:
SoftwareSerial bt(5,4);
