ELM327_Params.cpp

#include "ELM327_Params.h"

float speed = 0.0;
float engineLoad = 0.0;
float rpm = 0.0;
float throttlePos = 0.0;

// Read speed of vehicle and convert for readable value
void get_Speed(){
    blue.printf("010d\r\n");
    RX_Read();
    if('4' == RX_buffer[1] && '1' == RX_buffer[2]){
        speed = 16.0*hex2float(RX_buffer[5]) + hex2float(RX_buffer[6]);
    }
}

// Read calculated load engine and convert for readable value
void get_Engine_Load(){
    blue.printf("0104\r\n");
    RX_Read();
    if('4' == RX_buffer[1] && '1' == RX_buffer[2]){
        engineLoad = 100*(16.0*hex2float(RX_buffer[5]) + hex2float(RX_buffer[6]))/255;
    }
}

// Read engine speed and convert for readable value
void get_Engine_RPM(){
    blue.printf("010c\r\n");
    RX_Read();
    if('4' == RX_buffer[1] && '1' == RX_buffer[2]){
        rpm = ((16.0*hex2float(RX_buffer[5]) + hex2float(RX_buffer[6]))*256.0 + 16.0*hex2float(RX_buffer[7]) + hex2float(RX_buffer[8]))/4.0;
    }
}

// Read throttle/acceleration pedal position and convert for readable value
void get_Throttle_Position(){
    blue.printf("0111\r\n");
    RX_Read();
    if('4' == RX_buffer[1] && '1' == RX_buffer[2]){
        throttlePos = 100*(16.0*hex2float(RX_buffer[5]) + hex2float(RX_buffer[6]))/255;
    }
}

// Read defined car params by ELM327
void read_ELM_Params(){
    __disable_irq();
    ledGreen = LED_ON;
    get_Speed();
    get_Engine_Load();
    get_Engine_RPM();
    get_Throttle_Position();
    ledGreen = LED_OFF;
    __enable_irq();
}