olivier flayols
scania 124L dashboard for ETS2
Diff: main.cpp
- Revision:
- 0:bf6a96c707f6
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Sun Feb 18 10:53:44 2018 +0000
@@ -0,0 +1,177 @@
+#include "mbed.h"
+#include "FastPWM.h"
+
+Serial COM(USBTX, USBRX);
+
+DigitalOut batterie (D4);
+DigitalOut air_brake (D5);
+DigitalOut parking_brake (D6);
+DigitalOut oil (D7);
+
+DigitalOut dash_on (A0);
+DigitalOut light_on (A1);
+DigitalOut spliter_light (A2);
+DigitalOut blinkers (A3);
+DigitalOut retarder_light (A4);
+DigitalOut high_beam_light (A5);
+
+FastPWM fuel_pwm (PA_11);
+FastPWM water_pwm (D2);
+FastPWM air_pwm (D3);
+FastPWM oil_pwm (D8);
+FastPWM speed_pulse (D9);
+FastPWM batterie_neg (D10);
+FastPWM batterie_pos (D11);
+FastPWM buzzer (D13);
+FastPWM rpm_pulse (D14);
+
+int serial_byte;
+int prev_rpm;
+float prev_speed;
+
+float map(float x, float in_min, float in_max, float out_min, float out_max)
+{
+ return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min;
+}
+
+int Serial_data[41];
+bool OCTET0[8];
+bool OCTET1[8];
+bool OCTET2[8];
+
+enum OCTET0{brake_air_press_warning, park_brake, high_beam, low_beam, right_blinker, left_blinker, light_parking};
+enum OCTET1{water_temperature_warning, oil_pressure_warning, batterie_voltage_warning, fuel_warning, brake_air_emergency, motor_brake, light_reverse};
+enum OCTET2{engine_enabled, electric_enabled, left_blinker_state, right_blinker_state, NOK1, light_brake, trailer_connected};
+enum Serial_data {speed_ms, LSB_rpm, MSB_rpm, air_pressure, fuel_int, oil_pressure_int, oil_temperature_int, water_temperature_int, batterie_voltage_int, average_cosumption_int, adblue, engine_gear, effective_throttle, LSB_Fuel_liters, MSB_Fuel_liters, odometer_split_1,
+ odometer_split_2, odometer_split_3, odometer_split_4, game_time_split_1, game_time_split_2, game_time_split_3, game_time_split_4, next_rest_stop_split_1, next_rest_stop_split_2, next_rest_stop_split_3, next_rest_stop_split_4, cruise_control,
+ retarder_steps, decimal_oil_pressure, decimal_battery_voltage, decimal_average_consumption, speed_ms_decimal, decimal_fuel_liters, decimal_odometer, decimal_water_temperature, decimal_fuel, decimal_engine_rpm, OCTET_0, OCTET_1, OCTET_2};
+
+float fuel_level_needle[100] ={0.97,0.9652,0.9604,0.9556,0.9508,0.946,0.9412,0.9364,0.9316,0.9268,0.922,0.9172,0.9124,0.9076,0.9028,0.898,0.8932,0.8884,0.8836,0.8788,0.874,0.8692,0.8644,0.8596,0.85,0.8448,0.8396,0.8344,0.8292,0.824,0.8188,0.8136,0.8084,0.8032,0.798,0.7928,0.7876,0.7824,0.7772,0.772,0.7668,0.7616,0.7564,0.7512,0.746,0.7408,0.7356,0.7304,0.7252,0.72,0.7168,0.7136,0.7104,0.7072,0.704,0.7008,0.6976,0.6944,0.6912,0.688,0.6848,0.6816,0.6784,0.6752,0.672,0.6688,0.6656,0.6624,0.6592,0.656,0.6528,0.6496,0.6464,0.6432,0.64,0.6384,0.6368,0.6352,0.6336,0.632,0.6304,0.6288,0.6272,0.6256,0.624,0.6224,0.6208,0.6192,0.6176,0.616,0.6144,0.6128,0.6112,0.6096,0.608,0.6064,0.6048,0.6032,0.6016,0.6};
+float air_pressure_needle[150] ={0.95,0.9424,0.9348,0.9272,0.9196,0.912,0.9044,0.8968,0.8892,0.8816,0.874,0.8664,0.8588,0.8512,0.8436,0.836,0.8284,0.8208,0.8132,0.8056,0.798,0.7904,0.7828,0.7752,0.76,0.7541,0.7482,0.7423,0.7364,0.7305,0.7246,0.7187,0.7128,0.7069,0.701,0.6951,0.6892,0.6833,0.6774,0.6715,0.6656,0.6597,0.6538,0.6479,0.642,0.6361,0.6302,0.63,0.6267,0.6234,0.6201,0.6168,0.6135,0.6102,0.6069,0.6036,0.6003,0.597,0.5937,0.5904,0.5871,0.5838,0.5805,0.5772,0.5739,0.5706,0.5673,0.564,0.5607,0.5574,0.5541,0.55,0.5484,0.5468,0.5452,0.5436,0.542,0.5404,0.5388,0.5372,0.5356,0.534,0.5324,0.5308,0.5292,0.5276,0.526,0.5244,0.5228,0.5212,0.5196,0.518,0.5164,0.5148,0.5132,0.51,0.50917,0.50834,0.50751,0.50668,0.50585,0.50502,0.50419,0.50336,0.50253,0.5017,0.50087,0.50004,0.49921,0.49838,0.49755,0.49672,0.49589,0.49506,0.49423,0.4934,0.49257,0.49174,0.49091,0.49,0.48917,0.48834,0.48751,0.48668,0.48585,0.48502,0.48419,0.48336,0.48253,0.4817,0.48087,0.48004,0.47921,0.47838,0.47755,0.47672,0.47589,0.47506,0.47423,0.4734,0.47257,0.47174,0.47091,0.47,0.47,0.47,0.47,0.47,0.47,0.47};
+float water_temperature_needle[120] ={0.7,0.705,0.71,0.715,0.72,0.725,0.73,0.735,0.74,0.745,0.75,0.755,0.76,0.765,0.77,0.775,0.78,0.785,0.79,0.795,0.8,0.805,0.81,0.815,0.82,0.825,0.83,0.835,0.84,0.845,0.85,0.855,0.86,0.865,0.87,0.875,0.88,0.885,0.89,0.9,0.901,0.902,0.903,0.904,0.905,0.906,0.907,0.908,0.909,0.91,0.911,0.912,0.913,0.914,0.915,0.916,0.917,0.918,0.919,0.92,0.921,0.922,0.923,0.924,0.925,0.926,0.927,0.928,0.929,0.93,0.931,0.932,0.933,0.934,0.935,0.936,0.937,0.938,0.939,0.94,0.94135,0.9427,0.94405,0.9454,0.94675,0.9481,0.94945,0.9508,0.95215,0.9535,0.95485,0.9562,0.95755,0.9589,0.96025,0.9616,0.96295,0.9643,0.96565,0.967,0.968,0.969,0.97,0.971,0.972,0.973,0.974,0.975,0.976,0.977,0.978,0.979,0.98,0.981,0.982,0.983,0.984,0.985,0.986,0.987};
+float oil_pressure_needle[86] ={0.97,0.9637,0.9574,0.9511,0.9448,0.9385,0.9322,0.9259,0.9196,0.9133,0.9,0.8928,0.8856,0.8784,0.8712,0.864,0.8568,0.8496,0.8424,0.8352,0.828,0.82,0.8145,0.809,0.8035,0.798,0.7925,0.787,0.7815,0.776,0.7705,0.765,0.76,0.7563,0.7526,0.7489,0.7452,0.7415,0.7378,0.7341,0.7304,0.7267,0.723,0.72,0.7168,0.7136,0.7104,0.7072,0.704,0.7008,0.6976,0.6944,0.6912,0.688,0.685,0.6828,0.6806,0.6784,0.6762,0.674,0.6718,0.6696,0.6674,0.6652,0.663,0.6608,0.6586,0.6564,0.6542,0.652,0.6498,0.6476,0.6454,0.6432,0.641,0.6388,0.6366,0.6344,0.6322,0.63,0.63,0.63,0.63,0.63,0.63,0.63};
+
+int main()
+{
+ COM.baud(115200);
+ COM.format(8, SerialBase::None, 1);
+
+ //initialisation...
+ dash_on = 1;
+ light_on = 0;
+ batterie = 0;
+ oil = 0;
+ parking_brake = 0;
+ air_brake = 0;
+ blinkers = 0;
+ retarder_light = 0;
+ high_beam_light = 0;
+ spliter_light = 0;
+
+ //speed set at 0KM/H
+ speed_pulse.period_us (200000);
+ speed_pulse.write (0.50f);
+
+ //set water, baterie(-), oil PWM frequency at 887Hz (timer1 linked)
+ water_pwm.period_us (200); // 887Hz
+ water_pwm.write (0.30f);
+ oil_pwm.write (0.97f);
+
+ //buzzer configuration...frequency set for air,fuel, buzzer PWM (timer2 linked)
+ buzzer.period_us (2257); // 887Hz
+ buzzer.write (0.0f);
+
+ fuel_pwm.write (0.97f);
+ air_pwm.write (0.95f);
+
+ while(1) {
+
+
+ if(COM.readable()) {
+
+ serial_byte = COM.getc();
+
+ if(serial_byte != 0xFF) {
+ return;
+ }
+
+ serial_byte = COM.getc();
+
+ if(serial_byte != 0x02) {
+ return;
+ }
+
+ for (int i = 0; i<41; i++)
+ {
+ Serial_data[i] = COM.getc();
+ }
+
+ for(int i = 0; i < 8; i ++)
+ {
+ OCTET0[i] = ((int (Serial_data[OCTET_0]) >> i) & 0x01);
+ OCTET1[i] = ((int (Serial_data[OCTET_1]) >> i) & 0x01);
+ OCTET2[i] = ((int (Serial_data[OCTET_2]) >> i) & 0x01);
+ }
+
+
+ float rpm = ((Serial_data[MSB_rpm] << 8) + Serial_data[LSB_rpm]) + (decimal_engine_rpm);
+ float speed_kph = (Serial_data[speed_ms] + (Serial_data[speed_ms_decimal] / 100.0))*3.60f;
+
+ if (Serial_data[retarder_steps] > 1)
+ Serial_data[retarder_steps] = 1;
+
+
+
+//-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
+
+ light_on = OCTET0[light_parking];
+ dash_on = OCTET2[electric_enabled];
+ batterie = OCTET1[batterie_voltage_warning];
+ oil = OCTET1[oil_pressure_warning];
+ parking_brake = OCTET0[park_brake];
+ air_brake = OCTET0[brake_air_press_warning];
+ blinkers = (OCTET0[left_blinker] || OCTET0[right_blinker]);
+ retarder_light = Serial_data[retarder_steps];
+ high_beam_light = OCTET0[high_beam];
+ spliter_light = (Serial_data[engine_gear] & 0x01);
+
+ if(OCTET0[brake_air_press_warning] == 1){
+ buzzer.write(0.50f);
+ }else{
+ buzzer.write(0);
+ }
+
+ oil_pwm.write (oil_pressure_needle[Serial_data[oil_pressure_int]]);
+ air_pwm.write (air_pressure_needle[Serial_data[air_pressure]]);
+ fuel_pwm.write (fuel_level_needle[Serial_data[fuel_int]]);
+ water_pwm.write (water_temperature_needle[Serial_data[water_temperature_int]]);
+ batterie_neg.write (0);
+ batterie_pos.write (map(Serial_data[batterie_voltage_int], 0.0, 25.0, 0.00, 1.00) && OCTET2[electric_enabled]);
+
+ float period;
+
+ if ((rpm > 200) && (rpm != prev_rpm)){
+ prev_rpm = rpm;
+ rpm = map(rpm, 200.0, 3000.0, 20.0, 1030.0);
+ period = (1.000000f/rpm);
+ rpm_pulse.period_us(double(period)*1000000);
+ rpm_pulse.write(0.50f);
+
+ }
+
+ if(engine_gear == 13 || engine_gear == 14){
+ speed_kph = 0.0f;
+ }
+
+ if(speed_kph != prev_speed){
+ prev_speed = speed_kph;
+ speed_kph = map(speed_kph, 0, 120, 5, 160);
+ period = (1.000000f/speed_kph);
+ speed_pulse.period_us(double(period)*1000000);
+ speed_pulse.write(0.50f);
+ }
+
+
+ }
+ }
+}