only:m74.9
This commit is contained in:
parent
3216c5c97b
commit
3d96c2f21f
|
@ -0,0 +1,62 @@
|
|||
|
||||
|
||||
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 loop = 0
|
||||
local result = ""
|
||||
while num ~= 0 do
|
||||
loop = loop + 1
|
||||
if loop > 8 then
|
||||
-- this is about U32 being handled as negative
|
||||
return result
|
||||
end
|
||||
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
|
||||
|
||||
UDS_OUT = 0x7E0
|
||||
UDS_IN = 0x7E8
|
||||
|
||||
-- request programming
|
||||
txCan(1, UDS_OUT, 0, { 0x02, 0x10, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00 })
|
||||
|
||||
function onUDS(bus, id, dlc, data)
|
||||
print("UDS " ..arrayToString(data))
|
||||
if data[1] == 0x06 and data[2] == 0x50 and data[3] == 0x02 then
|
||||
print ("Programming ACK")
|
||||
txCan(1, UDS_OUT, 0, { 0x03, 0x27, 0x01, 0xA1, 0x00, 0x00, 0x00, 0x00 })
|
||||
elseif data[1] == 0x06 and data[2] == 0x67 and data[3] == 0x01 then
|
||||
seed = (data[7] << 24) + (data[6] << 16) + (data[5] << 8) + data[4]
|
||||
print ("Got seed [" ..toHexString(seed) .."]")
|
||||
end
|
||||
|
||||
|
||||
end
|
||||
|
||||
canRxAdd(1, UDS_IN, onUDS)
|
||||
|
||||
function onTick()
|
||||
end
|
||||
|
Loading…
Reference in New Issue