M2_OBD2_11bit.INO

#include <OBD2.h>
#include <DueTimer.h>
#include "SamNonDuePin.h"

/********************************************************************
This example is built upon the CANAcquisition class and the OBDParmameter class using 11bit (non-extended) OBD2 ID's
This example shows how to set up periodic data acquisition of OBD2 paramters based upon
standard PID's. If you'd like to add another paramter,simply copy one of the definitions and modify it accordingly. 
You may also need to add a new PID to the "OBD_PID" enum in the header file. 
/********************************************************************/

//create the CANport acqisition schedulers
cAcquireCAN CANport0(CAN_PORT_0);

/***** DEFINITIONS FOR OBD MESSAGES ON CAN PORT 0, see https://en.wikipedia.org/wiki/OBD-II_PIDs to add your own ***************/
//char _name[10], char _units[10], OBD_PID pid,  uint8_t OBD_PID_SIZE size, bool _signed, OBD_MODE_REQ mode, float32 slope, float32 offset, cAcquireCAN *, extended ID;

  cOBDParameter OBD_Speed(      "Speed "        , " KPH"		,  SPEED       , _8BITS,   false,   CURRENT,  1,      0,  &CANport0, false);
  cOBDParameter OBD_EngineSpeed("Engine Speed " , " RPM"		,  ENGINE_RPM  , _16BITS,  false,   CURRENT,  0.25,   0,  &CANport0, false);
  cOBDParameter OBD_Throttle(   "Throttle "     , " %"  		,  THROTTLE_POS, _8BITS,   false,   CURRENT,  0.3922, 0,  &CANport0, false);
  cOBDParameter OBD_Coolant(    "Coolant "      , " C"  		,  COOLANT_TEMP, _8BITS,   false ,  CURRENT,  1,    -40,  &CANport0, false);
  cOBDParameter OBD_EngineLoad( "Load "         , " %"  		,  ENGINE_LOAD , _8BITS,   false,   CURRENT,  0.3922, 0,  &CANport0, false);
  cOBDParameter OBD_MAF(        "MAF "          , " grams/s"    ,  ENGINE_MAF  , _16BITS,  false,   CURRENT,  0.01,   0,  &CANport0, false);
  cOBDParameter OBD_IAT(        "IAT "          , " C"  		,  ENGINE_IAT  , _8BITS,   false ,  CURRENT,  1,    -40,  &CANport0, false);

#define Serial SerialUSB
const int LOWPOW = PIN_EMAC_ERX0;

void setup()
{
  pinModeNonDue(LOWPOW, OUTPUT);
  digitalWriteNonDue(LOWPOW, HIGH);  
  pinMode(28, OUTPUT); 
  digitalWrite(28, LOW);    
  
  while (!Serial) ;
	//start serial port 
	Serial.begin(115200);

	//debugging message for monitor to indicate CPU resets are occuring
	Serial.println("System Reset");

	//set up the transmission/reception of messages to occur at 500Hz (2mS) timer interrupt
	Timer3.attachInterrupt(PrintScreen).setFrequency(1).start();
       
        //start CAN ports,  enable interrupts and RX masks, set the baud rate here
	CANport0.initialize(_500K);
}


UINT8 i;
UINT32 maxTime;

void loop()
{
CANport0.run(POLLING);
}

//this is our timer interrupt handler, called at XmS interval
void PrintScreen()
{

	//print out our latest OBDII data
	Serial.print(OBD_Speed.getName()); 
	Serial.print(OBD_Speed.getData());
	Serial.println(OBD_Speed.getUnits()); 	

  Serial.print(OBD_EngineSpeed.getName()); 
	Serial.print(OBD_EngineSpeed.getData());
	Serial.println(OBD_EngineSpeed.getUnits()); 

	Serial.print(OBD_Throttle.getName()); 
	Serial.print(OBD_Throttle.getData());
	Serial.println(OBD_Throttle.getUnits()); 
    
	Serial.print(OBD_Coolant.getName()); 
	Serial.print(OBD_Coolant.getData());
	Serial.println(OBD_Coolant.getUnits()); 
	

	Serial.print(OBD_EngineLoad.getName()); 
	Serial.print(OBD_EngineLoad.getData());
	Serial.println(OBD_EngineLoad.getUnits()); 

	Serial.print(OBD_MAF.getName()); 
	Serial.print(OBD_MAF.getData());
	Serial.println(OBD_MAF.getUnits()); 

	Serial.print(OBD_IAT.getName()); 
	Serial.print(OBD_IAT.getData());
	Serial.println(OBD_IAT.getUnits());         	

}