* Crossfire refactoring * Crossfire script now displaying fields * Crossfire script now displaying text selection values
359 lines
9.1 KiB
Lua
359 lines
9.1 KiB
Lua
local VALUE = 0
|
|
local COMBO = 1
|
|
|
|
local COLUMN_2 = 150
|
|
|
|
local edit = false
|
|
local page = 1
|
|
local current = 1
|
|
local refreshState = 0
|
|
local refreshIndex = 0
|
|
local calibrationState = 0
|
|
local pageOffset = 0
|
|
local calibrationStep = 0
|
|
local pages = { }
|
|
|
|
-- Change display attribute to current field
|
|
local function addField(step)
|
|
field = fields[current]
|
|
if field[2] == VALUE then
|
|
min = field[5]
|
|
max = field[6]
|
|
elseif field[2] == COMBO then
|
|
min = 0
|
|
max = #(field[5]) - 1
|
|
end
|
|
if (step < 0 and field[4] > min) or (step > 0 and field[4] < max) then
|
|
field[4] = field[4] + step
|
|
end
|
|
end
|
|
|
|
-- Select the next or previous page
|
|
local function selectPage(step)
|
|
page = 1 + ((page + step - 1 + #pages) % #pages)
|
|
refreshIndex = 0
|
|
calibrationStep = 0
|
|
end
|
|
|
|
-- Select the next or previous editable field
|
|
local function selectField(step)
|
|
current = 1 + ((current + step - 1 + #fields) % #fields)
|
|
if current > 7 + pageOffset then
|
|
pageOffset = current - 7
|
|
elseif current <= pageOffset then
|
|
pageOffset = current - 1
|
|
end
|
|
end
|
|
|
|
local function drawProgressBar()
|
|
local width = (140 * refreshIndex) / #fields
|
|
lcd.drawRectangle(30, 1, 144, 6)
|
|
lcd.drawFilledRectangle(32, 3, width, 2);
|
|
end
|
|
|
|
local function drawDevicePage(page)
|
|
-- if refreshIndex < #fields then
|
|
-- drawProgressBar()
|
|
-- end
|
|
|
|
for index = 1, 7, 1 do
|
|
field = page.fields[pageOffset+index]
|
|
if field == nil then
|
|
break
|
|
end
|
|
|
|
if field.name == nil then
|
|
lcd.drawText(0, 1+8*index, "...")
|
|
else
|
|
attr = current == (pageOffset+index) and ((edit == true and BLINK or 0) + INVERS) or 0
|
|
lcd.drawText(0, 1+8*index, field.name)
|
|
if field.functions ~= nil then
|
|
field.functions.display(field, 1+8*index, attr)
|
|
end
|
|
|
|
-- if field[4] == nil then
|
|
-- lcd.drawText(COLUMN_2, 1+8*index, "---", attr)
|
|
-- else
|
|
-- if field[2] == VALUE then
|
|
-- lcd.drawNumber(COLUMN_2, 1+8*index, field[4], LEFT + attr)
|
|
-- elseif field[2] == COMBO then
|
|
-- if field[4] >= 0 and field[4] < #(field[5]) then
|
|
-- lcd.drawText(COLUMN_2, 1+8*index, field[5][1+field[4]], attr)
|
|
-- end
|
|
-- end
|
|
-- end
|
|
end
|
|
end
|
|
end
|
|
|
|
local function createPage(id, name, fields_count)
|
|
newpage = {
|
|
id = id,
|
|
name = name,
|
|
pagetimeout = 0,
|
|
fields = {},
|
|
fieldstimeout = 0,
|
|
}
|
|
for i=1, fields_count do
|
|
newpage.fields[i] = { name=nil }
|
|
end
|
|
return newpage
|
|
end
|
|
|
|
local function getPage(name)
|
|
for i=1, #pages do
|
|
if pages[i].name == name then
|
|
return pages[i]
|
|
end
|
|
end
|
|
return nil
|
|
end
|
|
|
|
local function parseDeviceInfoMessage(data)
|
|
id = data[2]
|
|
name = ""
|
|
i = 3
|
|
while data[i] ~= 0 do
|
|
name = name .. string.char(data[i])
|
|
i = i + 1
|
|
end
|
|
fields_count = data[i+13]
|
|
pg = getPage(name)
|
|
if pg == nil then
|
|
pg = createPage(id, name, fields_count-1) -- TODO fields_count should be different
|
|
pages[#pages + 1] = pg
|
|
end
|
|
pg.pagetimeout = time + 3000 -- 30s
|
|
end
|
|
|
|
function split(inputstr)
|
|
local t={}; i=1
|
|
for str in string.gmatch(inputstr, "([^;]+)") do
|
|
t[i] = str
|
|
i = i + 1
|
|
end
|
|
return t
|
|
end
|
|
|
|
local function fieldTextSelectionLoad(field, data, offset)
|
|
values = ""
|
|
while data[offset] ~= 0 do
|
|
values = values .. string.char(data[offset])
|
|
offset = offset + 1
|
|
end
|
|
field.values = split(values)
|
|
offset = offset + 1
|
|
field.value = data[offset]
|
|
end
|
|
|
|
local function fieldTextSelectionDisplay(field, y, attr)
|
|
lcd.drawText(COLUMN_2, y, field.values[field.value+1], attr)
|
|
end
|
|
|
|
local types_functions = {
|
|
nil,
|
|
nil,
|
|
nil,
|
|
nil,
|
|
nil,
|
|
nil,
|
|
nil,
|
|
nil,
|
|
nil,
|
|
{ load=fieldTextSelectionLoad, display=fieldTextSelectionDisplay },
|
|
nil,
|
|
nil
|
|
}
|
|
|
|
local function parseParameterInfoMessage(data)
|
|
index = data[3]
|
|
field = pages[page].fields[index]
|
|
field.parent = data[4]
|
|
field.type = data[5]
|
|
field.functions = types_functions[field.type+1]
|
|
parent = field.parent
|
|
name = ""
|
|
while parent ~= 0 do
|
|
name = name .. " "
|
|
parent = pages[page].fields[parent].parent
|
|
end
|
|
i = 6
|
|
while data[i] ~= 0 do
|
|
name = name .. string.char(data[i])
|
|
i = i + 1
|
|
end
|
|
i = i + 1
|
|
field.name = name
|
|
if field.functions ~= nil then
|
|
field.functions.load(field, data, i)
|
|
end
|
|
pages[page].fieldstimeout = 0
|
|
end
|
|
|
|
local telemetryPopTimeout = 0
|
|
local devicesRefreshTimeout = 0
|
|
local function refreshNext()
|
|
command, data = crossfireTelemetryPop()
|
|
if command == nil then
|
|
time = getTime()
|
|
if time > devicesRefreshTimeout then
|
|
if #pages == 0 then
|
|
devicesRefreshTimeout = time + 100 -- 1s
|
|
else
|
|
devicesRefreshTimeout = time + 1000 -- 10s
|
|
end
|
|
crossfireTelemetryPush(0x28, { 0x00, 0xEA })
|
|
elseif page <= #pages and time > pages[page].fieldstimeout then
|
|
for i=1, #pages[page].fields do
|
|
field = pages[page].fields[i]
|
|
if field.name == nil then
|
|
crossfireTelemetryPush(0x2C, { pages[page].id, 0xEA, i })
|
|
pages[page].fieldstimeout = time + 200 -- 2s
|
|
end
|
|
end
|
|
end
|
|
elseif command == 0x29 then
|
|
parseDeviceInfoMessage(data)
|
|
elseif command == 0x2B then
|
|
parseParameterInfoMessage(data)
|
|
end
|
|
|
|
-- if refreshState == 0 then
|
|
-- if calibrationState == 1 then
|
|
-- if telemetryWrite(0x9D, calibrationStep) == true then
|
|
-- refreshState = 1
|
|
-- calibrationState = 2
|
|
-- telemetryPopTimeout = getTime() + 80 -- normal delay is 500ms
|
|
-- end
|
|
-- elseif refreshIndex < #fields then
|
|
-- field = fields[refreshIndex + 1]
|
|
-- if telemetryRead(field[3]) == true then
|
|
-- refreshState = 1
|
|
-- telemetryPopTimeout = getTime() + 80 -- normal delay is 500ms
|
|
-- end
|
|
-- end
|
|
-- elseif refreshState == 1 then
|
|
-- physicalId, primId, dataId, value = telemetryPop()
|
|
-- if physicalId == 0x1A and primId == 0x32 and dataId == 0x0C30 then
|
|
-- fieldId = value % 256
|
|
-- if calibrationState == 2 then
|
|
-- if fieldId == 0x9D then
|
|
-- refreshState = 0
|
|
-- calibrationState = 0
|
|
-- calibrationStep = (calibrationStep + 1) % 6
|
|
-- end
|
|
-- else
|
|
-- field = fields[refreshIndex + 1]
|
|
-- if fieldId == field[3] then
|
|
-- value = math.floor(value / 256)
|
|
-- if field[3] >= 0x9E and field[3] <= 0xA0 then
|
|
-- b1 = value % 256
|
|
-- b2 = math.floor(value / 256)
|
|
-- value = b1*256 + b2
|
|
-- value = value - bit32.band(value, 0x8000) * 2
|
|
-- end
|
|
-- if field[2] == COMBO and #field == 6 then
|
|
-- for index = 1, #(field[6]), 1 do
|
|
-- if value == field[6][index] then
|
|
-- value = index - 1
|
|
-- break
|
|
-- end
|
|
-- end
|
|
-- elseif field[2] == VALUE and #field == 8 then
|
|
-- value = value - field[8] + field[5]
|
|
-- end
|
|
-- fields[refreshIndex + 1][4] = value
|
|
-- refreshIndex = refreshIndex + 1
|
|
-- refreshState = 0
|
|
-- end
|
|
-- end
|
|
-- elseif getTime() > telemetryPopTimeout then
|
|
-- refreshState = 0
|
|
-- calibrationState = 0
|
|
-- end
|
|
-- end
|
|
end
|
|
|
|
local function updateField(field)
|
|
value = field[4]
|
|
if field[2] == COMBO and #field == 6 then
|
|
value = field[6][1+value]
|
|
elseif field[2] == VALUE and #field == 8 then
|
|
value = value + field[8] - field[5]
|
|
end
|
|
telemetryWrite(field[3], value)
|
|
end
|
|
|
|
-- Main
|
|
local function runFieldsPage(event)
|
|
if event == EVT_EXIT_BREAK then -- exit script
|
|
return 2
|
|
elseif event == EVT_ENTER_BREAK then -- toggle editing/selecting current field
|
|
if fields[current][4] ~= nil then
|
|
edit = not edit
|
|
if edit == false then
|
|
updateField(fields[current])
|
|
end
|
|
end
|
|
elseif edit then
|
|
if event == EVT_PLUS_FIRST or event == EVT_PLUS_REPT then
|
|
addField(1)
|
|
elseif event == EVT_MINUS_FIRST or event == EVT_MINUS_REPT then
|
|
addField(-1)
|
|
end
|
|
else
|
|
if event == EVT_MINUS_FIRST then
|
|
selectField(1)
|
|
elseif event == EVT_PLUS_FIRST then
|
|
selectField(-1)
|
|
end
|
|
end
|
|
redrawFieldsPage()
|
|
return 0
|
|
end
|
|
|
|
local function runNoDevicesPage(event)
|
|
lcd.clear()
|
|
lcd.drawText(24, 28, "Waiting for Crossfire devices...")
|
|
return 0
|
|
end
|
|
|
|
local function runDevicePage(index, event)
|
|
lcd.clear()
|
|
lcd.drawScreenTitle(pages[index].name, index, #pages)
|
|
drawDevicePage(pages[index])
|
|
return 0
|
|
end
|
|
|
|
-- Init
|
|
local function init()
|
|
current, edit, refreshState, refreshIndex = 1, false, 0, 0
|
|
end
|
|
|
|
-- Main
|
|
local function run(event)
|
|
if event == nil then
|
|
error("Cannot be run as a model script!")
|
|
return 2
|
|
elseif event == EVT_PAGE_BREAK then
|
|
selectPage(1)
|
|
elseif event == EVT_PAGE_LONG then
|
|
killEvents(event);
|
|
selectPage(-1)
|
|
elseif event == EVT_EXIT_BREAK then
|
|
return 2
|
|
end
|
|
|
|
if #pages == 0 then
|
|
result = runNoDevicesPage(event)
|
|
else
|
|
result = runDevicePage(page, event)
|
|
end
|
|
|
|
refreshNext()
|
|
|
|
return result
|
|
end
|
|
|
|
return { init=init, run=run }
|