2022-12-04 09:28:49 -08:00
|
|
|
strncpy(config->luaScript, R"(
|
|
|
|
AIRBAG = 0x050
|
|
|
|
GRA = 0x388
|
2022-12-26 18:21:21 -08:00
|
|
|
-- 1088
|
2022-12-04 09:28:49 -08:00
|
|
|
TCU_1 = 0x440
|
2022-12-26 18:21:21 -08:00
|
|
|
-- 1344
|
2022-12-04 09:28:49 -08:00
|
|
|
TCU_2 = 0x540
|
2022-12-26 20:59:55 -08:00
|
|
|
-- 1440
|
2022-12-04 09:28:49 -08:00
|
|
|
BRAKE_2 = 0x5A0
|
|
|
|
|
|
|
|
|
2022-12-27 06:57:13 -08:00
|
|
|
-- 640
|
2022-12-04 09:28:49 -08:00
|
|
|
MOTOR_1 = 0x280
|
2022-12-28 22:35:46 -08:00
|
|
|
-- 644
|
|
|
|
MOTOR_BRE = 0x284
|
|
|
|
-- 648
|
|
|
|
MOTOR_2 = 0x288
|
2022-12-27 06:57:13 -08:00
|
|
|
-- 896
|
2022-12-04 09:28:49 -08:00
|
|
|
MOTOR_3 = 0x380
|
2022-12-28 22:35:46 -08:00
|
|
|
-- 1152
|
2022-12-04 09:28:49 -08:00
|
|
|
MOTOR_5 = 0x480
|
2022-12-27 06:57:13 -08:00
|
|
|
-- 1160
|
2022-12-04 09:28:49 -08:00
|
|
|
MOTOR_6 = 0x488
|
2022-12-29 15:13:40 -08:00
|
|
|
-- 1386
|
|
|
|
ACC_GRA = 0x56A
|
2022-12-28 22:35:46 -08:00
|
|
|
-- 1408 the one with variable payload
|
|
|
|
MOTOR_INFO = 0x580
|
|
|
|
-- 1416
|
2022-12-04 09:28:49 -08:00
|
|
|
MOTOR_7 = 0x588
|
|
|
|
|
2023-01-09 18:35:08 -08:00
|
|
|
TCU_BUS = 1
|
|
|
|
|
2022-12-27 06:57:13 -08: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
|
|
|
|
|
2022-12-26 18:21:21 -08:00
|
|
|
function onTcu1(bus, id, dlc, data)
|
2023-01-09 21:55:36 -08:00
|
|
|
-- print("onTcu1")
|
2022-12-26 18:21:21 -08:00
|
|
|
end
|
|
|
|
|
|
|
|
function onTcu2(bus, id, dlc, data)
|
2023-01-09 21:55:36 -08:00
|
|
|
-- print("onTcu2")
|
2022-12-26 18:21:21 -08:00
|
|
|
end
|
|
|
|
|
2022-12-04 09:28:49 -08:00
|
|
|
canRxAdd(AIRBAG)
|
2022-12-26 18:21:21 -08:00
|
|
|
canRxAdd(TCU_1, onTcu1)
|
|
|
|
canRxAdd(TCU_2, onTcu2)
|
2022-12-26 20:59:55 -08:00
|
|
|
-- canRxAdd(BRAKE_2)
|
2022-12-04 09:28:49 -08:00
|
|
|
|
2022-12-28 22:35:46 -08:00
|
|
|
motor5FuelCounter = 0
|
2022-12-04 09:28:49 -08:00
|
|
|
|
|
|
|
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 setTwoBytes(data, offset, value)
|
|
|
|
data[offset + 1] = value % 255
|
|
|
|
data[offset + 2] = (value >> 8) % 255
|
|
|
|
end
|
|
|
|
|
|
|
|
shallSleep = Timer.new()
|
|
|
|
|
|
|
|
-- we want to turn on with hardware switch while ignition key is off
|
|
|
|
hadIgnitionEvent = false
|
|
|
|
|
|
|
|
function onCanRx(bus, id, dlc, data)
|
|
|
|
if id == AIRBAG then
|
|
|
|
-- looks like we have ignition key do not sleep!
|
|
|
|
shallSleep : reset()
|
|
|
|
hadIgnitionEvent = true
|
|
|
|
else
|
|
|
|
print('got CAN id=' ..id ..' dlc=' ..dlc)
|
|
|
|
|
|
|
|
|
|
|
|
end
|
|
|
|
end
|
|
|
|
|
|
|
|
function setTwoBytes(data, offset, value)
|
|
|
|
value = math.floor(value)
|
|
|
|
data[offset + 2] = value >> 8
|
|
|
|
data[offset + 1] = value & 0xff
|
|
|
|
end
|
|
|
|
|
|
|
|
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 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
|
|
|
|
|
2022-12-28 22:35:46 -08:00
|
|
|
canMotor1 = { 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }
|
2022-12-29 14:48:37 -08:00
|
|
|
motorBreData = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }
|
|
|
|
motor2Data = { 0x8A, 0x8D, 0x10, 0x04, 0x00, 0x4C, 0xDC, 0x87 }
|
2023-01-09 18:35:08 -08:00
|
|
|
motor2mux = {0x8A, 0xE8, 0x2C, 0x64}
|
2022-12-04 09:28:49 -08:00
|
|
|
canMotorInfo = { 0x00, 0x00, 0x00, 0x14, 0x1C, 0x93, 0x48, 0x14 }
|
2023-01-09 18:35:08 -08:00
|
|
|
canMotorInfo1= { 0x99, 0x14, 0x00, 0x7F, 0x00, 0xF0, 0x47, 0x01 }
|
|
|
|
canMotorInfo3= { 0x9B, 0x14, 0x00, 0x11, 0x1F, 0xE0, 0x0C, 0x46 }
|
2022-12-04 09:28:49 -08:00
|
|
|
canMotor3 = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }
|
|
|
|
motor5Data = { 0x1C, 0x08, 0xF3, 0x55, 0x19, 0x00, 0x00, 0xAD }
|
2022-12-25 23:23:37 -08:00
|
|
|
motor6Data = { 0x00, 0x00, 0x00, 0x7E, 0xFE, 0xFF, 0xFF, 0x00 }
|
2022-12-29 15:13:40 -08:00
|
|
|
motor7Data = { 0x1A, 0x66, 0x7E, 0x00, 0x00, 0x00, 0x00, 0x00 }
|
|
|
|
accGraData = { 0x00, 0x00, 0x08, 0x00, 0x1A, 0x00, 0x02, 0x01 }
|
2022-12-04 09:28:49 -08:00
|
|
|
|
|
|
|
setTickRate(100)
|
|
|
|
|
|
|
|
everySecondTimer = Timer.new()
|
|
|
|
canMotorInfoCounter = 0
|
|
|
|
|
2022-12-29 14:48:37 -08:00
|
|
|
motorBreCounter = 0
|
2022-12-29 15:13:40 -08:00
|
|
|
accGraCounter = 0
|
2022-12-27 05:29:35 -08:00
|
|
|
counter16 = 0
|
2023-01-09 18:35:08 -08:00
|
|
|
motor2counter = 0
|
2022-12-04 09:28:49 -08:00
|
|
|
|
2022-12-25 11:01:39 -08:00
|
|
|
mafSensor = Sensor.new("maf")
|
|
|
|
mafCalibrationIndex = findCurveIndex("mafcurve")
|
|
|
|
|
2023-01-09 18:35:08 -08:00
|
|
|
canMotorInfoTotalCounter = 0
|
|
|
|
|
2023-01-09 21:55:36 -08:00
|
|
|
function onAccGra(bus, id, dlc, data)
|
|
|
|
print("onAccGra")
|
|
|
|
end
|
|
|
|
|
|
|
|
canRxAdd(ECU_BUS, ACC_GRA, onAccGra)
|
|
|
|
|
2023-01-10 08:03:20 -08:00
|
|
|
motorBreCounter = 0
|
|
|
|
function onMotorBre(bus, id, dlc, data)
|
|
|
|
motorBreCounter = (motorBreCounter + 1) % 16
|
|
|
|
|
|
|
|
setBitRange(motorBreData, 8, 4, motorBreCounter)
|
|
|
|
xorChecksum(motorBreData, 1)
|
|
|
|
|
|
|
|
txCan(TCU_BUS, MOTOR_BRE, 0, motorBreData)
|
|
|
|
end
|
|
|
|
|
|
|
|
motor2counter = 0
|
|
|
|
function onMotor2(bus, id, dlc, data)
|
|
|
|
motor2counter = (motor2counter + 1) % 16
|
|
|
|
|
|
|
|
minTorque = fakeTorque / 2
|
|
|
|
motor2Data[7] = math.floor(minTorque / 0.39)
|
|
|
|
|
|
|
|
--print ( "brake " .. getBitRange(data, 16, 2) .. " " .. rpm)
|
|
|
|
|
|
|
|
brakeBit = rpm < 2000 and 1 or 0
|
|
|
|
setBitRange(motor2Data, 16, 1, brakeBit)
|
|
|
|
|
|
|
|
index = math.floor(motor2counter / 4)
|
|
|
|
motor2Data[1] = motor2mux[1 + index]
|
|
|
|
|
|
|
|
txCan(TCU_BUS, MOTOR_2, 0, motor2Data)
|
|
|
|
end
|
|
|
|
|
|
|
|
motor5FuelCounter = 0
|
|
|
|
function onMotor5(bus, id, dlc, data)
|
|
|
|
setBitRange(motor5Data, 5, 9, motor5FuelCounter)
|
|
|
|
xorChecksum(motor5Data, 8)
|
|
|
|
txCan(TCU_BUS, MOTOR_5, 0, motor5Data)
|
|
|
|
end
|
|
|
|
|
|
|
|
counter16 = 0
|
|
|
|
function onMotor6(bus, id, dlc, data)
|
|
|
|
counter16 = (counter16 + 1) % 16
|
|
|
|
|
|
|
|
-- engineTorque = getBitRange(data, 8, 8) * 0.39
|
|
|
|
-- actualTorque = getBitRange(data, 16, 8) * 0.39
|
|
|
|
-- feedbackGearbox = getBitRange(data, 40, 8) * 0.39
|
|
|
|
engineTorque = fakeTorque * 0.9
|
|
|
|
actualTorque = fakeTorque
|
|
|
|
feedbackGearbox = 255
|
|
|
|
|
|
|
|
motor6Data[2] = math.floor(engineTorque / 0.39)
|
|
|
|
motor6Data[3] = math.floor(actualTorque / 0.39)
|
|
|
|
motor6Data[6] = math.floor(feedbackGearbox / 0.39)
|
|
|
|
setBitRange(motor6Data, 60, 4, counter16)
|
|
|
|
|
|
|
|
xorChecksum(motor6Data, 1)
|
|
|
|
txCan(TCU_BUS, MOTOR_6, 0, motor6Data)
|
|
|
|
end
|
|
|
|
|
|
|
|
canMotorInfoCounter = 0
|
|
|
|
function onMotorInfo(bus, id, dlc, data)
|
|
|
|
canMotorInfoTotalCounter = canMotorInfoTotalCounter + 1
|
|
|
|
canMotorInfoCounter = (canMotorInfoCounter + 1) % 16
|
|
|
|
-- canMotorInfoCounter = getBitRange(data, 0, 4)
|
|
|
|
|
|
|
|
baseByte = canMotorInfoTotalCounter < 6 and 0x80 or 0x90
|
|
|
|
canMotorInfo[1] = baseByte + (canMotorInfoCounter)
|
|
|
|
canMotorInfo1[1] = baseByte + (canMotorInfoCounter)
|
|
|
|
canMotorInfo3[1] = baseByte + (canMotorInfoCounter)
|
|
|
|
mod4 = canMotorInfoCounter % 4
|
|
|
|
|
|
|
|
if (mod4 == 0 or mod4 == 2) then
|
|
|
|
txCan(TCU_BUS, MOTOR_INFO, 0, canMotorInfo)
|
|
|
|
elseif (mod4 == 1) then
|
|
|
|
txCan(TCU_BUS, MOTOR_INFO, 0, canMotorInfo1)
|
|
|
|
else
|
|
|
|
txCan(TCU_BUS, MOTOR_INFO, 0, canMotorInfo3)
|
|
|
|
end
|
|
|
|
end
|
|
|
|
|
|
|
|
function onMotor7(bus, id, dlc, data)
|
|
|
|
txCan(TCU_BUS, MOTOR_7, 0, motor7Data)
|
|
|
|
end
|
|
|
|
|
|
|
|
|
2022-12-04 09:28:49 -08:00
|
|
|
function onTick()
|
2022-12-25 11:01:39 -08:00
|
|
|
|
2022-12-29 15:13:40 -08:00
|
|
|
freqValue = getSensor("AuxSpeed1") or 0
|
2022-12-25 11:01:39 -08:00
|
|
|
mafValue = curve(mafCalibrationIndex, 5)
|
2022-12-29 15:13:40 -08:00
|
|
|
-- print(freqValue .. " mafValue=" .. mafValue)
|
2022-12-25 11:01:39 -08:00
|
|
|
mafSensor : set(mafValue)
|
|
|
|
|
2022-12-27 05:29:35 -08:00
|
|
|
counter16 = (counter16 + 1) % 16
|
2022-12-04 09:28:49 -08:00
|
|
|
|
|
|
|
rpm = getSensor("RPM") or 0
|
|
|
|
clt = getSensor("CLT") or 0
|
|
|
|
iat = getSensor("IAT") or 0
|
|
|
|
tps = getSensor("TPS1") or 0
|
|
|
|
vbat = getSensor("BatteryVoltage") or 0
|
|
|
|
|
2023-01-09 18:35:08 -08:00
|
|
|
if rpm == 0 then
|
|
|
|
canMotorInfoTotalCounter = 0
|
|
|
|
end
|
|
|
|
|
2022-12-04 09:28:49 -08:00
|
|
|
fakeTorque = interpolate(0, 6, 100, 60, tps)
|
|
|
|
|
2022-12-25 23:23:37 -08:00
|
|
|
engineTorque = fakeTorque * 0.9
|
2022-12-04 09:28:49 -08:00
|
|
|
innerTorqWithoutExt = fakeTorque
|
|
|
|
torqueLoss = 10
|
|
|
|
requestedTorque = fakeTorque
|
|
|
|
|
|
|
|
canMotor1[2] = engineTorque / 0.39
|
2022-12-28 22:35:46 -08:00
|
|
|
setTwoBytes(canMotor1, 2, 4 * rpm)
|
2022-12-04 09:28:49 -08:00
|
|
|
canMotor1[5] = innerTorqWithoutExt / 0.4
|
|
|
|
canMotor1[6] = tps / 0.4
|
|
|
|
canMotor1[7] = torqueLoss / 0.39
|
|
|
|
canMotor1[8] = requestedTorque / 0.39
|
|
|
|
txCan(1, MOTOR_1, 0, canMotor1)
|
|
|
|
|
2023-01-10 08:03:20 -08:00
|
|
|
onMotorBre(0, 0, 0, nil)
|
|
|
|
onMotor2(0, 0, 0, nil)
|
|
|
|
onMotor5(0, 0, 0, nil)
|
|
|
|
onMotor6(0, 0, 0, nil)
|
|
|
|
onMotor7(0, 0, 0, nil)
|
2022-12-25 23:23:37 -08:00
|
|
|
|
2022-12-29 15:13:40 -08:00
|
|
|
accGraCounter = (accGraCounter + 1) % 16
|
|
|
|
setBitRange(accGraData, 60, 4, accGraCounter)
|
|
|
|
xorChecksum(accGraData, 1)
|
2023-01-09 21:55:36 -08:00
|
|
|
-- txCan(1, ACC_GRA, 0, accGraData)
|
2023-01-09 18:35:08 -08:00
|
|
|
-- print("ACC_GRA " ..arrayToString(accGraData))
|
2022-12-04 09:28:49 -08:00
|
|
|
|
2022-12-29 15:13:40 -08:00
|
|
|
local timeToTurnOff = shallSleep : getElapsedSeconds() > 2
|
|
|
|
local connectedToUsb = vbat < 4
|
2022-12-04 09:28:49 -08:00
|
|
|
|
|
|
|
if hadIgnitionEvent and timeToTurnOff then
|
|
|
|
-- looks like ignition key was removed
|
|
|
|
mcu_standby()
|
|
|
|
end
|
|
|
|
|
|
|
|
if everySecondTimer : getElapsedSeconds() > 1 then
|
|
|
|
everySecondTimer : reset()
|
|
|
|
|
2022-12-28 22:35:46 -08:00
|
|
|
motor5FuelCounter = motor5FuelCounter + 20
|
2022-12-04 09:28:49 -08:00
|
|
|
|
2023-01-10 08:03:20 -08:00
|
|
|
onMotorInfo(0, 0, 0, nil)
|
2023-01-09 18:35:08 -08:00
|
|
|
|
2022-12-04 09:28:49 -08:00
|
|
|
end
|
|
|
|
end
|
|
|
|
|
|
|
|
)", efi::size(config->luaScript));
|