rusefi_documentation/B6-temp.md

148 lines
3.6 KiB
Markdown
Raw Normal View History

2022-08-25 09:53:01 -07:00
```
2022-08-26 19:25:22 -07:00
MOTOR_1 = 0x280
MOTOR_3 = 0x380
MOTOR_INFO = 0x580
MOTOR_5 = 0x480
MOTOR_6 = 0x488
MOTOR_7 = 0x588
2022-08-25 09:53:01 -07:00
function getBitRange(data, bitIndex, bitWidth)
byteIndex = bitIndex >> 3
shift = bitIndex - byteIndex * 8
value = data[1 + byteIndex]
if (shift + bitWidth > 8) then
value = value + data[2 + byteIndex] * 256
end
mask = (1 << bitWidth) - 1
return (value >> shift) & mask
end
-- sometimes we want to cut a CAN bus and install rusEFI into that cut
-- https://en.wikipedia.org/wiki/Man-in-the-middle_attack
-- this controls onCanRx rate as well!
setTickRate(300)
ECU_BUS = 1
-- really 'not ECU'
TCU_BUS = 2
2022-08-26 18:29:50 -07:00
function setTwoBytes(data, offset, value)
value = math.floor(value)
data[offset + 2] = value >> 8
data[offset + 1] = value & 0xff
end
2022-08-25 09:53:01 -07:00
hexstr = { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, "A", "B", "C", "D", "E", "F" }
function toHexString(num)
if num == 0 then
return '0'
end
local result = ""
while num > 0 do
local n = num % 16
result = hexstr[n + 1] ..result
num = math.floor(num / 16)
end
return result
end
function arrayToString(arr)
local str = ""
local index = 1
while arr[index] ~= nil do
str = str.." "..toHexString(arr[index])
index = index + 1
end
return str
end
totalEcuMessages = 0
totalTcuMessages = 0
2022-08-26 18:29:50 -07:00
motor1Data = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }
2022-08-28 09:52:45 -07:00
canMotorInfo = { 0x00, 0x00, 0x00, 0x14, 0x1C, 0x93, 0x48, 0x14 }
2022-08-26 18:29:50 -07:00
2022-08-25 09:53:01 -07:00
function onMotor1(bus, id, dlc, data)
rpm = getBitRange(data, 16, 16) * 0.25
tps = getBitRange(data, 40, 8) * 0.4
2022-08-25 17:15:25 -07:00
2022-08-26 19:12:17 -07:00
fakeTorque = interpolate(0, 6, 100, 60, tps)
2022-08-26 18:29:50 -07:00
-- engineTorque = getBitRange(data, 8, 8) * 0.39
-- innerTorqWithoutExt = getBitRange(data, 32, 8) * 0.4
-- torqueLoss = getBitRange(data, 48, 8) * 0.39
-- requestedTorque = getBitRange(data, 56, 8) * 0.39
2022-08-26 19:12:17 -07:00
engineTorque = fakeTorque
innerTorqWithoutExt = fakeTorque
torqueLoss = 10
requestedTorque = fakeTorque
2022-08-26 18:29:50 -07:00
motor1Data[2] = engineTorque / 0.39
setTwoBytes(motor1Data, 2, rpm / 0.25)
motor1Data[5] = innerTorqWithoutExt / 0.4
motor1Data[6] = tps / 0.4
motor1Data[7] = torqueLoss / 0.39
motor1Data[8] = requestedTorque / 0.39
2022-08-26 19:12:17 -07:00
print ('fakeTorque ' .. fakeTorque)
2022-08-25 09:53:01 -07:00
print ('engineTorque ' .. engineTorque .. ' RPM ' .. rpm)
2022-08-25 17:15:25 -07:00
print ('innerTorqWithoutExt ' .. innerTorqWithoutExt .. ' tps ' .. tps)
2022-08-26 19:17:30 -07:00
print ('torqueLoss ' .. torqueLoss .. ' requestedTorque ' .. requestedTorque)
2022-08-26 19:12:17 -07:00
txCan(TCU_BUS, id, 0, motor1Data)
2022-08-25 09:53:01 -07:00
end
function printAndDrop(bus, id, dlc, data)
print('Dropping ' ..arrayToString(data))
end
function onAnythingFromECU(bus, id, dlc, data)
totalEcuMessages = totalEcuMessages + 1
txCan(TCU_BUS, id, 0, data) -- relay non-TCU message to TCU
end
function onAnythingFromTCU(bus, id, dlc, data)
totalTcuMessages = totalTcuMessages + 1
txCan(ECU_BUS, id, 0, data) -- relay non-ECU message to ECU
end
-- VAG Motor_1 just as example
2022-08-28 09:52:45 -07:00
canRxAdd(ECU_BUS, MOTOR_1, onMotor1)
-- canRxAdd(ECU_BUS, MOTOR_3, printAndDrop)
-- canRxAdd(ECU_BUS, MOTOR_5, printAndDrop)
-- canRxAdd(ECU_BUS, MOTOR_6, printAndDrop)
-- canRxAdd(ECU_BUS, MOTOR_7, printAndDrop)
2022-08-25 09:53:01 -07:00
-- last option: unconditional forward of all remaining messages
canRxAddMask(ECU_BUS, 0, 0, onAnythingFromECU)
canRxAddMask(TCU_BUS, 0, 0, onAnythingFromTCU)
everySecondTimer = Timer.new()
2022-08-28 10:40:57 -07:00
canMotorInfoCounter = 0
2022-08-25 09:53:01 -07:00
function onTick()
if everySecondTimer:getElapsedSeconds() > 1 then
everySecondTimer:reset()
print("Total from ECU " .. totalEcuMessages .. " from TCU " .. totalTcuMessages)
2022-08-28 09:52:45 -07:00
2022-08-28 10:40:57 -07:00
canMotorInfoCounter = (canMotorInfoCounter + 1) % 8
canMotorInfo[1] = 0x90 + (canMotorInfoCounter * 2)
-- txCan(1, MOTOR_INFO, 0, canMotorInfo)
2022-08-28 09:52:45 -07:00
2022-08-25 09:53:01 -07:00
end
end
```