Устройства для автосимуляторов на Arduino (каналы и видео) | AlexGyver Community

/*** Start by including GTTurboEcu Library*/
#include<GTTurboEcu.h>/** * Define and configure GTTurboEcu Library * * This values are related to the bluetooth configuration. * library SoftwareSerial.h is use to connect the bluetooth device * by identifying: * 1) baudRate * 2) rxPin * 3) txPin*/
GTTurboEcu gtTurboEcu(9600L, 11, 10);


voidsetup() {

    // init serial communication, is only need if theres a need to read the debug info on serial port of the arduino// Serial.begin(9600);/**     * https://en.wikipedia.org/wiki/OBD-II_PIDs     *     * When the OBD client (ex: torque)     * init's connection, it will ask what sensors the "ecu" supports     *     * Register the PID(sensors) that will be reported to ODBII client app,     * only insert the PID in Hex, do not send the mode01 (see the wikipedia page for more info)     *     * ex PID(010C - Engine RPM) PID(0170 - Boost pressure control)*/
    gtTurboEcu.registerMode01Pid(0x0C);
    gtTurboEcu.registerMode01Pid(0x70);

}

voidloop() {

     /**     * The OBD client App (ex: torque),     * will frequently request values for the PID(sensors),     * that where registered in setup()     *      * use readPidRequest to listen for OBDII client app, pid request's*/
     String pidRequest = gtTurboEcu.readPidRequest();
     
     /**     * Process the pid request 010C - Engine RPM*/if (pidRequest.equalsIgnoreCase("010C")) {
      
            // read RPM value from RPM sensoruint32_t rpmSensorValue = <readYourRpmSensorValue()>;
            
            // CONVERT FORMULAS ON PID (more on wikipage)// find the formula that is used to convert the RPM value on the client side// revert the formula and apply to the value that was readed from the RPM sensor// EX on the client side the RPM value is divide by 4, // this means that the client is expecting an RPM = (rpmSensorValue * 4)uint32_t rpmSensorValueConverted = rpmSensorValue * 4;
            
            // NUMBER OF EXPECTED BYTES// The OBDII client is expecting a response with n number of bytes for a given PID (check the wikipage)// EX the RPM PID (010C), is expecting 2 bytes in the responseuint8_t numberOfBytes = 2;
            
            // finally send the response back/**             * pidRequest - we re-send the pid we received to identify it             * numberOfBytes - the number of bytes this PID value has, see OBDII PID specifications             * rpmSensorValueConverted - the value of the sensor*/
            gtTurboEcu.writePidResponse(pidRequest, numberOfBytes, rpmSensorValueConverted);    
            
            
      } elseif (pidRequest.equalsIgnoreCase("0170")) {
              // read  value from Turbo Boost sensoruint32_t turboBoostSensorValue = <readYourTurboBoostSensorValue()>;
              
              // CONVERT FORMULAS ON PID// no need to convert// NUMBER OF EXPECTED BYTESuint8_t numberOfBytes = 9;
              
              // finally send the response back
              gtTurboEcu.writePidResponse(pidRequest, numberOfBytes, turboBoostSensorValue);    
              
       } else {
      
           /**            * If pid not implemented, report it as not implemented*/
           gtTurboEcu.writePidNotSupported();
       }
       
       
       
     

} // loop end