mirror of
https://github.com/radio95-rnt/rds95.git
synced 2026-07-29 16:29:17 +02:00
proper uecp
This commit is contained in:
@@ -0,0 +1,281 @@
|
||||
uecp = {}
|
||||
uecp.rt_buffer = {}
|
||||
uecp.rt_buffer_index = 1
|
||||
uecp.rt_tx_remaining = 0
|
||||
|
||||
hooks.rt_transmission[#hooks.rt_transmission + 1] = function ()
|
||||
if #uecp.rt_buffer == 0 then return end
|
||||
|
||||
if #uecp.rt_buffer > 1 and uecp.rt_tx_remaining > 1 then
|
||||
uecp.rt_tx_remaining = uecp.rt_tx_remaining - 1
|
||||
return
|
||||
end
|
||||
|
||||
uecp.rt_buffer_index = (uecp.rt_buffer_index % #uecp.rt_buffer) + 1
|
||||
local entry = uecp.rt_buffer[uecp.rt_buffer_index]
|
||||
uecp.rt_tx_remaining = entry.number_tx
|
||||
|
||||
rds.set_rt(entry.text)
|
||||
if entry.toggle_ab then rds.toggle_rt_ab() end
|
||||
end
|
||||
|
||||
local mec_handlers = {}
|
||||
|
||||
local function dsn_helper(dsn, write)
|
||||
if dsn == 0 then write()
|
||||
elseif dsn == 254 then
|
||||
local start = dp.get_writing_program()
|
||||
for i = 1, dp.max_programs do
|
||||
local p = i - 1
|
||||
if p ~= start then
|
||||
dp.set_writing_program(p)
|
||||
write()
|
||||
end
|
||||
end
|
||||
elseif dsn == 255 then
|
||||
for i = 1, dp.max_programs do
|
||||
dp.set_writing_program(i - 1)
|
||||
write()
|
||||
end
|
||||
else
|
||||
dp.set_writing_program(dsn - 1)
|
||||
write()
|
||||
end
|
||||
end
|
||||
|
||||
mec_handlers[1] = function (data)
|
||||
-- PI
|
||||
local dsn = string.byte(data, 2)
|
||||
local psn = string.byte(data, 3)
|
||||
local pi_msb = string.byte(data, 4)
|
||||
local pi_lsb = string.byte(data, 5)
|
||||
|
||||
dsn_helper(dsn, function ()
|
||||
rds.set_pi((pi_msb << 8) | pi_lsb)
|
||||
end)
|
||||
return 5
|
||||
end
|
||||
mec_handlers[2] = function (data)
|
||||
-- PS
|
||||
local dsn = string.byte(data, 2)
|
||||
local psn = string.byte(data, 3)
|
||||
local ps = string.sub(data, 4, 11) -- Static len
|
||||
dsn_helper(dsn, function ()
|
||||
rds.set_ps(ps)
|
||||
end)
|
||||
return 11
|
||||
end
|
||||
mec_handlers[0x21] = function (data)
|
||||
-- LPS
|
||||
local dsn = string.byte(data, 2)
|
||||
local psn = string.byte(data, 3)
|
||||
local mel = string.byte(data, 4)
|
||||
local lps = string.sub(data, 5, 5+mel)
|
||||
|
||||
local cut = string.find(lps, "\r", 1, true)
|
||||
if cut then lps = string.sub(lps, 1, cut - 1) end
|
||||
|
||||
dsn_helper(dsn, function ()
|
||||
rds.set_lps(lps)
|
||||
end)
|
||||
return 4 + mel
|
||||
end
|
||||
mec_handlers[4] = function (data)
|
||||
-- PTYI
|
||||
local dsn = string.byte(data, 2)
|
||||
local psn = string.byte(data, 3)
|
||||
local data = string.byte(data, 4)
|
||||
dsn_helper(dsn, function ()
|
||||
rds.set_dpty((data & 8) ~= 0)
|
||||
end)
|
||||
return 4
|
||||
end
|
||||
mec_handlers[3] = function (data)
|
||||
-- TP/TA
|
||||
local dsn = string.byte(data, 2)
|
||||
local psn = string.byte(data, 3)
|
||||
local data = string.byte(data, 4)
|
||||
dsn_helper(dsn, function ()
|
||||
rds.set_ta((data & 1) ~= 0)
|
||||
rds.set_ta((data & 2) ~= 0)
|
||||
end)
|
||||
return 4
|
||||
end
|
||||
mec_handlers[7] = function (data)
|
||||
-- PTY
|
||||
local dsn = string.byte(data, 2)
|
||||
local psn = string.byte(data, 3)
|
||||
local data = string.byte(data, 4)
|
||||
dsn_helper(dsn, function ()
|
||||
rds.set_pty(data)
|
||||
end)
|
||||
return 4
|
||||
end
|
||||
mec_handlers[0x3E] = function (data)
|
||||
-- PTYN
|
||||
local dsn = string.byte(data, 2)
|
||||
local psn = string.byte(data, 3)
|
||||
local ptyn = string.sub(data, 4, 11) -- Static
|
||||
dsn_helper(dsn, function ()
|
||||
rds.set_ptyn(ptyn)
|
||||
end)
|
||||
return 11
|
||||
end
|
||||
mec_handlers[0x0A] = function (data)
|
||||
local dsn = string.byte(data, 2)
|
||||
local psn = string.byte(data, 3)
|
||||
local mel = string.byte(data, 4)
|
||||
|
||||
if mel == 0 then
|
||||
uecp.rt_buffer = {}
|
||||
uecp.rt_buffer_index = 1
|
||||
uecp.rt_tx_remaining = 0
|
||||
dsn_helper(dsn, function ()
|
||||
rds.set_rt_enabled(false)
|
||||
end)
|
||||
return 4
|
||||
end
|
||||
|
||||
local config = string.byte(data, 5)
|
||||
local toggle_ab = (config & 1) ~= 0
|
||||
local number_tx = (config >> 1) & 0xF
|
||||
local buffer_config = (config >> 5) & 3
|
||||
|
||||
if mel == 1 and buffer_config == 0 then
|
||||
uecp.rt_buffer = {}
|
||||
uecp.rt_buffer_index = 1
|
||||
uecp.rt_tx_remaining = 0
|
||||
dsn_helper(dsn, function ()
|
||||
rds.set_rt_enabled(false)
|
||||
end)
|
||||
return 5
|
||||
end
|
||||
|
||||
local rt_text = string.sub(data, 6, 4 + mel)
|
||||
local cr = string.find(rt_text, "\r", 1, true)
|
||||
if cr then rt_text = string.sub(rt_text, 1, cr - 1) end
|
||||
|
||||
if buffer_config == 0 then
|
||||
uecp.rt_buffer = {}
|
||||
uecp.rt_buffer_index = 1
|
||||
uecp.rt_buffer[1] = { text = rt_text, number_tx = number_tx, toggle_ab = toggle_ab }
|
||||
uecp.rt_tx_remaining = number_tx
|
||||
-- Seed the encoder immediately with the first entry
|
||||
dsn_helper(dsn, function ()
|
||||
rds.set_rt(rt_text)
|
||||
if toggle_ab then rds.toggle_rt_ab() end
|
||||
rds.set_rt_enabled(true)
|
||||
end)
|
||||
elseif buffer_config == 2 then
|
||||
uecp.rt_buffer[#uecp.rt_buffer + 1] = { text = rt_text, number_tx = number_tx, toggle_ab = toggle_ab }
|
||||
end
|
||||
|
||||
return 4 + mel
|
||||
end
|
||||
mec_handlers[0x13] = function (data)
|
||||
-- AF
|
||||
local dsn = string.byte(data, 2)
|
||||
local psn = string.byte(data, 3)
|
||||
local mel = string.sub(data, 4)
|
||||
|
||||
-- TODO: decode
|
||||
|
||||
return 4+mel
|
||||
end
|
||||
mec_handlers[0x1A] = function (data)
|
||||
-- ECC / SLS
|
||||
local dsn = string.byte(data, 2)
|
||||
-- No PSN
|
||||
local data = string.sub(data, 3)
|
||||
local data_lsb = string.sub(data, 4)
|
||||
|
||||
local full_data = ((data & 15) << 8) | data_lsb
|
||||
local variant = (data >> 4) & 3
|
||||
if variant == 0 then
|
||||
dsn_helper(dsn, function ()
|
||||
rds.set_ecc(full_data)
|
||||
end)
|
||||
end
|
||||
|
||||
return 4
|
||||
end
|
||||
mec_handlers[0x19] = function (data)
|
||||
-- CT
|
||||
local data = string.byte(data, 2)
|
||||
rds.set_ct(data ~= 0)
|
||||
return 2
|
||||
end
|
||||
mec_handlers[0x1C] = function (data)
|
||||
-- DS select
|
||||
local dsn = string.byte(data, 2)
|
||||
dp.set_program(dsn)
|
||||
dp.set_writing_program(dsn)
|
||||
return 2
|
||||
end
|
||||
|
||||
---@param data string
|
||||
local function undo_byte_stuff(data)
|
||||
local output = {}
|
||||
local i = 1
|
||||
while i <= #data do
|
||||
local d0 = string.byte(data, i)
|
||||
if d0 == 0xFD then
|
||||
local d1 = string.byte(data, i + 1)
|
||||
if not d1 then error("truncated escape sequence") end
|
||||
output[#output + 1] = string.char(0xFD + d1)
|
||||
i = i + 2
|
||||
else
|
||||
output[#output + 1] = string.char(d0)
|
||||
i = i + 1
|
||||
end
|
||||
end
|
||||
return table.concat(output)
|
||||
end
|
||||
|
||||
---@param packet string
|
||||
function uecp.parse_uecp(packet)
|
||||
local end_i = string.find(packet, "\xff", 1, true)
|
||||
if not end_i then
|
||||
print("could not find 0xff")
|
||||
return
|
||||
end
|
||||
|
||||
local unstuffed = undo_byte_stuff(string.sub(packet, 2, end_i - 1))
|
||||
|
||||
local addr1 = string.byte(unstuffed, 1)
|
||||
local addr2 = string.byte(unstuffed, 2)
|
||||
local site_addr = (addr1 << 2) | (addr2 >> 6)
|
||||
local encoder_addr = addr2 & 0x3F
|
||||
local sequence_count = string.byte(unstuffed, 3)
|
||||
local mfl = string.byte(unstuffed, 4)
|
||||
|
||||
local data = string.sub(unstuffed, 5, 4 + mfl)
|
||||
|
||||
if mfl ~= #data then
|
||||
print("data len not right")
|
||||
return
|
||||
end
|
||||
|
||||
local crc_calculated = dp.crc16(string.sub(unstuffed, 1, 4 + mfl))
|
||||
local crc_hi = string.byte(unstuffed, 4 + mfl + 1)
|
||||
local crc_lo = string.byte(unstuffed, 4 + mfl + 2)
|
||||
local crc_stored = (crc_hi << 8) | crc_lo
|
||||
|
||||
if crc_calculated ~= crc_stored then
|
||||
print("bad crc")
|
||||
return
|
||||
end
|
||||
|
||||
local consumed = 1
|
||||
while consumed <= #data do
|
||||
local mec = string.byte(data, consumed)
|
||||
local handler = mec_handlers[mec]
|
||||
if not handler then
|
||||
print(string.format("unknown MEC 0x%02X, cannot continue", mec))
|
||||
break
|
||||
end
|
||||
local advance = handler(string.sub(data, consumed))
|
||||
consumed = consumed + advance
|
||||
dp.set_writing_program(dp.get_program())
|
||||
end
|
||||
end
|
||||
Reference in New Issue
Block a user