Comunicación OBD con Ford Focus 2007

.



El amigo Sergegsx nos envia unas fotos del proyecto que está haciendo basado en SECUduino. Se comunica a su Ford Focus del 2007 gracias al "brick" que puedes encontrar en nuestra tienda usando OBD (ISO).
Para hacerlo, basta con usar la información de wikipedia respecto OBD II PIDs.

Veámos un ejemplo de una trama estandard OBD:

CAN_TxMsg.id=0x7DF; 

CAN_TxMsg.header.rtr=0;
CAN_TxMsg.header.length=8;
CAN_TxMsg.data[0]=0x02;  //Número de bytes adicionales de datos
CAN_TxMsg.data[1]=0x01;  //MODO

CAN_TxMsg.data[2]=0x0C;  //PID (función a pedir, en este caso rpm)

CAN_TxMsg.data[3]=0x00;
CAN_TxMsg.data[4]=0x00;
CAN_TxMsg.data[5]=0x00;
CAN_TxMsg.data[6]=0x00;
CAN_TxMsg.data[7]=0x00;

Al enviar dicho mensaje, el coche nos responderá :
7E8 | 0x04 | 0x41 | 0x0C | 0x0D | 0x50 | 0x00 | 0x00 | 0x00 

donde ID=7E8 y los 8 bytes de datos=0x04 0x41 0x0C 0x0D 0x50 0x00 0x00 0x00  

• El primer byte de datos indica el número de bytes adicionales (4 más).
• El segundo byte (0x41) indica que se trata de datos actuales.
• El tercer byte nos indica que función se trata (0x0C=rpm).
• El cuarto y quinto byte, son las rpm=((Byte3*256)+Byte4)/4= 852 rpm. Es decir:

           rpm =  ((CAN_RxMsg.data[3]*256) + CAN_RxMsg.data[4])/4;

Para ampliar información sobre otros PID, sólo basta con leer el link de wikipedia indicando anteriormente.

Código de lectura velocidad motor (rpm) :
 

// ----------------------------------------------
// SECUDUINO
// http://secuduino.blogspot.com/
// ---------------------------------------------- 

#include <CAN.h>

long rpm;

void setup()
{
 Serial.begin(115200);
 Serial.println("Empezamos...");

 CAN.begin(500);

 CAN_TxMsg.id=0x7DF;   
 CAN_TxMsg.header.rtr=0;
 CAN_TxMsg.header.length=8;
 CAN_TxMsg.data[0]=0x02;
 CAN_TxMsg.data[1]=0x01;  //MODE 
 CAN_TxMsg.data[2]=0x0C;  //PID
 CAN_TxMsg.data[3]=0x00;
 CAN_TxMsg.data[4]=0x00;
 CAN_TxMsg.data[5]=0x00;
 CAN_TxMsg.data[6]=0x00;
 CAN_TxMsg.data[7]=0x00; 

}

void loop()
{


 CAN.send(&CAN_TxMsg);

 delay(5);


 if (CAN.CheckNew())
 {
 
   if ( CAN.ReadFromDevice(&CAN_RxMsg) )
   {
     if (CAN_RxMsg.data[2]==0x0C)   //PID=0x0C (rpm)
     {
       rpm =  ((CAN_RxMsg.data[3]*256) + CAN_RxMsg.data[4])/4;
           
       Serial.print(millis());
       Serial.print(";");
       Serial.print(CAN_RxMsg.id,HEX);
       Serial.print(";");
       Serial.print(CAN_RxMsg.data[0],HEX);
       Serial.print(";");
       Serial.print(CAN_RxMsg.data[1],HEX);
       Serial.print(";");
       Serial.print(CAN_RxMsg.data[2],HEX);
       Serial.print(";");
       Serial.print(CAN_RxMsg.data[3],HEX);
       Serial.print(";");
       Serial.print(CAN_RxMsg.data[4],HEX);
       Serial.print(";");
       Serial.print(CAN_RxMsg.data[5],HEX);
       Serial.print(";");
       Serial.print(CAN_RxMsg.data[6],HEX);
       Serial.print(";");
       Serial.print(CAN_RxMsg.data[7],HEX);
       Serial.print(";");
       Serial.print("RPM=");
       Serial.println(rpm,DEC);
     }
 }
 
 }else
 {
   
 }

}

Un link interesante para ver que módelos Ford Focus disponen de diagnosis por CAN: http://www.aim-sportline.com/download/ecu/stock/ford/Ford_Focus_OBDII_connection_100_eng.pdf


Buen trabajo Sergegsx!!!