mirror of https://github.com/FOME-Tech/fome-fw.git
85 lines
2.3 KiB
Plaintext
85 lines
2.3 KiB
Plaintext
-- communication with https://github.com/rusefi/rusefi-hardware/tree/main/GDI-4ch/firmware
|
|
|
|
GDI4_BASE_ADDRESS = 0xF0
|
|
|
|
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
|
|
|
|
function printPacket(bus, id, dlc, data)
|
|
print('Received ' ..arrayToString(data))
|
|
end
|
|
|
|
function getTwoBytesLSB(data, offset, factor)
|
|
return (data[offset + 2] * 256 + data[offset + 1]) * factor
|
|
end
|
|
|
|
function setTwoBytesLsb(data, offset, value)
|
|
value = math.floor(value)
|
|
data[offset + 2] = value >> 8
|
|
data[offset + 1] = value & 0xff
|
|
end
|
|
|
|
function onCanConfiguration(bus, id, dlc, data)
|
|
print('Received configuration ' ..arrayToString(data))
|
|
print ("BoostVoltage " ..getTwoBytesLSB(data, 0, 0.01) )
|
|
print ("BoostCurrent " ..getTwoBytesLSB(data, 2, 0.01) )
|
|
print ("PeakCurrent " ..getTwoBytesLSB(data, 4, 0.01) )
|
|
print ("HoldCurrent " ..getTwoBytesLSB(data, 6, 0.01) )
|
|
end
|
|
|
|
canRxAdd(GDI4_BASE_ADDRESS, printPacket)
|
|
canRxAdd(GDI4_BASE_ADDRESS + 1, onCanConfiguration)
|
|
canRxAdd(GDI4_BASE_ADDRESS + 2, printPacket)
|
|
|
|
local data_set_voltage = { 0x88, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }
|
|
|
|
FIXED_POINT = 100
|
|
|
|
function onTick()
|
|
|
|
boostVoltage = getCalibration("mc33_hvolt")
|
|
boostCurrent = getCalibration("mc33_i_boost") / 1000.0
|
|
peakCurrent = getCalibration("mc33_i_peak") / 1000.0
|
|
print("boostVoltage " .. boostVoltage .." boostCurrent " ..boostCurrent .." peakCurrent " ..peakCurrent)
|
|
|
|
holdCurrent = getCalibration("mc33_i_hold")
|
|
peakDuration = getCalibration("mc33_t_peak_tot") / 1000.0
|
|
holdDuration = getCalibration("mc33_t_hold_tot") / 1000.0
|
|
print("holdCurrent " .. holdCurrent .. " peakDuration " .. peakDuration .." hold duration " ..holdDuration)
|
|
|
|
setTwoBytesLsb(data_set_voltage, 1, boostVoltage * FIXED_POINT)
|
|
setTwoBytesLsb(data_set_voltage, 3, boostCurrent * FIXED_POINT)
|
|
setTwoBytesLsb(data_set_voltage, 5, peakCurrent * FIXED_POINT)
|
|
print('Sending ' ..arrayToString(data_set_voltage))
|
|
|
|
|
|
|
|
txCan(1, 0x201, 1, data_set_voltage)
|
|
|
|
end
|
|
|
|
|