parent
2e81c448bf
commit
517cd42309
|
@ -137,13 +137,22 @@ FIXED_POINT = 128
|
||||||
setTickRate(100)
|
setTickRate(100)
|
||||||
|
|
||||||
function onCanConfiguration3(bus, id, dlc, data)
|
function onCanConfiguration3(bus, id, dlc, data)
|
||||||
-- print("Received configuration3 "..arrayToString(data))
|
-- print("Received configuration3 "..arrayToString(data))
|
||||||
pumpPeak = getTwoBytesLSB(data, 6, 1 / 128)
|
pumpPeak = getTwoBytesLSB(data, 6, 1 / 128)
|
||||||
-- print("GDI4 says PumpPeakCurrent ".. pumpPeak)
|
print("GDI4 says PumpPeakCurrent ".. pumpPeak)
|
||||||
setLuaGauge(1, pumpPeak)
|
setLuaGauge(1, pumpPeak)
|
||||||
end
|
end
|
||||||
|
|
||||||
|
function onCanVersion(bus, id, dlc, data)
|
||||||
|
year = data[1] * 100 + data[2]
|
||||||
|
month = data[3]
|
||||||
|
day = data[4]
|
||||||
|
-- print ("GDI4 firmware " ..year ..'/' ..month ..'/' ..day)
|
||||||
|
end
|
||||||
|
|
||||||
canRxAdd(GDI4_BASE_ADDRESS + 3, onCanConfiguration3)
|
canRxAdd(GDI4_BASE_ADDRESS + 3, onCanConfiguration3)
|
||||||
|
canRxAdd(GDI4_BASE_ADDRESS + 5, onCanVersion)
|
||||||
|
|
||||||
|
|
||||||
EMS_DCT11_128 = 0x80
|
EMS_DCT11_128 = 0x80
|
||||||
EMS_DCT12_129 = 0x81
|
EMS_DCT12_129 = 0x81
|
||||||
|
@ -157,13 +166,13 @@ EMS14_1349 = 0x545
|
||||||
|
|
||||||
counter = 0
|
counter = 0
|
||||||
|
|
||||||
payLoad128 = { 0x00, 0x17, 0x70, 0x0F, 0x1B, 0x2C, 0x1B, 0x75 }
|
payLoad128 = { 0x00, 0x17, 0x70, 0x0F, 0x1B, 0x2C, 0x1B, 0x75 }
|
||||||
payLoad129 = { 0x40, 0x84, 0x5F, 0x00, 0x00, 0x00, 0x00, 0x75 }
|
payLoad129 = { 0x40, 0x84, 0x5F, 0x00, 0x00, 0x00, 0x00, 0x75 }
|
||||||
payLoad399 = {0x00, 0x30, 0x1d, 0x00, 0x00, 0x63, 0x00, 0x00}
|
payLoad399 = { 0x00, 0x30, 0x1d, 0x00, 0x00, 0x63, 0x00, 0x00 }
|
||||||
payLoad608 = {0x05, 0x1d, 0x00, 0x30, 0x01, 0xa5, 0x7f, 0x31}
|
payLoad608 = { 0x05, 0x1d, 0x00, 0x30, 0x01, 0xa5, 0x7f, 0x31 }
|
||||||
payLoad672 = {0xe0, 0x00, 0x5f, 0x98, 0x39, 0x12, 0x9e, 0x08}
|
payLoad672 = { 0xe0, 0x00, 0x5f, 0x98, 0x39, 0x12, 0x9e, 0x08 }
|
||||||
payLoad809 = {0xd7, 0x7b, 0x7e, 0x0c, 0x11, 0x2c, 0x00, 0x10}
|
payLoad809 = { 0xd7, 0x7b, 0x7e, 0x0c, 0x11, 0x2c, 0x00, 0x10 }
|
||||||
payLoad898 = {0x40, 0xfe, 0x0f, 0x00, 0x00, 0x00, 0x00, 0x08}
|
payLoad898 = { 0x40, 0xfe, 0x0f, 0x00, 0x00, 0x00, 0x00, 0x08 }
|
||||||
payLoad1349 = { 0xCA, 0x16, 0x00, 0x8A, 0x75, 0xFF, 0x75, 0xFF }
|
payLoad1349 = { 0xCA, 0x16, 0x00, 0x8A, 0x75, 0xFF, 0x75, 0xFF }
|
||||||
|
|
||||||
speedSensor = Sensor.new("VehicleSpeed")
|
speedSensor = Sensor.new("VehicleSpeed")
|
||||||
|
@ -171,58 +180,29 @@ speedSensor : setTimeout(3000)
|
||||||
|
|
||||||
function onCluPacket(bus, id, dlc, data)
|
function onCluPacket(bus, id, dlc, data)
|
||||||
speedKph = getBitRange(data, 8, 9) * 0.5
|
speedKph = getBitRange(data, 8, 9) * 0.5
|
||||||
print('onCAR_SPEED ' ..speedKph)
|
-- print('onCAR_SPEED ' ..speedKph)
|
||||||
speedSensor : set(speedKph)
|
speedSensor : set(speedKph)
|
||||||
end
|
end
|
||||||
|
|
||||||
canRxAdd(1, 1264, onCluPacket)
|
canRxAdd(1, 1264, onCluPacket)
|
||||||
|
|
||||||
GDI4_BASE_ADDRESS = 0xBB20
|
|
||||||
GDI_CHANGE_ADDRESS = GDI4_BASE_ADDRESS + 0x10
|
|
||||||
local data_set_settings = { GDI4_CAN_SET_TAG, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }
|
|
||||||
|
|
||||||
function onCanConfiguration3(bus, id, dlc, data)
|
|
||||||
print("Received configuration3 "..arrayToString(data))
|
|
||||||
print("GDI4 says HoldCurrent "..getTwoBytesLSB(data, 0, 1 / 128) )
|
|
||||||
print("GDI4 says TholdOff "..getTwoBytesLSB(data, 2, 1) )
|
|
||||||
print("GDI4 says THoldDuration "..getTwoBytesLSB(data, 4, 1) )
|
|
||||||
pumpPeak = getTwoBytesLSB(data, 6, 1 / 128)
|
|
||||||
print("GDI4 says PumpPeakCurrent ".. pumpPeak)
|
|
||||||
setLuaGauge(1, pumpPeak)
|
|
||||||
end
|
|
||||||
|
|
||||||
canRxAdd(GDI4_BASE_ADDRESS + 3, onCanConfiguration3)
|
|
||||||
|
|
||||||
function onTick()
|
function onTick()
|
||||||
TholdOff = getCalibration("mc33_t_hold_off")
|
|
||||||
THoldDuration = getCalibration("mc33_t_hold_tot")
|
|
||||||
|
|
||||||
pumpPeakCurrent = getCalibration("mc33_hpfp_i_peak")
|
|
||||||
pumpHoldCurrent = getCalibration("mc33_hpfp_i_hold")
|
|
||||||
|
|
||||||
setTwoBytesLsb(data_set_settings, 1, TholdOff)
|
|
||||||
setTwoBytesLsb(data_set_settings, 3, THoldDuration)
|
|
||||||
-- set mc33_hpfp_i_peak 6
|
|
||||||
setTwoBytesLsb(data_set_settings, 5, pumpPeakCurrent * FIXED_POINT)
|
|
||||||
print('Will be sending ' ..arrayToString(data_set_settings))
|
|
||||||
txCan(1, GDI_CHANGE_ADDRESS + 3, 1, data_set_settings)
|
|
||||||
|
|
||||||
local RPMread = math.floor(getSensor("RPM") * 4)
|
local RPMread = math.floor(getSensor("RPM") * 4)
|
||||||
local RPMhi = RPMread >> 8
|
local RPMhi = RPMread >> 8
|
||||||
local RPMlo = RPMread & 0xff
|
local RPMlo = RPMread & 0xff
|
||||||
|
|
||||||
payLoad128[3] = RPMlo
|
payLoad128[3] = RPMlo
|
||||||
payLoad128[4] = RPMhi
|
payLoad128[4] = RPMhi
|
||||||
|
|
||||||
counter = (counter + 1) % 16
|
counter = (counter + 1) % 16
|
||||||
|
|
||||||
check128 = hyundaiSumNibbles(payLoad128, counter)
|
check128 = hyundaiSumNibbles(payLoad128, counter)
|
||||||
payLoad128[8] = check128 * 16 + counter
|
payLoad128[8] = check128 * 16 + counter
|
||||||
txCan(1, EMS_DCT11_128, 0, payLoad128)
|
txCan(1, EMS_DCT11_128, 0, payLoad128)
|
||||||
|
|
||||||
check129 = hyundaiSumNibbles(payLoad129, counter)
|
check129 = hyundaiSumNibbles(payLoad129, counter)
|
||||||
payLoad129[8] = check129 * 16 + counter
|
payLoad129[8] = check129 * 16 + counter
|
||||||
txCan(1, EMS_DCT12_129, 0, payLoad129)
|
txCan(1, EMS_DCT12_129, 0, payLoad129)
|
||||||
|
|
||||||
canRPMpayload = { 0x05, 0x1B, RPMlo, RPMhi, 0x1B, 0x2C, 0x00, 0x7F }
|
canRPMpayload = { 0x05, 0x1B, RPMlo, RPMhi, 0x1B, 0x2C, 0x00, 0x7F }
|
||||||
|
|
||||||
|
@ -235,8 +215,8 @@ function onTick()
|
||||||
txCan(1, EMS12_809, 0, payLoad809)
|
txCan(1, EMS12_809, 0, payLoad809)
|
||||||
txCan(1, EMS9_898, 0, payLoad898)
|
txCan(1, EMS9_898, 0, payLoad898)
|
||||||
|
|
||||||
pumpPeakCurrent = getCalibration("mc33_hpfp_i_peak")
|
pumpPeakCurrent = getCalibration("mc33_hpfp_i_peak")
|
||||||
pumpHoldCurrent = getCalibration("mc33_hpfp_i_hold")
|
pumpHoldCurrent = getCalibration("mc33_hpfp_i_hold")
|
||||||
|
|
||||||
TholdOff = getCalibration("mc33_t_hold_off")
|
TholdOff = getCalibration("mc33_t_hold_off")
|
||||||
THoldDuration = getCalibration("mc33_t_hold_tot")
|
THoldDuration = getCalibration("mc33_t_hold_tot")
|
||||||
|
@ -245,12 +225,12 @@ function onTick()
|
||||||
setTwoBytesLsb(data_set_settings, 1, TholdOff)
|
setTwoBytesLsb(data_set_settings, 1, TholdOff)
|
||||||
setTwoBytesLsb(data_set_settings, 3, THoldDuration)
|
setTwoBytesLsb(data_set_settings, 3, THoldDuration)
|
||||||
setTwoBytesLsb(data_set_settings, 5, pumpPeakCurrent * FIXED_POINT)
|
setTwoBytesLsb(data_set_settings, 5, pumpPeakCurrent * FIXED_POINT)
|
||||||
print('Will be sending ' ..arrayToString(data_set_settings))
|
-- print('Will be sending ' ..arrayToString(data_set_settings))
|
||||||
txCan(1, GDI_CHANGE_ADDRESS + 3, 1, data_set_settings)
|
txCan(1, GDI_CHANGE_ADDRESS + 3, 1, data_set_settings)
|
||||||
|
|
||||||
setTwoBytesLsb(data_set_settings, 1, pumpHoldCurrent * FIXED_POINT)
|
setTwoBytesLsb(data_set_settings, 1, pumpHoldCurrent * FIXED_POINT)
|
||||||
setTwoBytesLsb(data_set_settings, 3, GDI4_BASE_ADDRESS)
|
setTwoBytesLsb(data_set_settings, 3, GDI4_BASE_ADDRESS)
|
||||||
print('Will be sending ' ..arrayToString(data_set_settings))
|
-- print('Will be sending ' ..arrayToString(data_set_settings))
|
||||||
txCan(1, GDI_CHANGE_ADDRESS + 4, 1, data_set_settings)
|
txCan(1, GDI_CHANGE_ADDRESS + 4, 1, data_set_settings)
|
||||||
end
|
end
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue