2022-05-09 13:35:39 +00:00
|
|
|
local comms = require("scada-common.comms")
|
|
|
|
local log = require("scada-common.log")
|
|
|
|
local mqueue = require("scada-common.mqueue")
|
|
|
|
local util = require("scada-common.util")
|
|
|
|
|
2022-05-11 17:02:21 +00:00
|
|
|
-- supervisor rtu sessions (svrs)
|
|
|
|
local svrs_boiler = require("supervisor.session.rtu.boiler")
|
2022-05-13 13:45:11 +00:00
|
|
|
local svrs_emachine = require("supervisor.session.rtu.emachine")
|
|
|
|
local svrs_turbine = require("supervisor.session.rtu.turbine")
|
2022-05-11 17:02:21 +00:00
|
|
|
|
2022-05-04 17:37:01 +00:00
|
|
|
local rtu = {}
|
|
|
|
|
2022-05-09 13:35:39 +00:00
|
|
|
local PROTOCOLS = comms.PROTOCOLS
|
|
|
|
local SCADA_MGMT_TYPES = comms.SCADA_MGMT_TYPES
|
2022-05-13 14:27:57 +00:00
|
|
|
local RTU_UNIT_TYPES = comms.RTU_UNIT_TYPES
|
2022-05-09 13:35:39 +00:00
|
|
|
|
|
|
|
local print = util.print
|
|
|
|
local println = util.println
|
|
|
|
local print_ts = util.print_ts
|
|
|
|
local println_ts = util.println_ts
|
|
|
|
|
2022-05-10 16:01:56 +00:00
|
|
|
local PERIODICS = {
|
|
|
|
KEEP_ALIVE = 2.0
|
|
|
|
}
|
|
|
|
|
2022-05-13 13:45:11 +00:00
|
|
|
-- create a new RTU session
|
|
|
|
---@param id integer
|
|
|
|
---@param in_queue mqueue
|
|
|
|
---@param out_queue mqueue
|
|
|
|
---@param advertisement table
|
|
|
|
rtu.new_session = function (id, in_queue, out_queue, advertisement)
|
2022-05-09 13:35:39 +00:00
|
|
|
local log_header = "rtu_session(" .. id .. "): "
|
|
|
|
|
|
|
|
local self = {
|
|
|
|
id = id,
|
|
|
|
in_q = in_queue,
|
|
|
|
out_q = out_queue,
|
2022-05-13 13:45:11 +00:00
|
|
|
advert = advertisement,
|
2022-05-09 13:35:39 +00:00
|
|
|
-- connection properties
|
|
|
|
seq_num = 0,
|
|
|
|
r_seq_num = nil,
|
|
|
|
connected = true,
|
|
|
|
rtu_conn_watchdog = util.new_watchdog(3),
|
2022-05-13 13:45:11 +00:00
|
|
|
last_rtt = 0,
|
|
|
|
units = {}
|
2022-05-09 13:35:39 +00:00
|
|
|
}
|
|
|
|
|
2022-05-13 13:45:11 +00:00
|
|
|
---@class rtu_session
|
|
|
|
local public = {}
|
|
|
|
|
|
|
|
-- parse the recorded advertisement
|
|
|
|
local _parse_advertisement = function ()
|
|
|
|
self.units = {}
|
|
|
|
for i = 1, #self.advert do
|
2022-05-13 13:49:24 +00:00
|
|
|
local unit = nil ---@type unit_session
|
2022-05-13 13:45:11 +00:00
|
|
|
|
|
|
|
---@type rtu_advertisement
|
|
|
|
local unit_advert = {
|
|
|
|
type = self.advert[i][0],
|
|
|
|
index = self.advert[i][1],
|
|
|
|
reactor = self.advert[i][2],
|
|
|
|
rsio = self.advert[i][3]
|
|
|
|
}
|
|
|
|
|
|
|
|
local u_type = unit_advert.type
|
|
|
|
|
|
|
|
-- create unit by type
|
2022-05-13 14:27:57 +00:00
|
|
|
if u_type == RTU_UNIT_TYPES.REDSTONE then
|
2022-05-13 13:45:11 +00:00
|
|
|
|
2022-05-13 14:27:57 +00:00
|
|
|
elseif u_type == RTU_UNIT_TYPES.BOILER then
|
2022-05-13 13:45:11 +00:00
|
|
|
unit = svrs_boiler.new(self.id, unit_advert, self.out_q)
|
2022-05-13 14:27:57 +00:00
|
|
|
elseif u_type == RTU_UNIT_TYPES.BOILER_VALVE then
|
2022-05-13 13:45:11 +00:00
|
|
|
-- @todo Mekanism 10.1+
|
2022-05-13 14:27:57 +00:00
|
|
|
elseif u_type == RTU_UNIT_TYPES.TURBINE then
|
2022-05-13 13:45:11 +00:00
|
|
|
unit = svrs_turbine.new(self.id, unit_advert, self.out_q)
|
2022-05-13 14:27:57 +00:00
|
|
|
elseif u_type == RTU_UNIT_TYPES.TURBINE_VALVE then
|
2022-05-13 13:45:11 +00:00
|
|
|
-- @todo Mekanism 10.1+
|
2022-05-13 14:27:57 +00:00
|
|
|
elseif u_type == RTU_UNIT_TYPES.EMACHINE then
|
2022-05-13 13:45:11 +00:00
|
|
|
unit = svrs_emachine.new(self.id, unit_advert, self.out_q)
|
2022-05-13 14:27:57 +00:00
|
|
|
elseif u_type == RTU_UNIT_TYPES.IMATRIX then
|
2022-05-13 13:45:11 +00:00
|
|
|
-- @todo Mekanism 10.1+
|
|
|
|
end
|
|
|
|
|
|
|
|
if unit ~= nil then
|
|
|
|
table.insert(self.units, unit)
|
|
|
|
else
|
|
|
|
self.units = {}
|
|
|
|
log.error(log_header .. "bad advertisement; encountered unsupported RTU type")
|
|
|
|
break
|
|
|
|
end
|
|
|
|
end
|
|
|
|
end
|
|
|
|
|
2022-05-09 13:35:39 +00:00
|
|
|
-- send a MODBUS TCP packet
|
2022-05-13 13:45:11 +00:00
|
|
|
---@param m_pkt modbus_packet
|
2022-05-09 19:00:16 +00:00
|
|
|
local _send_modbus = function (m_pkt)
|
2022-05-09 13:35:39 +00:00
|
|
|
local s_pkt = comms.scada_packet()
|
|
|
|
s_pkt.make(self.seq_num, PROTOCOLS.MODBUS_TCP, m_pkt.raw_sendable())
|
|
|
|
self.modem.transmit(self.s_port, self.l_port, s_pkt.raw_sendable())
|
|
|
|
self.seq_num = self.seq_num + 1
|
|
|
|
end
|
|
|
|
|
|
|
|
-- send a SCADA management packet
|
2022-05-13 13:45:11 +00:00
|
|
|
---@param msg_type SCADA_MGMT_TYPES
|
|
|
|
---@param msg table
|
2022-05-09 13:35:39 +00:00
|
|
|
local _send_mgmt = function (msg_type, msg)
|
|
|
|
local s_pkt = comms.scada_packet()
|
|
|
|
local m_pkt = comms.mgmt_packet()
|
|
|
|
|
|
|
|
m_pkt.make(msg_type, msg)
|
|
|
|
s_pkt.make(self.seq_num, PROTOCOLS.SCADA_MGMT, m_pkt.raw_sendable())
|
|
|
|
|
|
|
|
self.out_q.push_packet(s_pkt)
|
|
|
|
self.seq_num = self.seq_num + 1
|
|
|
|
end
|
|
|
|
|
|
|
|
-- handle a packet
|
2022-05-13 13:45:11 +00:00
|
|
|
---@param pkt modbus_frame|mgmt_frame
|
2022-05-09 13:35:39 +00:00
|
|
|
local _handle_packet = function (pkt)
|
|
|
|
-- check sequence number
|
|
|
|
if self.r_seq_num == nil then
|
|
|
|
self.r_seq_num = pkt.scada_frame.seq_num()
|
|
|
|
elseif self.r_seq_num >= pkt.scada_frame.seq_num() then
|
|
|
|
log.warning(log_header .. "sequence out-of-order: last = " .. self.r_seq_num .. ", new = " .. pkt.scada_frame.seq_num())
|
|
|
|
return
|
|
|
|
else
|
|
|
|
self.r_seq_num = pkt.scada_frame.seq_num()
|
|
|
|
end
|
|
|
|
|
2022-05-09 19:00:16 +00:00
|
|
|
-- feed watchdog
|
|
|
|
self.rtu_conn_watchdog.feed()
|
|
|
|
|
2022-05-09 13:35:39 +00:00
|
|
|
-- process packet
|
|
|
|
if pkt.scada_frame.protocol() == PROTOCOLS.MODBUS_TCP then
|
2022-05-13 13:45:11 +00:00
|
|
|
if self.units[pkt.unit_id] ~= nil then
|
2022-05-13 13:49:24 +00:00
|
|
|
local unit = self.units[pkt.unit_id] ---@type unit_session
|
2022-05-13 13:45:11 +00:00
|
|
|
unit.handle_packet(pkt)
|
|
|
|
end
|
2022-05-09 13:35:39 +00:00
|
|
|
elseif pkt.scada_frame.protocol() == PROTOCOLS.SCADA_MGMT then
|
|
|
|
|
2022-05-09 19:00:16 +00:00
|
|
|
if pkt.type == SCADA_MGMT_TYPES.KEEP_ALIVE then
|
|
|
|
-- keep alive reply
|
|
|
|
if pkt.length == 2 then
|
|
|
|
local srv_start = pkt.data[1]
|
|
|
|
local rtu_send = pkt.data[2]
|
|
|
|
local srv_now = util.time()
|
|
|
|
self.last_rtt = srv_now - srv_start
|
|
|
|
|
|
|
|
if self.last_rtt > 500 then
|
|
|
|
log.warning(log_header .. "RTU KEEP_ALIVE round trip time > 500ms (" .. self.last_rtt .. "ms)")
|
|
|
|
end
|
|
|
|
|
|
|
|
-- log.debug(log_header .. "RTU RTT = ".. self.last_rtt .. "ms")
|
|
|
|
-- log.debug(log_header .. "RTU TT = ".. (srv_now - rtu_send) .. "ms")
|
|
|
|
else
|
|
|
|
log.debug(log_header .. "SCADA keep alive packet length mismatch")
|
|
|
|
end
|
|
|
|
elseif pkt.type == SCADA_MGMT_TYPES.CLOSE then
|
2022-05-09 13:35:39 +00:00
|
|
|
-- close the session
|
|
|
|
self.connected = false
|
|
|
|
elseif pkt.type == SCADA_MGMT_TYPES.RTU_ADVERT then
|
|
|
|
-- RTU unit advertisement
|
2022-05-13 13:45:11 +00:00
|
|
|
self.advert = pkt.data
|
|
|
|
_parse_advertisement()
|
2022-05-09 13:35:39 +00:00
|
|
|
else
|
|
|
|
log.debug(log_header .. "handler received unsupported SCADA_MGMT packet type " .. pkt.type)
|
|
|
|
end
|
|
|
|
end
|
|
|
|
end
|
|
|
|
|
|
|
|
-- PUBLIC FUNCTIONS --
|
|
|
|
|
|
|
|
-- get the session ID
|
2022-05-13 13:45:11 +00:00
|
|
|
public.get_id = function () return self.id end
|
2022-05-09 13:35:39 +00:00
|
|
|
|
|
|
|
-- check if a timer matches this session's watchdog
|
2022-05-13 13:45:11 +00:00
|
|
|
---@param timer number
|
|
|
|
public.check_wd = function (timer)
|
2022-05-10 17:06:13 +00:00
|
|
|
return self.rtu_conn_watchdog.is_timer(timer)
|
2022-05-09 13:35:39 +00:00
|
|
|
end
|
|
|
|
|
|
|
|
-- close the connection
|
2022-05-13 13:45:11 +00:00
|
|
|
public.close = function ()
|
2022-05-09 13:35:39 +00:00
|
|
|
self.rtu_conn_watchdog.cancel()
|
|
|
|
self.connected = false
|
|
|
|
_send_mgmt(SCADA_MGMT_TYPES.CLOSE, {})
|
|
|
|
println(log_header .. "connection to RTU closed by server")
|
|
|
|
log.info(log_header .. "session closed by server")
|
|
|
|
end
|
|
|
|
|
|
|
|
-- iterate the session
|
2022-05-13 13:45:11 +00:00
|
|
|
---@return boolean connected
|
|
|
|
public.iterate = function ()
|
2022-05-09 13:35:39 +00:00
|
|
|
if self.connected then
|
2022-05-13 13:45:11 +00:00
|
|
|
------------------
|
|
|
|
-- update units --
|
|
|
|
------------------
|
|
|
|
|
|
|
|
for i = 1, #self.units do
|
|
|
|
self.units[i].update()
|
|
|
|
end
|
|
|
|
|
2022-05-09 13:35:39 +00:00
|
|
|
------------------
|
|
|
|
-- handle queue --
|
|
|
|
------------------
|
|
|
|
|
|
|
|
local handle_start = util.time()
|
|
|
|
|
|
|
|
while self.in_q.ready() and self.connected do
|
|
|
|
-- get a new message to process
|
2022-05-13 13:45:11 +00:00
|
|
|
local msg = self.in_q.pop()
|
|
|
|
|
|
|
|
if msg ~= nil then
|
|
|
|
if msg.qtype == mqueue.TYPE.PACKET then
|
|
|
|
-- handle a packet
|
|
|
|
_handle_packet(msg.message)
|
|
|
|
elseif msg.qtype == mqueue.TYPE.COMMAND then
|
|
|
|
-- handle instruction
|
|
|
|
elseif msg.qtype == mqueue.TYPE.DATA then
|
|
|
|
-- instruction with body
|
|
|
|
end
|
2022-05-09 13:35:39 +00:00
|
|
|
end
|
|
|
|
|
|
|
|
-- max 100ms spent processing queue
|
|
|
|
if util.time() - handle_start > 100 then
|
|
|
|
log.warning(log_header .. "exceeded 100ms queue process limit")
|
|
|
|
break
|
|
|
|
end
|
|
|
|
end
|
|
|
|
|
|
|
|
-- exit if connection was closed
|
|
|
|
if not self.connected then
|
|
|
|
self.rtu_conn_watchdog.cancel()
|
|
|
|
println(log_header .. "connection to RTU closed by remote host")
|
|
|
|
log.info(log_header .. "session closed by remote host")
|
|
|
|
return self.connected
|
|
|
|
end
|
|
|
|
|
|
|
|
----------------------
|
|
|
|
-- update periodics --
|
|
|
|
----------------------
|
|
|
|
|
|
|
|
local elapsed = util.time() - self.periodics.last_update
|
|
|
|
|
|
|
|
local periodics = self.periodics
|
|
|
|
|
|
|
|
-- keep alive
|
|
|
|
|
|
|
|
periodics.keep_alive = periodics.keep_alive + elapsed
|
|
|
|
if periodics.keep_alive >= PERIODICS.KEEP_ALIVE then
|
2022-05-09 19:00:16 +00:00
|
|
|
_send_mgmt(SCADA_MGMT_TYPES.KEEP_ALIVE, { util.time() })
|
2022-05-09 13:35:39 +00:00
|
|
|
periodics.keep_alive = 0
|
|
|
|
end
|
|
|
|
|
|
|
|
self.periodics.last_update = util.time()
|
|
|
|
end
|
|
|
|
|
|
|
|
return self.connected
|
|
|
|
end
|
|
|
|
|
2022-05-13 13:45:11 +00:00
|
|
|
return public
|
2022-05-09 13:35:39 +00:00
|
|
|
end
|
|
|
|
|
2022-05-04 17:37:01 +00:00
|
|
|
return rtu
|