From 0c1ac0c932f87017dbeda25784a988907b20f662 Mon Sep 17 00:00:00 2001
From: rusefi <rusefillc@gmail.com>
Date: Mon, 7 Sep 2020 16:25:00 -0400
Subject: [PATCH] microRusEFI used as Body Control Module BCM BCU

---
 firmware/config/boards/microrusefi/compile_mre_f4.sh | 2 +-
 firmware/controllers/sensors/can_sensor.h            | 3 +++
 firmware/init/sensor/init_can_sensors.cpp            | 6 +++---
 3 files changed, 7 insertions(+), 4 deletions(-)

diff --git a/firmware/config/boards/microrusefi/compile_mre_f4.sh b/firmware/config/boards/microrusefi/compile_mre_f4.sh
index 5d00d07f33..818e95e853 100644
--- a/firmware/config/boards/microrusefi/compile_mre_f4.sh
+++ b/firmware/config/boards/microrusefi/compile_mre_f4.sh
@@ -6,6 +6,6 @@ export PROJECT_BOARD=microrusefi
 export PROJECT_CPU=ARCH_STM32F4
 export EXTRA_PARAMS="-DSHORT_BOARD_NAME=mre_f4"
 
-
+# export DEBUG_LEVEL_OPT="-O0 -ggdb -g3"
 
 bash config/boards/common_make.sh
diff --git a/firmware/controllers/sensors/can_sensor.h b/firmware/controllers/sensors/can_sensor.h
index 484c9f062c..0a6ac99b8f 100644
--- a/firmware/controllers/sensors/can_sensor.h
+++ b/firmware/controllers/sensors/can_sensor.h
@@ -112,6 +112,9 @@ public:
 			msg[1] = OBD_CURRENT_DATA;
 			msg[2] = PID;
 		}
+		// let's sleep on write update after each OBD request, this would give read thread a chance to read response
+		// todo: smarter logic of all this with with semaphore not just sleep
+		chThdSleepMilliseconds(300);
 		return m_next;
 	}
 
diff --git a/firmware/init/sensor/init_can_sensors.cpp b/firmware/init/sensor/init_can_sensors.cpp
index 64d994cd9d..7f6e085642 100644
--- a/firmware/init/sensor/init_can_sensors.cpp
+++ b/firmware/init/sensor/init_can_sensors.cpp
@@ -48,9 +48,9 @@ void initCanSensors() {
 	if (CONFIG(consumeObdSensors)) {
 //		registerCanSensor(canPedalSensor);
 		registerCanSensor(obdRpmSensor);
-//		registerCanSensor(obdCltSensor);
-		//		registerCanSensor(obdIatSensor);
-		//		registerCanSensor(obdTpsSensor);
+		registerCanSensor(obdCltSensor);
+		registerCanSensor(obdIatSensor);
+		registerCanSensor(obdTpsSensor);
 	}
 }
 #endif // EFI_CAN_SUPPORT