mirror of
https://github.com/SemvdH/OBD2-car-display.git
synced 2025-12-12 18:51:04 +00:00
progress
This commit is contained in:
@@ -86,6 +86,7 @@ uint32_t ram_b_amount = 0; /* counts up to 96 to show the KB of ram */
|
||||
char device_label_i = -1; /* counter in the current device label */
|
||||
|
||||
char bt_state = BT_INITIALISING;
|
||||
char update_slow = 0;
|
||||
|
||||
obd2_elm327_t elm327;
|
||||
|
||||
@@ -160,7 +161,7 @@ void on_init_run()
|
||||
display.print(" ", (display.getDisplayXSize() / 2) - (INIT_TEXT_WIDTH * display.getFontXsize() / 2) - (INIT_PERCENTAGE_WIDTH / 2), display.getDisplayYSize() / 2 + 50);
|
||||
if (init_percent > 90)
|
||||
{
|
||||
update_percent(8);
|
||||
update_percent(8);
|
||||
}
|
||||
}
|
||||
/* update initialization text */
|
||||
@@ -279,7 +280,7 @@ void on_init_run()
|
||||
|
||||
if (init_percent == 100)
|
||||
{
|
||||
statemachine_next();
|
||||
statemachine_next();
|
||||
}
|
||||
}
|
||||
|
||||
@@ -304,29 +305,91 @@ void on_main_enter()
|
||||
#if (DEBUG == 1)
|
||||
Serial.println("Entering main loop");
|
||||
#endif
|
||||
display.setColor(VGA_AQUA);
|
||||
Timer0.attachInterrupt(query_slow_obd2_values);
|
||||
Timer0.start(MS(5000));
|
||||
display.setColor(VGA_AQUA);
|
||||
}
|
||||
|
||||
void on_main_run()
|
||||
{
|
||||
obd2_elm327_process(&elm327);
|
||||
if (update_slow)
|
||||
{
|
||||
update_slow = 0;
|
||||
|
||||
} else {
|
||||
obd2_elm327_process_fast(&elm327);
|
||||
}
|
||||
|
||||
if (elm327.value_updates & (1 << UPDATE_RPM_POS))
|
||||
{
|
||||
display.print("rpm ",0,100);
|
||||
display.printNumI(elm327.rpm,100,100,4,'0');
|
||||
elm327.value_updates &= ~(1 << UPDATE_RPM_POS);
|
||||
#if (DEBUG == 1)
|
||||
Serial.println("rpm");
|
||||
Serial.println(elm327.rpm);
|
||||
#endif
|
||||
int width = (int)(display.getDisplayXSize() * ((float)elm327.rpm / 7000.0));
|
||||
display.fillRect(0,20,width,20);
|
||||
display.setColor(VGA_FUCHSIA);
|
||||
display.print("rpm", 0, 20);
|
||||
display.printNumI(elm327.engine_load, 30, 20, 4, '0');
|
||||
display.setColor(VGA_AQUA);
|
||||
}
|
||||
|
||||
if (elm327.value_updates & (1 << UPDATE_THROTTLE_POS))
|
||||
if (elm327.value_updates & (1 << UPDATE_COOLANT_TEMP_POS))
|
||||
{
|
||||
display.printNumI(elm327.throttle_percent,100,20,3,'0');
|
||||
elm327.value_updates &= ~(1 << UPDATE_THROTTLE_POS);
|
||||
}
|
||||
elm327.value_updates &= ~(1 << UPDATE_COOLANT_TEMP_POS);
|
||||
display.print("coolant temp", 0, 100);
|
||||
display.printNumI(elm327.engine_coolant_temp, 200, 100, 4, '0');
|
||||
}
|
||||
|
||||
if (elm327.value_updates & (1 << UPDATE_FUEL_PRESSURE_POS))
|
||||
{
|
||||
elm327.value_updates &= ~(1 << UPDATE_FUEL_PRESSURE_POS);
|
||||
display.print("fuel pressure", 0, 120);
|
||||
display.printNumF(elm327.fuel_pressure, 200, 120, 4, '0');
|
||||
}
|
||||
|
||||
if (elm327.value_updates & (1 << UPDATE_FUEL_LEVEL_POS))
|
||||
{
|
||||
elm327.value_updates &= ~(1 << UPDATE_FUEL_LEVEL_POS);
|
||||
display.print("fuel level", 0, 140);
|
||||
display.printNumF(elm327.fuel_level, 200, 140, 4, '0');
|
||||
}
|
||||
|
||||
// if (elm327.value_updates & (1 << UPDATE_INTAKE_AIR_TEMP_POS))
|
||||
// {
|
||||
// elm327.value_updates &= ~(1 << UPDATE_INTAKE_AIR_TEMP_POS);
|
||||
// display.print("intake air temp", 0, 160);
|
||||
// display.printNumI(elm327.intake_air_temp, 200, 160, 4, '0');
|
||||
// }
|
||||
|
||||
// if (elm327.value_updates & (1 << UPDATE_AMBIENT_AIR_TEMP_POS))
|
||||
// {
|
||||
// elm327.value_updates &= ~(1 << UPDATE_AMBIENT_AIR_TEMP_POS);
|
||||
// display.print("ambient air temp", 0, 180);
|
||||
// display.printNumI(elm327.ambient_air_temp, 200, 180, 4, '0');
|
||||
// }
|
||||
|
||||
// if (elm327.value_updates & (1 << UPDATE_OIL_TEMP_POS))
|
||||
// {
|
||||
// elm327.value_updates &= ~(1 << UPDATE_OIL_TEMP_POS);
|
||||
// display.print("oil temp", 0, 200);
|
||||
// display.printNumF(elm327.engine_oil_temp, 200, 200, 4, '0');
|
||||
// }
|
||||
|
||||
if (elm327.value_updates & (1 << UPDATE_ENGINE_LOAD_POS))
|
||||
{
|
||||
elm327.value_updates &= ~(1 << UPDATE_ENGINE_LOAD_POS);
|
||||
int width = (int)(display.getDisplayXSize() * ((float)elm327.engine_load / 100.0));
|
||||
display.fillRect(0,50,width,50);
|
||||
display.setColor(VGA_FUCHSIA);
|
||||
display.print("el", 0, 50);
|
||||
display.printNumI(elm327.engine_load, 20, 50, 4, '0');
|
||||
display.setColor(VGA_AQUA);
|
||||
}
|
||||
|
||||
// if (elm327.value_updates & (1 << UPDATE_MANIFOLD_PRESSURE_POS))
|
||||
// {
|
||||
// elm327.value_updates &= ~(1 << UPDATE_MANIFOLD_PRESSURE_POS);
|
||||
// display.print("manifold pressure", 0, 240);
|
||||
// display.printNumI(elm327.manifold_pressure, 200, 240, 4, '0');
|
||||
// }
|
||||
}
|
||||
|
||||
void update_init_text()
|
||||
@@ -432,7 +495,12 @@ void update_ram_kb()
|
||||
|
||||
void bt_state_changed()
|
||||
{
|
||||
update_percent(10);
|
||||
update_percent(10);
|
||||
}
|
||||
|
||||
void query_slow_obd2_values()
|
||||
{
|
||||
update_slow = 1;
|
||||
}
|
||||
|
||||
void setup()
|
||||
@@ -460,7 +528,7 @@ void setup()
|
||||
statemachine_register_state(&main_state, STATE_CAR_INFO);
|
||||
|
||||
// TODO remove
|
||||
//statemachine_register_state(&main_state, 0);
|
||||
// statemachine_register_state(&main_state, 0);
|
||||
statemachine_init();
|
||||
|
||||
display.clrScr();
|
||||
@@ -473,14 +541,14 @@ void setup()
|
||||
display.setColor(COLOR_ORANGE);
|
||||
display.print("Waiting for ELM327", (display.getDisplayXSize() / 2) - ((18 * display.getFontXsize()) / 2), 160);
|
||||
|
||||
#if (DEBUG == 1)
|
||||
Serial.println("checking for bt");
|
||||
#endif
|
||||
#if (DEBUG == 1)
|
||||
Serial.println("checking for bt");
|
||||
#endif
|
||||
if (!obd2_elm327_init(&elm327))
|
||||
{
|
||||
#if (DEBUG == 1)
|
||||
Serial.println("Shit man its fucked");
|
||||
#endif
|
||||
#if (DEBUG == 1)
|
||||
Serial.println("Shit man its fucked");
|
||||
#endif
|
||||
}
|
||||
elm327.on_state_change = &bt_state_changed;
|
||||
#if (DEBUG == 1)
|
||||
|
||||
@@ -9,22 +9,24 @@
|
||||
|
||||
typedef enum elm327_current_value_e
|
||||
{
|
||||
RPM_V,
|
||||
THROTTLE_V,
|
||||
COOLANT_TEMP_V,
|
||||
INTAKE_AIR_TEMP_V,
|
||||
AMBIENT_AIR_TEMP_V,
|
||||
OIL_TEMP_V,
|
||||
ENGINE_LOAD_V,
|
||||
BATTERY_VOLTAGE_V,
|
||||
FUEL_PRESSURE_V,
|
||||
SPEED_V,
|
||||
MANIFOLD_PRESSURE_V
|
||||
RPM_V, // fast
|
||||
// THROTTLE_V,
|
||||
COOLANT_TEMP_V, // slow
|
||||
INTAKE_AIR_TEMP_V, // slow
|
||||
AMBIENT_AIR_TEMP_V, // slow
|
||||
OIL_TEMP_V, // slow
|
||||
ENGINE_LOAD_V, // fast
|
||||
// BATTERY_VOLTAGE_V,
|
||||
FUEL_PRESSURE_V, // fast?
|
||||
// SPEED_V,
|
||||
MANIFOLD_PRESSURE_V, // fast?
|
||||
FUEL_LEVEL_V // slow
|
||||
|
||||
} elm327_current_value;
|
||||
|
||||
ELM327 elm327_obj;
|
||||
elm327_current_value current_value;
|
||||
elm327_current_value current_value_fast;
|
||||
elm327_current_value current_value_slow;
|
||||
|
||||
char bt_states[2][BT_STATE_LENGTH] = {"Initializing", "Connected"};
|
||||
|
||||
@@ -65,81 +67,24 @@ void obd2_elm327_check_connection(obd2_elm327_t *elm327)
|
||||
}
|
||||
}
|
||||
|
||||
void obd2_elm327_process(obd2_elm327_t *elm327)
|
||||
void obd2_elm327_process_fast(obd2_elm327_t *elm327)
|
||||
{
|
||||
|
||||
switch (current_value)
|
||||
switch (current_value_fast)
|
||||
{
|
||||
case RPM_V:
|
||||
{
|
||||
float rpm = elm327->elm327->rpm();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
if (rpm > 0 && rpm < RPM_MAX)
|
||||
elm327->rpm = (uint16_t)rpm;
|
||||
elm327->value_updates |= (1 << UPDATE_RPM_POS);
|
||||
current_value_fast = ENGINE_LOAD_V;
|
||||
}
|
||||
current_value = THROTTLE_V;
|
||||
break;
|
||||
}
|
||||
case THROTTLE_V:
|
||||
{
|
||||
float throttle = elm327->elm327->throttle();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
else if (elm327->elm327->nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
if (throttle > 0 && throttle <= THROTTLE_MAX)
|
||||
{
|
||||
elm327->throttle_percent = (uint8_t)throttle;
|
||||
elm327->value_updates |= (1 << UPDATE_THROTTLE_POS);
|
||||
}
|
||||
// elm327->elm327->printError();
|
||||
current_value_fast = ENGINE_LOAD_V;
|
||||
}
|
||||
// current_value = COOLANT_TEMP_V;
|
||||
//TODO remove
|
||||
current_value = RPM_V;
|
||||
break;
|
||||
}
|
||||
case COOLANT_TEMP_V:
|
||||
{
|
||||
float coolant_temp = elm327->elm327->engineCoolantTemp();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
elm327->engine_coolant_temp = (uint8_t)coolant_temp;
|
||||
elm327->value_updates |= (1 << UPDATE_COOLANT_TEMP_POS);
|
||||
}
|
||||
current_value = INTAKE_AIR_TEMP_V;
|
||||
break;
|
||||
}
|
||||
case INTAKE_AIR_TEMP_V:
|
||||
{
|
||||
float intake_air_temp = elm327->elm327->intakeAirTemp();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
elm327->intake_air_temp = (uint8_t)intake_air_temp;
|
||||
elm327->value_updates |= (1 << UPDATE_INTAKE_AIR_TEMP_POS);
|
||||
}
|
||||
current_value = AMBIENT_AIR_TEMP_V;
|
||||
break;
|
||||
}
|
||||
case AMBIENT_AIR_TEMP_V:
|
||||
{
|
||||
float ambient_air_temp = elm327->elm327->ambientAirTemp();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
elm327->ambient_air_temp = (uint8_t)ambient_air_temp;
|
||||
elm327->value_updates |= (1 << UPDATE_AMBIENT_AIR_TEMP_POS);
|
||||
}
|
||||
current_value = OIL_TEMP_V;
|
||||
break;
|
||||
}
|
||||
case OIL_TEMP_V:
|
||||
{
|
||||
float engine_oil_temp = elm327->elm327->oilTemp();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
elm327->engine_oil_temp = engine_oil_temp;
|
||||
elm327->value_updates |= (1 << UPDATE_OIL_TEMP_POS);
|
||||
}
|
||||
current_value = ENGINE_LOAD_V;
|
||||
break;
|
||||
}
|
||||
case ENGINE_LOAD_V:
|
||||
@@ -149,19 +94,13 @@ void obd2_elm327_process(obd2_elm327_t *elm327)
|
||||
{
|
||||
elm327->engine_load = (uint8_t)engine_load;
|
||||
elm327->value_updates |= (1 << UPDATE_ENGINE_LOAD_POS);
|
||||
current_value_fast = FUEL_PRESSURE_V;
|
||||
}
|
||||
current_value = BATTERY_VOLTAGE_V;
|
||||
break;
|
||||
}
|
||||
case BATTERY_VOLTAGE_V:
|
||||
{
|
||||
float battery_voltage = elm327->elm327->batteryVoltage();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
else if (elm327->elm327->nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
elm327->battery_voltage = battery_voltage;
|
||||
elm327->value_updates |= (1 << UPDATE_BATTERY_VOLTAGE_POS);
|
||||
// elm327->elm327->printError();
|
||||
current_value_fast = FUEL_PRESSURE_V;
|
||||
}
|
||||
current_value = FUEL_PRESSURE_V;
|
||||
break;
|
||||
}
|
||||
case FUEL_PRESSURE_V:
|
||||
@@ -169,21 +108,15 @@ void obd2_elm327_process(obd2_elm327_t *elm327)
|
||||
float fuel_pressure = elm327->elm327->fuelPressure();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
elm327->fuel_pressure = fuel_pressure;
|
||||
elm327->fuel_pressure = (uint16_t)fuel_pressure;
|
||||
elm327->value_updates |= (1 << UPDATE_FUEL_PRESSURE_POS);
|
||||
current_value_fast = MANIFOLD_PRESSURE_V;
|
||||
}
|
||||
current_value = SPEED_V;
|
||||
break;
|
||||
}
|
||||
case SPEED_V:
|
||||
{
|
||||
float speed = elm327->elm327->mph();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
else if (elm327->elm327->nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
elm327->speed = (uint8_t)(speed * KM_IN_MILES);
|
||||
elm327->value_updates |= (1 << UPDATE_SPEED_POS);
|
||||
// elm327->elm327->printError();
|
||||
current_value_fast = MANIFOLD_PRESSURE_V;
|
||||
}
|
||||
current_value = MANIFOLD_PRESSURE_V;
|
||||
break;
|
||||
}
|
||||
case MANIFOLD_PRESSURE_V:
|
||||
@@ -193,8 +126,101 @@ void obd2_elm327_process(obd2_elm327_t *elm327)
|
||||
{
|
||||
elm327->manifold_pressure = (uint8_t)manifold_pressure;
|
||||
elm327->value_updates |= (1 << UPDATE_MANIFOLD_PRESSURE_POS);
|
||||
current_value_fast = RPM_V;
|
||||
}
|
||||
else if (elm327->elm327->nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
// elm327->elm327->printError();
|
||||
current_value_fast = RPM_V;
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void obd2_elm327_process_slow(obd2_elm327_t *elm327)
|
||||
{
|
||||
|
||||
switch (current_value_slow)
|
||||
{
|
||||
case COOLANT_TEMP_V:
|
||||
{
|
||||
float coolant_temp = elm327->elm327->engineCoolantTemp();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
elm327->engine_coolant_temp = (uint8_t)coolant_temp;
|
||||
elm327->value_updates |= (1 << UPDATE_COOLANT_TEMP_POS);
|
||||
current_value_slow = INTAKE_AIR_TEMP_V;
|
||||
}
|
||||
else if (elm327->elm327->nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
// elm327->elm327->printError();
|
||||
current_value_slow = INTAKE_AIR_TEMP_V;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case INTAKE_AIR_TEMP_V:
|
||||
{
|
||||
float intake_air_temp = elm327->elm327->intakeAirTemp();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
elm327->intake_air_temp = (uint8_t)intake_air_temp;
|
||||
elm327->value_updates |= (1 << UPDATE_INTAKE_AIR_TEMP_POS);
|
||||
current_value_slow = AMBIENT_AIR_TEMP_V;
|
||||
}
|
||||
else if (elm327->elm327->nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
// elm327->elm327->printError();
|
||||
current_value_slow = AMBIENT_AIR_TEMP_V;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case AMBIENT_AIR_TEMP_V:
|
||||
{
|
||||
float ambient_air_temp = elm327->elm327->ambientAirTemp();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
elm327->ambient_air_temp = (uint8_t)ambient_air_temp;
|
||||
elm327->value_updates |= (1 << UPDATE_AMBIENT_AIR_TEMP_POS);
|
||||
current_value_slow = OIL_TEMP_V;
|
||||
}
|
||||
else if (elm327->elm327->nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
// elm327->elm327->printError();
|
||||
current_value_slow = OIL_TEMP_V;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case OIL_TEMP_V:
|
||||
{
|
||||
float engine_oil_temp = elm327->elm327->oilTemp();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
elm327->engine_oil_temp = (uint16_t)engine_oil_temp;
|
||||
elm327->value_updates |= (1 << UPDATE_OIL_TEMP_POS);
|
||||
current_value_slow = FUEL_LEVEL_V;
|
||||
}
|
||||
else if (elm327->elm327->nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
// elm327->elm327->printError();
|
||||
current_value_slow = FUEL_LEVEL_V;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case FUEL_LEVEL_V:
|
||||
{
|
||||
float fuel_level = elm327->elm327->fuelLevel();
|
||||
if (elm327->elm327->nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
elm327->fuel_level = (uint16_t)fuel_level;
|
||||
elm327->value_updates |= (1 << UPDATE_FUEL_LEVEL_POS);
|
||||
current_value_slow = COOLANT_TEMP_V;
|
||||
}
|
||||
else if (elm327->elm327->nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
// elm327->elm327->printError();
|
||||
current_value_slow = COOLANT_TEMP_V;
|
||||
}
|
||||
current_value = RPM_V;
|
||||
break;
|
||||
}
|
||||
default:
|
||||
|
||||
@@ -66,6 +66,7 @@ Be sure to disconnect the TX and RX pins from the BT module when programming the
|
||||
#define UPDATE_FUEL_PRESSURE_POS 0x08
|
||||
#define UPDATE_SPEED_POS 0x09
|
||||
#define UPDATE_MANIFOLD_PRESSURE_POS 0x0A
|
||||
#define UPDATE_FUEL_LEVEL_POS 0x0B
|
||||
|
||||
enum BluetoothState
|
||||
{
|
||||
@@ -90,12 +91,13 @@ typedef struct obt2_elm327_tag
|
||||
uint8_t engine_coolant_temp;
|
||||
uint8_t intake_air_temp;
|
||||
uint8_t ambient_air_temp;
|
||||
float engine_oil_temp;
|
||||
uint16_t engine_oil_temp;
|
||||
uint8_t engine_load;
|
||||
float battery_voltage;
|
||||
float fuel_pressure;
|
||||
uint16_t fuel_pressure;
|
||||
uint8_t speed;
|
||||
uint8_t manifold_pressure;
|
||||
uint16_t fuel_level;
|
||||
} obd2_elm327_t;
|
||||
|
||||
/**
|
||||
@@ -107,11 +109,18 @@ typedef struct obt2_elm327_tag
|
||||
char obd2_elm327_init(obd2_elm327_t *elm327);
|
||||
|
||||
/**
|
||||
* @brief processes the bluetooth module communication with the OBD2 reader
|
||||
* @brief processes the bluetooth module communication with the OBD2 reader for variables that change quickly
|
||||
*
|
||||
* @param bt pointer to struct holding bluetooth driver data
|
||||
*/
|
||||
void obd2_elm327_process(obd2_elm327_t *elm327);
|
||||
void obd2_elm327_process_fast(obd2_elm327_t *elm327);
|
||||
|
||||
/**
|
||||
* @brief processes the bluetooth module communication with the OBD2 reader for variables that change slowly
|
||||
*
|
||||
* @param bt pointer to struct holding bluetooth driver data
|
||||
*/
|
||||
void obd2_elm327_process_slow(obd2_elm327_t *elm327);
|
||||
|
||||
void obd2_elm327_check_connection(obd2_elm327_t *elm327);
|
||||
|
||||
|
||||
@@ -6,9 +6,20 @@
|
||||
|
||||
ELM327 myELM327;
|
||||
|
||||
typedef enum
|
||||
{
|
||||
ENG_COOLANT_TEMP,
|
||||
ENG_FUEL_PRESSURE,
|
||||
ENG_MANIFOLD_PRESSURE,
|
||||
RPM
|
||||
} obd2_state;
|
||||
|
||||
uint32_t rpm = 0;
|
||||
float rpm = 0;
|
||||
float cool_temp = 0;
|
||||
uint8_t man_pres = 0;
|
||||
float fuel_pres = 0;
|
||||
|
||||
obd2_state current_state = ENG_COOLANT_TEMP;
|
||||
|
||||
void setup()
|
||||
{
|
||||
@@ -46,38 +57,78 @@ void setup()
|
||||
|
||||
void loop()
|
||||
{
|
||||
float tempRPM = myELM327.rpm();
|
||||
// float t = myELM327.
|
||||
|
||||
// float tempval3 = myELM327.fuelInjectTiming();
|
||||
|
||||
if (myELM327.nb_rx_state == ELM_SUCCESS)
|
||||
switch (current_state)
|
||||
{
|
||||
rpm = (uint32_t)tempRPM;
|
||||
Serial.print("RPM: "); Serial.println(rpm);
|
||||
// Serial.print("feul t: "); Serial.println(tempval3);
|
||||
case ENG_COOLANT_TEMP:
|
||||
{
|
||||
cool_temp = myELM327.engineCoolantTemp();
|
||||
|
||||
if (myELM327.nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
Serial.print("coolant temp: ");
|
||||
Serial.println(cool_temp);
|
||||
current_state = ENG_FUEL_PRESSURE;
|
||||
}
|
||||
else if (myELM327.nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
myELM327.printError();
|
||||
//current_state = ENG_FUEL_PRESSURE;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case ENG_FUEL_PRESSURE:
|
||||
{
|
||||
fuel_pres = myELM327.fuelPressure();
|
||||
|
||||
if (myELM327.nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
Serial.print("fuel pressure: ");
|
||||
Serial.println(fuel_pres);
|
||||
current_state = ENG_MANIFOLD_PRESSURE;
|
||||
}
|
||||
else if (myELM327.nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
myELM327.printError();
|
||||
//current_state = ENG_MANIFOLD_PRESSURE;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case ENG_MANIFOLD_PRESSURE:
|
||||
{
|
||||
man_pres = myELM327.manifoldPressure();
|
||||
|
||||
if (myELM327.nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
Serial.print("manifold pressure: ");
|
||||
Serial.println(man_pres);
|
||||
current_state = RPM;
|
||||
}
|
||||
else if (myELM327.nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
myELM327.printError();
|
||||
//current_state = RPM;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case RPM:
|
||||
{
|
||||
rpm = myELM327.rpm();
|
||||
|
||||
if (myELM327.nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
Serial.print("rpm: ");
|
||||
Serial.println(rpm);
|
||||
current_state = ENG_COOLANT_TEMP;
|
||||
}
|
||||
else if (myELM327.nb_rx_state != ELM_GETTING_MSG)
|
||||
{
|
||||
myELM327.printError();
|
||||
//current_state = ENG_COOLANT_TEMP;
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
else if (myELM327.nb_rx_state != ELM_GETTING_MSG)
|
||||
myELM327.printError();
|
||||
|
||||
float tempval1 = myELM327.engineCoolantTemp();
|
||||
if (myELM327.nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
Serial.print("coolant: "); Serial.println(tempval1);
|
||||
|
||||
}
|
||||
else if (myELM327.nb_rx_state != ELM_GETTING_MSG)
|
||||
myELM327.printError();
|
||||
|
||||
float tempval2 = myELM327.oilTemp();
|
||||
|
||||
if (myELM327.nb_rx_state == ELM_SUCCESS)
|
||||
{
|
||||
Serial.print("oil: "); Serial.println(tempval2);
|
||||
|
||||
}
|
||||
else if (myELM327.nb_rx_state != ELM_GETTING_MSG)
|
||||
myELM327.printError();
|
||||
|
||||
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user