From 69a86ee38f73c197068da6c592b5279e5479b147 Mon Sep 17 00:00:00 2001
From: rusefillc <sdfsdfqsf2334234234>
Date: Fri, 4 Feb 2022 16:39:26 -0500
Subject: [PATCH] N73

---
 firmware/config/engines/bmw_n73.cpp | 87 ++++++++++++++++++-----------
 1 file changed, 54 insertions(+), 33 deletions(-)

diff --git a/firmware/config/engines/bmw_n73.cpp b/firmware/config/engines/bmw_n73.cpp
index 8bc055ed93..e57b0a6933 100644
--- a/firmware/config/engines/bmw_n73.cpp
+++ b/firmware/config/engines/bmw_n73.cpp
@@ -18,12 +18,22 @@ function twoBytes(data, offset, factor)
 		return (data[offset + 2] * 256 + data[offset + 1]) * factor
 end
 
+--
+-- crazy copy-pasta, at some point move to sets/bags
+
+tcuMessages = {}
+-- 'ecu' means not-TCU
+ecuMessages = {}
+
 CAN_BMW_E90_TORQUE_1 = 0x0A8
 CAN_BMW_E90_TORQUE_2 = 0x0A9
 CAN_BMW_E90_RPM_THROTTLE = 0x0AA
-CAN_BMW_E90_TORQUE_DEMAND = 0x0B6
+CAN_BMW_E90_DSC_TORQUE_DEMAND = 0x0B6
+CAN_BMW_E90_WHEEL_SPEED = 0x0CE
 CAN_BMW_E90_IGNITION_KEY = 0x130
 CAN_BMW_E65_GEAR_SELECTOR = 0x192
+CAN_BMW_E90_DSC_STATUS = 0x19E
+CAN_BMW_E90_DSC_SPEED = 0x1A0
 CAN_BMW_E90_COOLANT = 0x1D0
 CAN_BMW_E90_LOCKING = 0x2FC
 CAN_BMW_E90_DASH_ON = 0x332
@@ -39,10 +49,15 @@ CAN_BMW_GEAR_SERVICE = 0x598
 ECU_BUS = 1
 GEAR_BUS = 2
 
+canRxAdd(CAN_BMW_E90_TORQUE_1)
+canRxAdd(CAN_BMW_E90_TORQUE_2)
 canRxAdd(CAN_BMW_E90_RPM_THROTTLE)
-canRxAdd(CAN_BMW_E90_TORQUE_DEMAND)
+canRxAdd(CAN_BMW_E90_DSC_TORQUE_DEMAND)
+canRxAdd(CAN_BMW_E90_WHEEL_SPEED)
 canRxAdd(CAN_BMW_E90_IGNITION_KEY)
 canRxAdd(CAN_BMW_E65_GEAR_SELECTOR)
+canRxAdd(CAN_BMW_E90_DSC_STATUS)
+canRxAdd(CAN_BMW_E90_DSC_SPEED)
 canRxAdd(CAN_BMW_E90_COOLANT)
 canRxAdd(CAN_BMW_E90_LOCKING)
 canRxAdd(CAN_BMW_E90_DASH_ON)
@@ -56,12 +71,14 @@ canRxAdd(CAN_BMW_GEAR_NETWORK)
 canRxAdd(CAN_BMW_GEAR_SERVICE)
 
 
-txPayload = { }
-
 function relayToTcu(id, data)
 	txCan(GEAR_BUS, id, 0, data) -- relay non-TCU message to TCU
 end
 
+function relayToEcu(id, data)
+	txCan(ECU_BUS, id, 0, data) -- relay non-ECU message to ECU
+end
+
 function printDebug(msg)
     print(msg)
 end
@@ -70,10 +87,7 @@ function onCanRx(bus, id, dlc, data)
 	id = id % 2048
 	-- local output = string.format("%x", id)
 
-	if id == CAN_BMW_E90_IGNITION_KEY then
-		printDebug('!!!!!!!!!!!!! CAN_BMW_E90_IGNITION_KEY')
-		relayToTcu(id, data)
-    elseif id == CAN_BMW_E90_TORQUE_1 then
+	if id == CAN_BMW_E90_TORQUE_1 then
 		TORQ_AVL = 0.5 * (twoBytes(data, 1, 1) >> 4)
 		TORQ_AVL_DMEE = 0.5 * (twoBytes(data, 3, 1) >> 4)
 		print('CAN_BMW_E90_TORQUE_1 TORQ_AVL=' .. TORQ_AVL .. ' TORQ_AVL_DMEE=' .. TORQ_AVL_DMEE)
@@ -81,49 +95,58 @@ function onCanRx(bus, id, dlc, data)
     elseif id == CAN_BMW_E90_TORQUE_2 then
 		printDebug('CAN_BMW_E90_TORQUE_2')
 		relayToTcu(id, data)
-    elseif id == CAN_BMW_E90_TORQUE_DEMAND then
-		printDebug('CAN_BMW_E90_TORQUE_DEMAND')
-		relayToTcu(id, data)
-    elseif id == CAN_BMW_E90_DASH_ON then
-		printDebug('CAN_BMW_E90_DASH_ON')
-		relayToTcu(id, data)
-	elseif id == CAN_BMW_E65_GEAR_SELECTOR then
-		printDebug('CAN_BMW_E65_GEAR_SELECTOR')
-		relayToTcu(id, data)
-	elseif id == CAN_BMW_E65_GEAR_SELECTOR then
-		printDebug('CAN_BMW_E65_GEAR_SELECTOR')
-		relayToTcu(id, data)
 	elseif id == CAN_BMW_E90_RPM_THROTTLE then
 		rpm = twoBytes(data, 4, 0.25)
 		print('CAN_BMW_E90_RPM_THROTTLE rpm=' .. rpm)
 		relayToTcu(id, data)
+    elseif id == CAN_BMW_E90_DSC_TORQUE_DEMAND then
+		printDebug('CAN_BMW_E90_DSC_TORQUE_DEMAND')
+		relayToTcu(id, data)
+    elseif id == CAN_BMW_E90_WHEEL_SPEED then
+		printDebug('CAN_BMW_E90_WHEEL_SPEED')
+		relayToTcu(id, data)
+    elseif id == CAN_BMW_E90_IGNITION_KEY then
+    	printDebug('!!!!!!!!!!!!! CAN_BMW_E90_IGNITION_KEY')
+    	relayToTcu(id, data)
+	elseif id == CAN_BMW_E65_GEAR_SELECTOR then
+		printDebug('CAN_BMW_E65_GEAR_SELECTOR')
+		relayToTcu(id, data)
+	elseif id == CAN_BMW_E90_DSC_STATUS then
+		printDebug('CAN_BMW_E90_DSC_STATUS')
+		relayToTcu(id, data)
+	elseif id == CAN_BMW_E90_DSC_SPEED then
+		printDebug('CAN_BMW_E90_DSC_SPEED')
+		relayToTcu(id, data)
 	elseif id == CAN_BMW_E90_COOLANT then
 		printDebug('CAN_BMW_E90_COOLANT')
 		relayToTcu(id, data)
 	elseif id == CAN_BMW_E90_LOCKING then
 		printDebug('CAN_BMW_E90_LOCKING')
 		relayToTcu(id, data)
+    elseif id == CAN_BMW_E90_DASH_ON then
+		printDebug('CAN_BMW_E90_DASH_ON')
+		relayToTcu(id, data)
 	elseif id == CAN_BMW_GEAR_TORQUE_DEMAND2 then
 		printDebug('*******CAN_BMW_GEAR_TORQUE_DEMAND2')
-		txCan(ECU_BUS, id, 0, data) -- relay TCU message to non-TCU
+		relayToEcu(id, data)
 	elseif id == CAN_BMW_GEAR_TRANSMISSION_DATA then
 		printDebug('*******CAN_BMW_GEAR_TRANSMISSION_DATA')
-		txCan(ECU_BUS, id, 0, data) -- relay TCU message to non-TCU
-	elseif id == CAN_BMW_GEAR_TRANSMISSION_DISP then
-		printDebug('*******CAN_BMW_GEAR_TRANSMISSION_DISP')
-		txCan(ECU_BUS, id, 0, data) -- relay TCU message to non-TCU
-	elseif id == CAN_BMW_GEAR_GANG_STATUS then
-		printDebug('*******CAN_BMW_GEAR_GANG_STATUS')
-		txCan(ECU_BUS, id, 0, data) -- relay TCU message to non-TCU
+		relayToEcu(id, data)
 	elseif id == CAN_BMW_GEAR_GEARBOX_DATA_2 then
 		printDebug('CAN_BMW_GEAR_GEARBOX_DATA_2')
-		txCan(ECU_BUS, id, 0, data) -- relay TCU message to non-TCU
+		relayToEcu(id, data)
+	elseif id == CAN_BMW_GEAR_TRANSMISSION_DISP then
+		printDebug('*******CAN_BMW_GEAR_TRANSMISSION_DISP')
+		relayToEcu(id, data)
+	elseif id == CAN_BMW_GEAR_GANG_STATUS then
+		printDebug('*******CAN_BMW_GEAR_GANG_STATUS')
+		relayToEcu(id, data)
 	elseif id == CAN_BMW_GEAR_NETWORK then
 		printDebug('CAN_BMW_GEAR_NETWORK')
-		txCan(ECU_BUS, id, 0, data) -- relay TCU message to non-TCU
+		relayToEcu(id, data)
 	elseif id == CAN_BMW_GEAR_SERVICE then
 		printDebug('CAN_BMW_GEAR_SERVICE')
-		txCan(ECU_BUS, id, 0, data) -- relay TCU message to non-TCU
+		relayToEcu(id, data)
 	else
         print('No handler for ' .. id)
 	end
@@ -132,8 +155,6 @@ function onCanRx(bus, id, dlc, data)
 end
 
 function onTick()
-	-- 	txCan(1, 0x611, 1, txPayload)
-	-- 	txCan(2, 0x612, 1, txPayload)
 end
 
 )", efi::size(config->luaScript));