#134 #104 redstone RTU integration with supervisor unit, waste routing implemented, changed how redstone I/O works (again, should be good now), modbus fixes
This commit is contained in:
@@ -207,7 +207,7 @@ function coordinator.new_session(id, in_queue, out_queue, facility_units)
|
||||
end
|
||||
elseif cmd == CRDN_COMMANDS.SET_WASTE then
|
||||
if pkt.length == 3 then
|
||||
self.out_q.push_data(SV_Q_DATA.SET_WASTE, data)
|
||||
unit.set_waste(pkt.data[3])
|
||||
else
|
||||
log.debug(log_header .. "CRDN command unit set waste missing option")
|
||||
end
|
||||
|
||||
@@ -27,26 +27,10 @@ local println = util.println
|
||||
local print_ts = util.print_ts
|
||||
local println_ts = util.println_ts
|
||||
|
||||
local RTU_S_CMDS = {
|
||||
}
|
||||
|
||||
local RTU_S_DATA = {
|
||||
RS_COMMAND = 1,
|
||||
UNIT_COMMAND = 2
|
||||
}
|
||||
|
||||
rtu.RTU_S_CMDS = RTU_S_CMDS
|
||||
rtu.RTU_S_DATA = RTU_S_DATA
|
||||
|
||||
local PERIODICS = {
|
||||
KEEP_ALIVE = 2000
|
||||
}
|
||||
|
||||
---@class rs_session_command
|
||||
---@field reactor integer
|
||||
---@field channel RS_IO
|
||||
---@field value integer|boolean
|
||||
|
||||
-- create a new RTU session
|
||||
---@param id integer
|
||||
---@param in_queue mqueue
|
||||
@@ -74,8 +58,6 @@ function rtu.new_session(id, in_queue, out_queue, advertisement, facility_units)
|
||||
last_update = 0,
|
||||
keep_alive = 0
|
||||
},
|
||||
rs_io_q = {},
|
||||
turbine_cmd_q = {},
|
||||
units = {}
|
||||
}
|
||||
|
||||
@@ -84,8 +66,6 @@ function rtu.new_session(id, in_queue, out_queue, advertisement, facility_units)
|
||||
|
||||
local function _reset_config()
|
||||
self.units = {}
|
||||
self.rs_io_q = {}
|
||||
self.turbine_cmd_q = {}
|
||||
end
|
||||
|
||||
-- parse the recorded advertisement and create unit sub-sessions
|
||||
@@ -141,14 +121,15 @@ function rtu.new_session(id, in_queue, out_queue, advertisement, facility_units)
|
||||
|
||||
if u_type == RTU_UNIT_TYPES.REDSTONE then
|
||||
-- redstone
|
||||
unit, rs_in_q = svrs_redstone.new(self.id, i, unit_advert, self.modbus_q)
|
||||
unit = svrs_redstone.new(self.id, i, unit_advert, self.modbus_q)
|
||||
if type(unit) ~= "nil" then target_unit.add_redstone(unit) end
|
||||
elseif u_type == RTU_UNIT_TYPES.BOILER_VALVE then
|
||||
-- boiler (Mekanism 10.1+)
|
||||
unit = svrs_boilerv.new(self.id, i, unit_advert, self.modbus_q)
|
||||
if type(unit) ~= "nil" then target_unit.add_boiler(unit) end
|
||||
elseif u_type == RTU_UNIT_TYPES.TURBINE_VALVE then
|
||||
-- turbine (Mekanism 10.1+)
|
||||
unit, tbv_in_q = svrs_turbinev.new(self.id, i, unit_advert, self.modbus_q)
|
||||
unit = svrs_turbinev.new(self.id, i, unit_advert, self.modbus_q)
|
||||
if type(unit) ~= "nil" then target_unit.add_turbine(unit) end
|
||||
elseif u_type == RTU_UNIT_TYPES.IMATRIX then
|
||||
-- induction matrix
|
||||
@@ -169,31 +150,6 @@ function rtu.new_session(id, in_queue, out_queue, advertisement, facility_units)
|
||||
|
||||
if unit ~= nil then
|
||||
table.insert(self.units, unit)
|
||||
|
||||
if u_type == RTU_UNIT_TYPES.REDSTONE then
|
||||
if self.rs_io_q[unit_advert.reactor] == nil then
|
||||
self.rs_io_q[unit_advert.reactor] = rs_in_q
|
||||
else
|
||||
_reset_config()
|
||||
log.error(log_header .. util.c("bad advertisement: duplicate redstone RTU for reactor " .. unit_advert.reactor))
|
||||
break
|
||||
end
|
||||
elseif u_type == RTU_UNIT_TYPES.TURBINE_VALVE then
|
||||
if self.turbine_cmd_q[unit_advert.reactor] == nil then
|
||||
self.turbine_cmd_q[unit_advert.reactor] = {}
|
||||
end
|
||||
|
||||
local queues = self.turbine_cmd_q[unit_advert.reactor]
|
||||
|
||||
if queues[unit_advert.index] == nil then
|
||||
queues[unit_advert.index] = tbv_in_q
|
||||
else
|
||||
_reset_config()
|
||||
log.error(log_header .. util.c("bad advertisement: duplicate turbine RTU (same index of ",
|
||||
unit_advert.index, ") for reactor ", unit_advert.reactor))
|
||||
break
|
||||
end
|
||||
end
|
||||
else
|
||||
_reset_config()
|
||||
if type(u_type) == "number" then
|
||||
@@ -353,25 +309,6 @@ function rtu.new_session(id, in_queue, out_queue, advertisement, facility_units)
|
||||
-- handle instruction
|
||||
elseif msg.qtype == mqueue.TYPE.DATA then
|
||||
-- instruction with body
|
||||
local cmd = msg.message ---@type queue_data
|
||||
if cmd.key == RTU_S_DATA.RS_COMMAND then
|
||||
local rs_cmd = cmd.val ---@type rs_session_command
|
||||
|
||||
if rsio.is_valid_channel(rs_cmd.channel) then
|
||||
cmd.key = svrs_redstone.RS_RTU_S_DATA.RS_COMMAND
|
||||
if rs_cmd.reactor == nil then
|
||||
-- for all reactors (facility)
|
||||
for i = 1, #self.rs_io_q do
|
||||
local q = self.rs_io.q[i] ---@type mqueue
|
||||
q.push_data(msg)
|
||||
end
|
||||
elseif self.rs_io_q[rs_cmd.reactor] ~= nil then
|
||||
-- for just one reactor
|
||||
local q = self.rs_io.q[rs_cmd.reactor] ---@type mqueue
|
||||
q.push_data(msg)
|
||||
end
|
||||
end
|
||||
end
|
||||
end
|
||||
end
|
||||
|
||||
|
||||
16
supervisor/session/rtu/qtypes.lua
Normal file
16
supervisor/session/rtu/qtypes.lua
Normal file
@@ -0,0 +1,16 @@
|
||||
---@class rtu_unit_qtypes
|
||||
local qtypes = {}
|
||||
|
||||
local TBV_RTU_S_CMDS = {
|
||||
INC_DUMP_MODE = 1,
|
||||
DEC_DUMP_MODE = 2
|
||||
}
|
||||
|
||||
local TBV_RTU_S_DATA = {
|
||||
SET_DUMP_MODE = 1
|
||||
}
|
||||
|
||||
qtypes.TBV_RTU_S_CMDS = TBV_RTU_S_CMDS
|
||||
qtypes.TBV_RTU_S_DATA = TBV_RTU_S_DATA
|
||||
|
||||
return qtypes
|
||||
@@ -12,39 +12,40 @@ local redstone = {}
|
||||
local RTU_UNIT_TYPES = comms.RTU_UNIT_TYPES
|
||||
local MODBUS_FCODE = types.MODBUS_FCODE
|
||||
|
||||
local RS_IO = rsio.IO
|
||||
local IO_PORT = rsio.IO
|
||||
local IO_LVL = rsio.IO_LVL
|
||||
local IO_DIR = rsio.IO_DIR
|
||||
local IO_MODE = rsio.IO_MODE
|
||||
|
||||
local RS_RTU_S_CMDS = {
|
||||
}
|
||||
|
||||
local RS_RTU_S_DATA = {
|
||||
RS_COMMAND = 1
|
||||
}
|
||||
|
||||
redstone.RS_RTU_S_CMDS = RS_RTU_S_CMDS
|
||||
redstone.RS_RTU_S_DATA = RS_RTU_S_DATA
|
||||
local TXN_READY = -1
|
||||
|
||||
local TXN_TYPES = {
|
||||
DI_READ = 1,
|
||||
COIL_WRITE = 2,
|
||||
INPUT_REG_READ = 3,
|
||||
HOLD_REG_WRITE = 4
|
||||
COIL_READ = 3,
|
||||
INPUT_REG_READ = 4,
|
||||
HOLD_REG_WRITE = 5,
|
||||
HOLD_REG_READ = 6
|
||||
}
|
||||
|
||||
local TXN_TAGS = {
|
||||
"redstone.di_read",
|
||||
"redstone.coil_write",
|
||||
"redstone.input_reg_write",
|
||||
"redstone.hold_reg_write"
|
||||
"redstone.coil_read",
|
||||
"redstone.input_reg_read",
|
||||
"redstone.hold_reg_write",
|
||||
"redstone.hold_reg_read"
|
||||
}
|
||||
|
||||
local PERIODICS = {
|
||||
INPUT_READ = 200
|
||||
INPUT_READ = 200,
|
||||
OUTPUT_SYNC = 200
|
||||
}
|
||||
|
||||
---@class phy_entry
|
||||
---@field phy IO_LVL
|
||||
---@field req IO_LVL
|
||||
|
||||
-- create a new redstone rtu session runner
|
||||
---@param session_id integer
|
||||
---@param unit_id integer
|
||||
@@ -62,57 +63,127 @@ function redstone.new(session_id, unit_id, advert, out_queue)
|
||||
|
||||
local self = {
|
||||
session = unit_session.new(session_id, unit_id, advert, out_queue, log_tag, TXN_TAGS),
|
||||
in_q = mqueue.new(),
|
||||
has_di = false,
|
||||
has_do = false,
|
||||
has_ai = false,
|
||||
has_ao = false,
|
||||
periodics = {
|
||||
next_di_req = 0,
|
||||
next_ir_req = 0
|
||||
next_di_req = 0,
|
||||
next_cl_sync = 0,
|
||||
next_ir_req = 0,
|
||||
next_hr_sync = 0
|
||||
},
|
||||
---@class rs_io_list
|
||||
io_list = {
|
||||
digital_in = {}, -- discrete inputs
|
||||
digital_out = {}, -- coils
|
||||
analog_in = {}, -- input registers
|
||||
analog_out = {} -- holding registers
|
||||
digital_in = {}, -- discrete inputs
|
||||
digital_out = {}, -- coils
|
||||
analog_in = {}, -- input registers
|
||||
analog_out = {} -- holding registers
|
||||
},
|
||||
db = {}
|
||||
phy_trans = { coils = -1, hold_regs = -1 },
|
||||
-- last set/read ports (reflecting the current state of the RTU)
|
||||
---@class rs_io_states
|
||||
phy_io = {
|
||||
digital_in = {}, -- discrete inputs
|
||||
digital_out = {}, -- coils
|
||||
analog_in = {}, -- input registers
|
||||
analog_out = {} -- holding registers
|
||||
},
|
||||
---@class redstone_session_db
|
||||
db = {
|
||||
-- read/write functions for connected I/O
|
||||
io = {}
|
||||
}
|
||||
}
|
||||
|
||||
local public = self.session.get()
|
||||
|
||||
-- INITIALIZE --
|
||||
|
||||
-- create all channels as disconnected
|
||||
for _ = 1, #RS_IO do
|
||||
-- create all ports as disconnected
|
||||
for _ = 1, #IO_PORT do
|
||||
table.insert(self.db, IO_LVL.DISCONNECT)
|
||||
end
|
||||
|
||||
-- setup I/O
|
||||
for i = 1, #advert.rsio do
|
||||
local channel = advert.rsio[i]
|
||||
local port = advert.rsio[i]
|
||||
|
||||
if rsio.is_valid_channel(channel) then
|
||||
local mode = rsio.get_io_mode(channel)
|
||||
if rsio.is_valid_port(port) then
|
||||
local mode = rsio.get_io_mode(port)
|
||||
|
||||
if mode == IO_MODE.DIGITAL_IN then
|
||||
self.has_di = true
|
||||
table.insert(self.io_list.digital_in, channel)
|
||||
table.insert(self.io_list.digital_in, port)
|
||||
|
||||
self.phy_io.digital_in[port] = { phy = IO_LVL.FLOATING, req = IO_LVL.FLOATING }
|
||||
|
||||
---@class rs_db_dig_io
|
||||
local io_f = {
|
||||
read = function () return rsio.digital_is_active(port, self.phy_io.digital_in[port].phy) end,
|
||||
---@param active boolean
|
||||
write = function (active) end
|
||||
}
|
||||
|
||||
self.db.io[port] = io_f
|
||||
elseif mode == IO_MODE.DIGITAL_OUT then
|
||||
table.insert(self.io_list.digital_out, channel)
|
||||
self.has_do = true
|
||||
table.insert(self.io_list.digital_out, port)
|
||||
|
||||
self.phy_io.digital_out[port] = { phy = IO_LVL.FLOATING, req = IO_LVL.FLOATING }
|
||||
|
||||
---@class rs_db_dig_io
|
||||
local io_f = {
|
||||
read = function () return rsio.digital_is_active(port, self.phy_io.digital_out[port].phy) end,
|
||||
---@param active boolean
|
||||
write = function (active)
|
||||
local level = rsio.digital_write_active(port, active)
|
||||
if level ~= nil then self.phy_io.digital_out[port].req = level end
|
||||
end
|
||||
}
|
||||
|
||||
self.db.io[port] = io_f
|
||||
elseif mode == IO_MODE.ANALOG_IN then
|
||||
self.has_ai = true
|
||||
table.insert(self.io_list.analog_in, channel)
|
||||
table.insert(self.io_list.analog_in, port)
|
||||
|
||||
self.phy_io.analog_in[port] = { phy = 0, req = 0 }
|
||||
|
||||
---@class rs_db_ana_io
|
||||
local io_f = {
|
||||
---@return integer
|
||||
read = function () return self.phy_io.analog_in[port].phy end,
|
||||
---@param value integer
|
||||
write = function (value) end
|
||||
}
|
||||
|
||||
self.db.io[port] = io_f
|
||||
elseif mode == IO_MODE.ANALOG_OUT then
|
||||
table.insert(self.io_list.analog_out, channel)
|
||||
self.has_ao = true
|
||||
table.insert(self.io_list.analog_out, port)
|
||||
|
||||
self.phy_io.analog_out[port] = { phy = 0, req = 0 }
|
||||
|
||||
---@class rs_db_ana_io
|
||||
local io_f = {
|
||||
---@return integer
|
||||
read = function () return self.phy_io.analog_out[port].phy end,
|
||||
---@param value integer
|
||||
write = function (value)
|
||||
if value >= 0 and value <= 15 then
|
||||
self.phy_io.analog_out[port].req = value
|
||||
end
|
||||
end
|
||||
}
|
||||
|
||||
self.db.io[port] = io_f
|
||||
else
|
||||
-- should be unreachable code, we already validated channels
|
||||
log.error(util.c(log_tag, "failed to identify advertisement channel IO mode (", channel, ")"), true)
|
||||
-- should be unreachable code, we already validated ports
|
||||
log.error(util.c(log_tag, "failed to identify advertisement port IO mode (", port, ")"), true)
|
||||
return nil
|
||||
end
|
||||
|
||||
self.db[channel] = IO_LVL.LOW
|
||||
else
|
||||
log.error(util.c(log_tag, "invalid advertisement channel (", channel, ")"), true)
|
||||
log.error(util.c(log_tag, "invalid advertisement port (", port, ")"), true)
|
||||
return nil
|
||||
end
|
||||
end
|
||||
@@ -129,14 +200,40 @@ function redstone.new(session_id, unit_id, advert, out_queue)
|
||||
self.session.send_request(TXN_TYPES.INPUT_REG_READ, MODBUS_FCODE.READ_INPUT_REGS, { 1, #self.io_list.analog_in })
|
||||
end
|
||||
|
||||
-- write coil output
|
||||
local function _write_coil(coil, value)
|
||||
self.session.send_request(TXN_TYPES.COIL_WRITE, MODBUS_FCODE.WRITE_MUL_COILS, { coil, value })
|
||||
-- write all coil outputs
|
||||
local function _write_coils()
|
||||
local params = { 1 }
|
||||
|
||||
local outputs = self.phy_io.digital_out
|
||||
for i = 1, #self.io_list.digital_out do
|
||||
local port = self.io_list.digital_out[i]
|
||||
table.insert(params, outputs[port].req)
|
||||
end
|
||||
|
||||
self.phy_trans.coils = self.session.send_request(TXN_TYPES.COIL_WRITE, MODBUS_FCODE.WRITE_MUL_COILS, params)
|
||||
end
|
||||
|
||||
-- write holding register output
|
||||
local function _write_holding_register(reg, value)
|
||||
self.session.send_request(TXN_TYPES.HOLD_REG_WRITE, MODBUS_FCODE.WRITE_MUL_HOLD_REGS, { reg, value })
|
||||
-- read all coil outputs
|
||||
local function _read_coils()
|
||||
self.session.send_request(TXN_TYPES.COIL_READ, MODBUS_FCODE.READ_COILS, { 1, #self.io_list.digital_out })
|
||||
end
|
||||
|
||||
-- write all holding register outputs
|
||||
local function _write_holding_registers()
|
||||
local params = { 1 }
|
||||
|
||||
local outputs = self.phy_io.analog_out
|
||||
for i = 1, #self.io_list.analog_out do
|
||||
local port = self.io_list.analog_out[i]
|
||||
table.insert(params, outputs[port].req)
|
||||
end
|
||||
|
||||
self.phy_trans.hold_regs = self.session.send_request(TXN_TYPES.HOLD_REG_WRITE, MODBUS_FCODE.WRITE_MUL_HOLD_REGS, params)
|
||||
end
|
||||
|
||||
-- read all holding register outputs
|
||||
local function _read_holding_registers()
|
||||
self.session.send_request(TXN_TYPES.HOLD_REG_READ, MODBUS_FCODE.READ_MUL_HOLD_REGS, { 1, #self.io_list.analog_out })
|
||||
end
|
||||
|
||||
-- PUBLIC FUNCTIONS --
|
||||
@@ -146,14 +243,23 @@ function redstone.new(session_id, unit_id, advert, out_queue)
|
||||
function public.handle_packet(m_pkt)
|
||||
local txn_type = self.session.try_resolve(m_pkt)
|
||||
if txn_type == false then
|
||||
-- nothing to do
|
||||
-- check if this is a failed write request
|
||||
-- redstone operations are always immediately executed, so this would not be from an ACK or BUSY
|
||||
if m_pkt.txn_id == self.phy_trans.coils then
|
||||
self.phy_trans.coils = TXN_READY
|
||||
log.debug(log_tag .. "failed to write coils, retrying soon")
|
||||
elseif m_pkt.txn_id == self.phy_trans.hold_regs then
|
||||
self.phy_trans.hold_regs = TXN_READY
|
||||
log.debug(log_tag .. "failed to write holding registers, retrying soon")
|
||||
end
|
||||
elseif txn_type == TXN_TYPES.DI_READ then
|
||||
-- discrete input read response
|
||||
if m_pkt.length == #self.io_list.digital_in then
|
||||
for i = 1, m_pkt.length do
|
||||
local channel = self.io_list.digital_in[i]
|
||||
local port = self.io_list.digital_in[i]
|
||||
local value = m_pkt.data[i]
|
||||
self.db[channel] = value
|
||||
|
||||
self.phy_io.digital_in[port].phy = value
|
||||
end
|
||||
else
|
||||
log.debug(log_tag .. "MODBUS transaction reply length mismatch (" .. TXN_TAGS[txn_type] .. ")")
|
||||
@@ -162,15 +268,55 @@ function redstone.new(session_id, unit_id, advert, out_queue)
|
||||
-- input register read response
|
||||
if m_pkt.length == #self.io_list.analog_in then
|
||||
for i = 1, m_pkt.length do
|
||||
local channel = self.io_list.analog_in[i]
|
||||
local port = self.io_list.analog_in[i]
|
||||
local value = m_pkt.data[i]
|
||||
self.db[channel] = value
|
||||
|
||||
self.phy_io.analog_in[port].phy = value
|
||||
end
|
||||
else
|
||||
log.debug(log_tag .. "MODBUS transaction reply length mismatch (" .. TXN_TAGS[txn_type] .. ")")
|
||||
end
|
||||
elseif txn_type == TXN_TYPES.COIL_WRITE or txn_type == TXN_TYPES.HOLD_REG_WRITE then
|
||||
-- successful acknowledgement
|
||||
elseif txn_type == TXN_TYPES.COIL_WRITE then
|
||||
-- successful acknowledgement, read back
|
||||
_read_coils()
|
||||
elseif txn_type == TXN_TYPES.COIL_READ then
|
||||
-- update phy I/O table
|
||||
-- if there are multiple outputs for the same port, they will overwrite eachother (but *should* be identical)
|
||||
-- given these are redstone outputs, if one worked they all should have, so no additional verification will be done
|
||||
if m_pkt.length == #self.io_list.digital_out then
|
||||
for i = 1, m_pkt.length do
|
||||
local port = self.io_list.digital_out[i]
|
||||
local value = m_pkt.data[i]
|
||||
|
||||
self.phy_io.digital_out[port].phy = value
|
||||
if self.phy_io.digital_out[port].req == IO_LVL.FLOATING then
|
||||
self.phy_io.digital_out[port].req = value
|
||||
end
|
||||
end
|
||||
|
||||
self.phy_trans.coils = TXN_READY
|
||||
else
|
||||
log.debug(log_tag .. "MODBUS transaction reply length mismatch (" .. TXN_TAGS[txn_type] .. ")")
|
||||
end
|
||||
elseif txn_type == TXN_TYPES.HOLD_REG_WRITE then
|
||||
-- successful acknowledgement, read back
|
||||
_read_holding_registers()
|
||||
elseif txn_type == TXN_TYPES.HOLD_REG_READ then
|
||||
-- update phy I/O table
|
||||
-- if there are multiple outputs for the same port, they will overwrite eachother (but *should* be identical)
|
||||
-- given these are redstone outputs, if one worked they all should have, so no additional verification will be done
|
||||
if m_pkt.length == #self.io_list.analog_out then
|
||||
for i = 1, m_pkt.length do
|
||||
local port = self.io_list.analog_out[i]
|
||||
local value = m_pkt.data[i]
|
||||
|
||||
self.phy_io.analog_out[port].phy = value
|
||||
end
|
||||
else
|
||||
log.debug(log_tag .. "MODBUS transaction reply length mismatch (" .. TXN_TAGS[txn_type] .. ")")
|
||||
end
|
||||
|
||||
self.phy_trans.hold_regs = TXN_READY
|
||||
elseif txn_type == nil then
|
||||
log.error(log_tag .. "unknown transaction reply")
|
||||
else
|
||||
@@ -181,60 +327,6 @@ function redstone.new(session_id, unit_id, advert, out_queue)
|
||||
-- update this runner
|
||||
---@param time_now integer milliseconds
|
||||
function public.update(time_now)
|
||||
-- check command queue
|
||||
while self.in_q.ready() do
|
||||
-- get a new message to process
|
||||
local msg = self.in_q.pop()
|
||||
|
||||
if msg ~= nil then
|
||||
if msg.qtype == mqueue.TYPE.DATA then
|
||||
-- instruction with body
|
||||
local cmd = msg.message ---@type queue_data
|
||||
if cmd.key == RS_RTU_S_DATA.RS_COMMAND then
|
||||
local rs_cmd = cmd.val ---@type rs_session_command
|
||||
|
||||
if self.db[rs_cmd.channel] ~= IO_LVL.DISCONNECT then
|
||||
-- we have this as a connected channel
|
||||
local mode = rsio.get_io_mode(rs_cmd.channel)
|
||||
if mode == IO_MODE.DIGITAL_OUT then
|
||||
-- record the value for retries
|
||||
self.db[rs_cmd.channel] = rs_cmd.value
|
||||
|
||||
-- find the coil address then write to it
|
||||
for i = 0, #self.digital_out do
|
||||
if self.digital_out[i] == rs_cmd.channel then
|
||||
_write_coil(i, rs_cmd.value)
|
||||
break
|
||||
end
|
||||
end
|
||||
elseif mode == IO_MODE.ANALOG_OUT then
|
||||
-- record the value for retries
|
||||
self.db[rs_cmd.channel] = rs_cmd.value
|
||||
|
||||
-- find the holding register address then write to it
|
||||
for i = 0, #self.analog_out do
|
||||
if self.analog_out[i] == rs_cmd.channel then
|
||||
_write_holding_register(i, rs_cmd.value)
|
||||
break
|
||||
end
|
||||
end
|
||||
else
|
||||
log.debug(util.c(log_tag, "attemted write to non D/O or A/O mode ", mode))
|
||||
end
|
||||
end
|
||||
end
|
||||
end
|
||||
end
|
||||
|
||||
-- max 100ms spent processing queue
|
||||
if util.time() - time_now > 100 then
|
||||
log.warning(log_tag .. "exceeded 100ms queue process limit")
|
||||
break
|
||||
end
|
||||
end
|
||||
|
||||
time_now = util.time()
|
||||
|
||||
-- poll digital inputs
|
||||
if self.has_di then
|
||||
if self.periodics.next_di_req <= time_now then
|
||||
@@ -243,6 +335,20 @@ function redstone.new(session_id, unit_id, advert, out_queue)
|
||||
end
|
||||
end
|
||||
|
||||
-- sync digital outputs
|
||||
if self.has_do then
|
||||
if (self.periodics.next_cl_sync <= time_now) and (self.phy_trans.coils == TXN_READY) then
|
||||
for _, entry in pairs(self.phy_io.digital_out) do
|
||||
if entry.phy ~= entry.req then
|
||||
_write_coils()
|
||||
break
|
||||
end
|
||||
end
|
||||
|
||||
self.periodics.next_cl_sync = time_now + PERIODICS.OUTPUT_SYNC
|
||||
end
|
||||
end
|
||||
|
||||
-- poll analog inputs
|
||||
if self.has_ai then
|
||||
if self.periodics.next_ir_req <= time_now then
|
||||
@@ -251,6 +357,20 @@ function redstone.new(session_id, unit_id, advert, out_queue)
|
||||
end
|
||||
end
|
||||
|
||||
-- sync analog outputs
|
||||
if self.has_ao then
|
||||
if (self.periodics.next_hr_sync <= time_now) and (self.phy_trans.hold_regs == TXN_READY) then
|
||||
for _, entry in pairs(self.phy_io.analog_out) do
|
||||
if entry.phy ~= entry.req then
|
||||
_write_holding_registers()
|
||||
break
|
||||
end
|
||||
end
|
||||
|
||||
self.periodics.next_hr_sync = time_now + PERIODICS.OUTPUT_SYNC
|
||||
end
|
||||
end
|
||||
|
||||
self.session.post_update()
|
||||
end
|
||||
|
||||
@@ -262,7 +382,7 @@ function redstone.new(session_id, unit_id, advert, out_queue)
|
||||
-- get the unit session database
|
||||
function public.get_db() return self.db end
|
||||
|
||||
return public, self.in_q
|
||||
return public
|
||||
end
|
||||
|
||||
return redstone
|
||||
|
||||
@@ -4,6 +4,7 @@ local mqueue = require("scada-common.mqueue")
|
||||
local types = require("scada-common.types")
|
||||
local util = require("scada-common.util")
|
||||
|
||||
local qtypes = require("supervisor.session.rtu.qtypes")
|
||||
local unit_session = require("supervisor.session.rtu.unit_session")
|
||||
|
||||
local turbinev = {}
|
||||
@@ -12,17 +13,8 @@ local RTU_UNIT_TYPES = comms.RTU_UNIT_TYPES
|
||||
local DUMPING_MODE = types.DUMPING_MODE
|
||||
local MODBUS_FCODE = types.MODBUS_FCODE
|
||||
|
||||
local TBV_RTU_S_CMDS = {
|
||||
INC_DUMP_MODE = 1,
|
||||
DEC_DUMP_MODE = 2
|
||||
}
|
||||
|
||||
local TBV_RTU_S_DATA = {
|
||||
SET_DUMP_MODE = 1
|
||||
}
|
||||
|
||||
turbinev.RS_RTU_S_CMDS = TBV_RTU_S_CMDS
|
||||
turbinev.RS_RTU_S_DATA = TBV_RTU_S_DATA
|
||||
local TBV_RTU_S_CMDS = qtypes.TBV_RTU_S_CMDS
|
||||
local TBV_RTU_S_DATA = qtypes.TBV_RTU_S_DATA
|
||||
|
||||
local TXN_TYPES = {
|
||||
FORMED = 1,
|
||||
@@ -67,7 +59,6 @@ function turbinev.new(session_id, unit_id, advert, out_queue)
|
||||
|
||||
local self = {
|
||||
session = unit_session.new(session_id, unit_id, advert, out_queue, log_tag, TXN_TAGS),
|
||||
in_q = mqueue.new(),
|
||||
has_build = false,
|
||||
periodics = {
|
||||
next_formed_req = 0,
|
||||
@@ -240,9 +231,9 @@ function turbinev.new(session_id, unit_id, advert, out_queue)
|
||||
---@param time_now integer milliseconds
|
||||
function public.update(time_now)
|
||||
-- check command queue
|
||||
while self.in_q.ready() do
|
||||
while self.session.in_q.ready() do
|
||||
-- get a new message to process
|
||||
local msg = self.in_q.pop()
|
||||
local msg = self.session.in_q.pop()
|
||||
|
||||
if msg ~= nil then
|
||||
if msg.qtype == mqueue.TYPE.COMMAND then
|
||||
@@ -254,15 +245,21 @@ function turbinev.new(session_id, unit_id, advert, out_queue)
|
||||
elseif cmd == TBV_RTU_S_CMDS.DEC_DUMP_MODE then
|
||||
_dec_dump_mode()
|
||||
else
|
||||
log.debug(util.c(log_tag, "unrecognized in_q command ", cmd))
|
||||
log.debug(util.c(log_tag, "unrecognized in-queue command ", cmd))
|
||||
end
|
||||
elseif msg.qtype == mqueue.TYPE.DATA then
|
||||
-- instruction with body
|
||||
local cmd = msg.message ---@type queue_data
|
||||
if cmd.key == TBV_RTU_S_DATA.SET_DUMP_MODE then
|
||||
_set_dump_mode(cmd.val)
|
||||
if cmd.val == types.DUMPING_MODE.IDLE or
|
||||
cmd.val == types.DUMPING_MODE.DUMPING_EXCESS or
|
||||
cmd.val == types.DUMPING_MODE.DUMPING then
|
||||
_set_dump_mode(cmd.val)
|
||||
else
|
||||
log.debug(util.c(log_tag, "unrecognized dumping mode \"", cmd.val, "\""))
|
||||
end
|
||||
else
|
||||
log.debug(util.c(log_tag, "unrecognized in_q data ", cmd.key))
|
||||
log.debug(util.c(log_tag, "unrecognized in-queue data ", cmd.key))
|
||||
end
|
||||
end
|
||||
end
|
||||
@@ -313,7 +310,7 @@ function turbinev.new(session_id, unit_id, advert, out_queue)
|
||||
-- get the unit session database
|
||||
function public.get_db() return self.db end
|
||||
|
||||
return public, self.in_q
|
||||
return public
|
||||
end
|
||||
|
||||
return turbinev
|
||||
|
||||
@@ -1,5 +1,6 @@
|
||||
local comms = require("scada-common.comms")
|
||||
local log = require("scada-common.log")
|
||||
local mqueue = require("scada-common.mqueue")
|
||||
local types = require("scada-common.types")
|
||||
local util = require("scada-common.util")
|
||||
|
||||
@@ -42,7 +43,9 @@ function unit_session.new(session_id, unit_id, advert, out_queue, log_tag, txn_t
|
||||
}
|
||||
|
||||
---@class _unit_session
|
||||
local protected = {}
|
||||
local protected = {
|
||||
in_q = mqueue.new()
|
||||
}
|
||||
|
||||
---@class unit_session
|
||||
local public = {}
|
||||
@@ -53,6 +56,7 @@ function unit_session.new(session_id, unit_id, advert, out_queue, log_tag, txn_t
|
||||
---@param txn_type integer transaction type
|
||||
---@param f_code MODBUS_FCODE function code
|
||||
---@param register_param table register range or register and values
|
||||
---@return integer txn_id transaction ID of this transaction
|
||||
function protected.send_request(txn_type, f_code, register_param)
|
||||
local m_pkt = comms.modbus_packet()
|
||||
local txn_id = self.transaction_controller.create(txn_type)
|
||||
@@ -60,11 +64,13 @@ function unit_session.new(session_id, unit_id, advert, out_queue, log_tag, txn_t
|
||||
m_pkt.make(txn_id, self.unit_id, f_code, register_param)
|
||||
|
||||
self.out_q.push_packet(m_pkt)
|
||||
|
||||
return txn_id
|
||||
end
|
||||
|
||||
-- try to resolve a MODBUS transaction
|
||||
---@param m_pkt modbus_frame MODBUS packet
|
||||
---@return integer|false txn_type transaction type or false on error/busy
|
||||
---@return integer|false txn_type, integer txn_id transaction type or false on error/busy, transaction ID
|
||||
function protected.try_resolve(m_pkt)
|
||||
if m_pkt.scada_frame.protocol() == PROTOCOLS.MODBUS_TCP then
|
||||
if m_pkt.unit_id == self.unit_id then
|
||||
@@ -110,7 +116,7 @@ function unit_session.new(session_id, unit_id, advert, out_queue, log_tag, txn_t
|
||||
self.device_fail = false
|
||||
|
||||
-- no error, return the transaction type
|
||||
return txn_type
|
||||
return txn_type, m_pkt.txn_id
|
||||
end
|
||||
else
|
||||
log.error(log_tag .. "wrong unit ID: " .. m_pkt.unit_id, true)
|
||||
@@ -120,7 +126,7 @@ function unit_session.new(session_id, unit_id, advert, out_queue, log_tag, txn_t
|
||||
end
|
||||
|
||||
-- error or transaction in progress, return false
|
||||
return false
|
||||
return false, m_pkt.txn_id
|
||||
end
|
||||
|
||||
-- post update tasks
|
||||
@@ -141,6 +147,8 @@ function unit_session.new(session_id, unit_id, advert, out_queue, log_tag, txn_t
|
||||
function public.get_device_idx() return self.device_index end
|
||||
-- get the reactor ID
|
||||
function public.get_reactor() return self.reactor end
|
||||
-- get the command queue
|
||||
function public.get_cmd_queue() return protected.in_q end
|
||||
|
||||
-- close this unit
|
||||
function public.close() self.connected = false end
|
||||
@@ -171,7 +179,10 @@ function unit_session.new(session_id, unit_id, advert, out_queue, log_tag, txn_t
|
||||
end
|
||||
|
||||
-- get the unit session database
|
||||
function public.get_db() return {} end
|
||||
function public.get_db()
|
||||
log.debug("template unit_session.get_db() called", true)
|
||||
return {}
|
||||
end
|
||||
|
||||
return protected
|
||||
end
|
||||
|
||||
@@ -9,9 +9,8 @@ local SV_Q_DATA = {
|
||||
SCRAM = 2,
|
||||
RESET_RPS = 3,
|
||||
SET_BURN = 4,
|
||||
SET_WASTE = 5,
|
||||
__END_PLC_CMDS__ = 6,
|
||||
CRDN_ACK = 7
|
||||
__END_PLC_CMDS__ = 5,
|
||||
CRDN_ACK = 6
|
||||
}
|
||||
|
||||
---@class coord_ack
|
||||
|
||||
@@ -82,8 +82,6 @@ local function _sv_handle_outq(session)
|
||||
plc_s.in_queue.push_command(PLC_S_CMDS.RPS_RESET)
|
||||
elseif cmd.key == SV_Q_DATA.SET_BURN and type(cmd.val) == "table" and #cmd.val == 2 then
|
||||
plc_s.in_queue.push_data(PLC_S_DATA.BURN_RATE, cmd.val[2])
|
||||
elseif cmd.key == SV_Q_DATA.SET_WASTE and type(cmd.val) == "table" and #cmd.val == 2 then
|
||||
---@todo set waste
|
||||
else
|
||||
log.debug(util.c("unknown PLC SV queue command ", cmd.key))
|
||||
end
|
||||
|
||||
@@ -1,9 +1,15 @@
|
||||
local types = require("scada-common.types")
|
||||
local util = require("scada-common.util")
|
||||
local log = require("scada-common.log")
|
||||
local log = require("scada-common.log")
|
||||
local rsio = require("scada-common.rsio")
|
||||
local types = require("scada-common.types")
|
||||
local util = require("scada-common.util")
|
||||
|
||||
local qtypes = require("supervisor.session.rtu.qtypes")
|
||||
|
||||
---@class reactor_control_unit
|
||||
local unit = {}
|
||||
|
||||
local WASTE_MODE = types.WASTE_MODE
|
||||
|
||||
local ALARM = types.ALARM
|
||||
local PRIO = types.ALARM_PRIORITY
|
||||
local ALARM_STATE = types.ALARM_STATE
|
||||
@@ -11,6 +17,8 @@ local ALARM_STATE = types.ALARM_STATE
|
||||
local TRI_FAIL = types.TRI_FAIL
|
||||
local DUMPING_MODE = types.DUMPING_MODE
|
||||
|
||||
local IO = rsio.IO
|
||||
|
||||
local FLOW_STABILITY_DELAY_MS = 15000
|
||||
|
||||
local DT_KEYS = {
|
||||
@@ -105,6 +113,7 @@ function unit.new(for_reactor, num_boilers, num_turbines)
|
||||
-- "It's just a routine turbin' trip!" -Bill Gibson
|
||||
TurbineTrip = { state = AISTATE.INACTIVE, trip_time = 0, hold_time = 0, id = ALARM.TurbineTrip, tier = PRIO.URGENT }
|
||||
},
|
||||
---@class unit_db
|
||||
db = {
|
||||
---@class annunciator
|
||||
annunciator = {
|
||||
@@ -173,6 +182,8 @@ function unit.new(for_reactor, num_boilers, num_turbines)
|
||||
|
||||
-- PRIVATE FUNCTIONS --
|
||||
|
||||
--#region time derivative utility functions
|
||||
|
||||
-- compute a change with respect to time of the given value
|
||||
---@param key string value key
|
||||
---@param value number value
|
||||
@@ -204,13 +215,44 @@ function unit.new(for_reactor, num_boilers, num_turbines)
|
||||
---@param key string value key
|
||||
---@return number
|
||||
local function _get_dt(key)
|
||||
if self.deltas[key] then
|
||||
return self.deltas[key].dt
|
||||
else
|
||||
return 0.0
|
||||
if self.deltas[key] then return self.deltas[key].dt else return 0.0 end
|
||||
end
|
||||
|
||||
--#endregion
|
||||
|
||||
--#region redstone I/O
|
||||
|
||||
-- write to a redstone port
|
||||
local function __rs_w(port, value)
|
||||
for i = 1, #self.redstone do
|
||||
local db = self.redstone[i].get_db() ---@type redstone_session_db
|
||||
local io = db.io[port] ---@type rs_db_dig_io|nil
|
||||
if io ~= nil then io.write(value) end
|
||||
end
|
||||
end
|
||||
|
||||
-- read a redstone port<br>
|
||||
-- this will read from the first one encountered if there are multiple, because there should not be multiple
|
||||
---@param port IO_PORT
|
||||
---@return boolean|nil
|
||||
local function __rs_r(port)
|
||||
for i = 1, #self.redstone do
|
||||
local db = self.redstone[i].get_db() ---@type redstone_session_db
|
||||
local io = db.io[port] ---@type rs_db_dig_io|nil
|
||||
if io ~= nil then return io.read() end
|
||||
end
|
||||
end
|
||||
|
||||
-- waste valves
|
||||
local waste_pu = { open = function () __rs_w(IO.WASTE_PU, true) end, close = function () __rs_w(IO.WASTE_PU, false) end }
|
||||
local waste_sna = { open = function () __rs_w(IO.WASTE_PO, true) end, close = function () __rs_w(IO.WASTE_PO, false) end }
|
||||
local waste_po = { open = function () __rs_w(IO.WASTE_POPL, true) end, close = function () __rs_w(IO.WASTE_POPL, false) end }
|
||||
local waste_sps = { open = function () __rs_w(IO.WASTE_AM, true) end, close = function () __rs_w(IO.WASTE_AM, false) end }
|
||||
|
||||
--#endregion
|
||||
|
||||
--#region task helpers
|
||||
|
||||
-- update an alarm state given conditions
|
||||
---@param tripped boolean if the alarm condition is still active
|
||||
---@param alarm alarm_def alarm table
|
||||
@@ -335,6 +377,10 @@ function unit.new(for_reactor, num_boilers, num_turbines)
|
||||
end
|
||||
end
|
||||
|
||||
--#endregion
|
||||
|
||||
--#region alarms and annunciator
|
||||
|
||||
-- update the annunciator
|
||||
local function _update_annunciator()
|
||||
-- update deltas
|
||||
@@ -617,6 +663,8 @@ function unit.new(for_reactor, num_boilers, num_turbines)
|
||||
_update_alarm_state(any_trip, self.alarms.TurbineTrip)
|
||||
end
|
||||
|
||||
--#endregion
|
||||
|
||||
-- unlink disconnected units
|
||||
---@param sessions table
|
||||
local function _unlink_disconnected_units(sessions)
|
||||
@@ -642,6 +690,13 @@ function unit.new(for_reactor, num_boilers, num_turbines)
|
||||
_reset_dt(DT_KEYS.ReactorHCool)
|
||||
end
|
||||
|
||||
-- link a redstone RTU session
|
||||
---@param rs_unit unit_session
|
||||
function public.add_redstone(rs_unit)
|
||||
-- insert into list
|
||||
table.insert(self.redstone, rs_unit)
|
||||
end
|
||||
|
||||
-- link a turbine RTU session
|
||||
---@param turbine unit_session
|
||||
function public.add_turbine(turbine)
|
||||
@@ -676,17 +731,6 @@ function unit.new(for_reactor, num_boilers, num_turbines)
|
||||
end
|
||||
end
|
||||
|
||||
-- link a redstone RTU capability
|
||||
function public.add_redstone(field, accessor)
|
||||
-- ensure field exists
|
||||
if self.redstone[field] == nil then
|
||||
self.redstone[field] = {}
|
||||
end
|
||||
|
||||
-- insert into list
|
||||
table.insert(self.redstone[field], accessor)
|
||||
end
|
||||
|
||||
-- purge devices associated with the given RTU session ID
|
||||
---@param session integer RTU session ID
|
||||
function public.purge_rtu_devices(session)
|
||||
@@ -716,7 +760,7 @@ function unit.new(for_reactor, num_boilers, num_turbines)
|
||||
_update_alarms()
|
||||
end
|
||||
|
||||
-- ACK/RESET ALARMS --
|
||||
-- OPERATIONS --
|
||||
|
||||
-- acknowledge all alarms (if possible)
|
||||
function public.ack_all()
|
||||
@@ -743,6 +787,32 @@ function unit.new(for_reactor, num_boilers, num_turbines)
|
||||
end
|
||||
end
|
||||
|
||||
-- route reactor waste
|
||||
---@param mode WASTE_MODE waste handling mode
|
||||
function public.set_waste(mode)
|
||||
if mode == WASTE_MODE.AUTO then
|
||||
---@todo automatic waste routing
|
||||
elseif mode == WASTE_MODE.PLUTONIUM then
|
||||
-- route through plutonium generation
|
||||
waste_pu.open()
|
||||
waste_sna.close()
|
||||
waste_po.close()
|
||||
waste_sps.close()
|
||||
elseif mode == WASTE_MODE.POLONIUM then
|
||||
-- route through polonium generation into pellets
|
||||
waste_pu.close()
|
||||
waste_sna.open()
|
||||
waste_po.open()
|
||||
waste_sps.close()
|
||||
elseif mode == WASTE_MODE.ANTI_MATTER then
|
||||
-- route through polonium generation into SPS
|
||||
waste_pu.close()
|
||||
waste_sna.open()
|
||||
waste_po.close()
|
||||
waste_sps.open()
|
||||
end
|
||||
end
|
||||
|
||||
-- READ STATES/PROPERTIES --
|
||||
|
||||
-- get build properties of all machines
|
||||
|
||||
Reference in New Issue
Block a user