206 lines
5.3 KiB
Markdown
206 lines
5.3 KiB
Markdown
```
|
|
|
|
MOTOR_1 = 0x280
|
|
MOTOR_3 = 0x380
|
|
MOTOR_INFO = 0x580
|
|
MOTOR_5 = 0x480
|
|
MOTOR_6 = 0x488
|
|
MOTOR_7 = 0x588
|
|
|
|
|
|
fuelCounter = 0;
|
|
|
|
function xorChecksum(data, targetIndex)
|
|
local index = 1
|
|
local result = 0
|
|
while data[index] ~= nil do
|
|
if index ~= targetIndex then
|
|
result = result ~ data[index]
|
|
end
|
|
index = index + 1
|
|
end
|
|
data[targetIndex] = result
|
|
return result
|
|
end
|
|
|
|
function setBitRange(data, totalBitIndex, bitWidth, value)
|
|
local byteIndex = totalBitIndex >> 3
|
|
local bitInByteIndex = totalBitIndex - byteIndex * 8
|
|
if (bitInByteIndex + bitWidth > 8) then
|
|
bitsToHandleNow = 8 - bitInByteIndex
|
|
setBitRange(data, totalBitIndex + bitsToHandleNow, bitWidth - bitsToHandleNow, value >> bitsToHandleNow)
|
|
bitWidth = bitsToHandleNow
|
|
end
|
|
mask = (1 << bitWidth) - 1
|
|
data[1 + byteIndex] = data[1 + byteIndex] & (~(mask << bitInByteIndex))
|
|
maskedValue = value & mask
|
|
shiftedValue = maskedValue << bitInByteIndex
|
|
data[1 + byteIndex] = data[1 + byteIndex] | shiftedValue
|
|
end
|
|
|
|
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
|
|
|
|
function setTwoBytes(data, offset, value)
|
|
value = math.floor(value)
|
|
data[offset + 2] = value >> 8
|
|
data[offset + 1] = value & 0xff
|
|
end
|
|
|
|
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
|
|
|
|
motor1Data = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }
|
|
canMotorInfo = { 0x00, 0x00, 0x00, 0x14, 0x1C, 0x93, 0x48, 0x14 }
|
|
canMotor3 = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }
|
|
motor5Data = { 0x1C, 0x08, 0xF3, 0x55, 0x19, 0x00, 0x00, 0xAD}
|
|
motor6Data = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }
|
|
motor7Data = { 0x1A, 0x66, 0x7E, 0x00, 0x00, 0x00, 0x00, 0x00 }
|
|
|
|
function onMotor1(bus, id, dlc, data)
|
|
rpm = getBitRange(data, 16, 16) * 0.25
|
|
tps = getBitRange(data, 40, 8) * 0.4
|
|
|
|
fakeTorque = interpolate(0, 6, 100, 60, tps)
|
|
|
|
-- 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
|
|
|
|
engineTorque = fakeTorque
|
|
innerTorqWithoutExt = fakeTorque
|
|
torqueLoss = 10
|
|
requestedTorque = fakeTorque
|
|
|
|
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
|
|
|
|
print ('fakeTorque ' ..fakeTorque)
|
|
print ('engineTorque ' ..engineTorque ..' RPM ' ..rpm)
|
|
print ('innerTorqWithoutExt ' ..innerTorqWithoutExt ..' tps ' ..tps)
|
|
|
|
print ('torqueLoss ' ..torqueLoss ..' requestedTorque ' ..requestedTorque)
|
|
|
|
txCan(TCU_BUS, id, 0, motor1Data)
|
|
end
|
|
|
|
function onMotor3(bus, id, dlc, data)
|
|
iat = getBitRange(data, 8, 8) * 0.75 - 48
|
|
pps = getBitRange(data, 16, 8) * 0.40
|
|
tps = getBitRange(data, 56, 8) * 0.40
|
|
print ('pps ' ..pps ..' tps ' ..tps ..' iat ' ..iat)
|
|
|
|
|
|
desired_wheel_torque = fakeTorque
|
|
canMotor3[2] = (iat + 48) / 0.75
|
|
canMotor3[3] = tps / 0.4
|
|
canMotor3[5] = 0x20
|
|
setBitRange(canMotor3, 24, 12, math.floor(desired_wheel_torque / 0.39))
|
|
canMotor3[8] = tps / 0.4
|
|
txCan(TCU_BUS, id, 0, canMotor3)
|
|
end
|
|
|
|
function onMotor5(bus, id, dlc, data)
|
|
setBitRange(motor5Data, 5, 9, fuelCounter)
|
|
xorChecksum(motor5Data, 8)
|
|
txCan(TCU_BUS, id, 0, motor5Data)
|
|
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
|
|
canRxAdd(ECU_BUS, MOTOR_1, onMotor1)
|
|
|
|
canRxAdd(ECU_BUS, MOTOR_3, onMotor3)
|
|
canRxAdd(ECU_BUS, MOTOR_5, onMotor5)
|
|
canRxAdd(ECU_BUS, MOTOR_INFO, printAndDrop)
|
|
canRxAdd(ECU_BUS, MOTOR_6, printAndDrop)
|
|
canRxAdd(ECU_BUS, MOTOR_7, printAndDrop)
|
|
|
|
-- last option: unconditional forward of all remaining messages
|
|
canRxAddMask(ECU_BUS, 0, 0, onAnythingFromECU)
|
|
canRxAddMask(TCU_BUS, 0, 0, onAnythingFromTCU)
|
|
|
|
everySecondTimer = Timer.new()
|
|
canMotorInfoCounter = 0
|
|
|
|
function onTick()
|
|
if everySecondTimer : getElapsedSeconds() > 1 then
|
|
everySecondTimer : reset()
|
|
print("Total from ECU " ..totalEcuMessages .." from TCU " ..totalTcuMessages)
|
|
|
|
fuelCounter = fuelCounter + 20
|
|
|
|
|
|
canMotorInfoCounter = (canMotorInfoCounter + 1) % 8
|
|
motor7Data[1] = 0x90 + (canMotorInfoCounter * 2)
|
|
txCan(1, MOTOR_INFO, 0, motor7Data)
|
|
|
|
end
|
|
end
|
|
|
|
|
|
|
|
```
|