2022-08-28 16:12:30 +00:00
|
|
|
local log = require("scada-common.log")
|
|
|
|
local types = require("scada-common.types")
|
2022-10-07 15:43:18 +00:00
|
|
|
local util = require("scada-common.util")
|
2022-06-04 19:33:04 +00:00
|
|
|
|
|
|
|
local unit_session = require("supervisor.session.rtu.unit_session")
|
|
|
|
|
|
|
|
local sps = {}
|
|
|
|
|
2023-02-21 17:27:16 +00:00
|
|
|
local RTU_UNIT_TYPE = types.RTU_UNIT_TYPE
|
2022-06-04 19:33:04 +00:00
|
|
|
local MODBUS_FCODE = types.MODBUS_FCODE
|
|
|
|
|
|
|
|
local TXN_TYPES = {
|
|
|
|
FORMED = 1,
|
|
|
|
BUILD = 2,
|
|
|
|
STATE = 3,
|
|
|
|
TANKS = 4
|
|
|
|
}
|
|
|
|
|
|
|
|
local TXN_TAGS = {
|
|
|
|
"sps.formed",
|
|
|
|
"sps.build",
|
|
|
|
"sps.state",
|
2022-06-04 21:59:24 +00:00
|
|
|
"sps.tanks"
|
2022-06-04 19:33:04 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
local PERIODICS = {
|
|
|
|
FORMED = 2000,
|
|
|
|
BUILD = 1000,
|
|
|
|
STATE = 500,
|
|
|
|
TANKS = 1000
|
|
|
|
}
|
|
|
|
|
|
|
|
-- create a new sps rtu session runner
|
2023-02-25 04:36:16 +00:00
|
|
|
---@nodiscard
|
2023-02-20 05:49:37 +00:00
|
|
|
---@param session_id integer RTU session ID
|
|
|
|
---@param unit_id integer RTU unit ID
|
|
|
|
---@param advert rtu_advertisement RTU advertisement table
|
|
|
|
---@param out_queue mqueue RTU unit message out queue
|
2022-06-04 19:33:04 +00:00
|
|
|
function sps.new(session_id, unit_id, advert, out_queue)
|
|
|
|
-- type check
|
2023-02-21 16:05:57 +00:00
|
|
|
if advert.type ~= RTU_UNIT_TYPE.SPS then
|
2023-11-12 16:54:47 +00:00
|
|
|
log.error("attempt to instantiate sps RTU for type " .. types.rtu_type_to_string(advert.type))
|
2022-06-04 19:33:04 +00:00
|
|
|
return nil
|
|
|
|
end
|
|
|
|
|
2023-11-06 15:21:42 +00:00
|
|
|
local log_tag = util.c("session.rtu(", session_id, ").sps[@", unit_id, "]: ")
|
2022-06-04 19:33:04 +00:00
|
|
|
|
|
|
|
local self = {
|
2022-11-12 06:35:31 +00:00
|
|
|
session = unit_session.new(session_id, unit_id, advert, out_queue, log_tag, TXN_TAGS),
|
2022-06-04 19:33:04 +00:00
|
|
|
has_build = false,
|
|
|
|
periodics = {
|
|
|
|
next_formed_req = 0,
|
|
|
|
next_build_req = 0,
|
|
|
|
next_state_req = 0,
|
2022-06-04 21:59:24 +00:00
|
|
|
next_tanks_req = 0
|
2022-06-04 19:33:04 +00:00
|
|
|
},
|
|
|
|
---@class sps_session_db
|
|
|
|
db = {
|
|
|
|
formed = false,
|
|
|
|
build = {
|
2022-10-07 15:43:18 +00:00
|
|
|
last_update = 0,
|
2022-06-04 19:33:04 +00:00
|
|
|
length = 0,
|
|
|
|
width = 0,
|
|
|
|
height = 0,
|
2023-02-14 20:15:34 +00:00
|
|
|
min_pos = types.new_zero_coordinate(),
|
|
|
|
max_pos = types.new_zero_coordinate(),
|
2022-06-04 19:33:04 +00:00
|
|
|
coils = 0,
|
|
|
|
input_cap = 0,
|
|
|
|
output_cap = 0,
|
|
|
|
max_energy = 0
|
|
|
|
},
|
|
|
|
state = {
|
2022-10-07 15:43:18 +00:00
|
|
|
last_update = 0,
|
2022-06-04 19:33:04 +00:00
|
|
|
process_rate = 0.0
|
|
|
|
},
|
|
|
|
tanks = {
|
2022-10-07 15:43:18 +00:00
|
|
|
last_update = 0,
|
2023-02-14 20:15:34 +00:00
|
|
|
input = types.new_empty_gas(),
|
2022-06-04 19:33:04 +00:00
|
|
|
input_need = 0,
|
|
|
|
input_fill = 0.0,
|
2023-02-14 20:15:34 +00:00
|
|
|
output = types.new_empty_gas(),
|
2022-06-04 19:33:04 +00:00
|
|
|
output_need = 0,
|
|
|
|
output_fill = 0.0,
|
|
|
|
energy = 0,
|
|
|
|
energy_need = 0,
|
|
|
|
energy_fill = 0.0
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
local public = self.session.get()
|
|
|
|
|
|
|
|
-- PRIVATE FUNCTIONS --
|
|
|
|
|
2022-06-04 21:59:24 +00:00
|
|
|
-- query if the multiblock is formed
|
2022-06-04 19:33:04 +00:00
|
|
|
local function _request_formed()
|
|
|
|
-- read discrete input 1 (start = 1, count = 1)
|
|
|
|
self.session.send_request(TXN_TYPES.FORMED, MODBUS_FCODE.READ_DISCRETE_INPUTS, { 1, 1 })
|
|
|
|
end
|
|
|
|
|
|
|
|
-- query the build of the device
|
|
|
|
local function _request_build()
|
2022-06-04 19:36:47 +00:00
|
|
|
-- read input registers 1 through 9 (start = 1, count = 9)
|
|
|
|
self.session.send_request(TXN_TYPES.BUILD, MODBUS_FCODE.READ_INPUT_REGS, { 1, 9 })
|
2022-06-04 19:33:04 +00:00
|
|
|
end
|
|
|
|
|
|
|
|
-- query the state of the device
|
|
|
|
local function _request_state()
|
2022-06-04 19:36:47 +00:00
|
|
|
-- read input register 10 (start = 10, count = 1)
|
|
|
|
self.session.send_request(TXN_TYPES.STATE, MODBUS_FCODE.READ_INPUT_REGS, { 10, 1 })
|
2022-06-04 19:33:04 +00:00
|
|
|
end
|
|
|
|
|
|
|
|
-- query the tanks of the device
|
|
|
|
local function _request_tanks()
|
2022-06-04 19:36:47 +00:00
|
|
|
-- read input registers 11 through 19 (start = 11, count = 9)
|
2023-02-25 04:36:16 +00:00
|
|
|
self.session.send_request(TXN_TYPES.TANKS, MODBUS_FCODE.READ_INPUT_REGS, { 11, 9 })
|
2022-06-04 19:33:04 +00:00
|
|
|
end
|
|
|
|
|
|
|
|
-- PUBLIC FUNCTIONS --
|
|
|
|
|
|
|
|
-- handle a packet
|
|
|
|
---@param m_pkt modbus_frame
|
|
|
|
function public.handle_packet(m_pkt)
|
2022-09-19 02:25:59 +00:00
|
|
|
local txn_type = self.session.try_resolve(m_pkt)
|
2022-06-04 19:33:04 +00:00
|
|
|
if txn_type == false then
|
|
|
|
-- nothing to do
|
|
|
|
elseif txn_type == TXN_TYPES.FORMED then
|
|
|
|
-- formed response
|
|
|
|
-- load in data if correct length
|
|
|
|
if m_pkt.length == 1 then
|
|
|
|
self.db.formed = m_pkt.data[1]
|
2023-02-12 18:06:44 +00:00
|
|
|
|
|
|
|
if not self.db.formed then self.has_build = false end
|
2022-06-04 19:33:04 +00:00
|
|
|
else
|
|
|
|
log.debug(log_tag .. "MODBUS transaction reply length mismatch (" .. TXN_TAGS[txn_type] .. ")")
|
|
|
|
end
|
|
|
|
elseif txn_type == TXN_TYPES.BUILD then
|
|
|
|
-- build response
|
|
|
|
-- load in data if correct length
|
|
|
|
if m_pkt.length == 9 then
|
2022-10-07 15:43:18 +00:00
|
|
|
self.db.build.last_update = util.time_ms()
|
|
|
|
self.db.build.length = m_pkt.data[1]
|
|
|
|
self.db.build.width = m_pkt.data[2]
|
|
|
|
self.db.build.height = m_pkt.data[3]
|
|
|
|
self.db.build.min_pos = m_pkt.data[4]
|
|
|
|
self.db.build.max_pos = m_pkt.data[5]
|
|
|
|
self.db.build.coils = m_pkt.data[6]
|
|
|
|
self.db.build.input_cap = m_pkt.data[7]
|
|
|
|
self.db.build.output_cap = m_pkt.data[8]
|
|
|
|
self.db.build.max_energy = m_pkt.data[9]
|
2022-06-04 19:33:04 +00:00
|
|
|
self.has_build = true
|
2022-11-11 19:59:53 +00:00
|
|
|
|
2023-02-20 05:49:37 +00:00
|
|
|
out_queue.push_data(unit_session.RTU_US_DATA.BUILD_CHANGED, { unit = advert.reactor, type = advert.type })
|
2022-06-04 19:33:04 +00:00
|
|
|
else
|
|
|
|
log.debug(log_tag .. "MODBUS transaction reply length mismatch (" .. TXN_TAGS[txn_type] .. ")")
|
|
|
|
end
|
|
|
|
elseif txn_type == TXN_TYPES.STATE then
|
|
|
|
-- state response
|
|
|
|
-- load in data if correct length
|
|
|
|
if m_pkt.length == 1 then
|
2022-10-07 15:43:18 +00:00
|
|
|
self.db.state.last_update = util.time_ms()
|
2022-06-04 19:33:04 +00:00
|
|
|
self.db.state.process_rate = m_pkt.data[1]
|
|
|
|
else
|
|
|
|
log.debug(log_tag .. "MODBUS transaction reply length mismatch (" .. TXN_TAGS[txn_type] .. ")")
|
|
|
|
end
|
|
|
|
elseif txn_type == TXN_TYPES.TANKS then
|
|
|
|
-- tanks response
|
|
|
|
-- load in data if correct length
|
|
|
|
if m_pkt.length == 9 then
|
2022-10-07 15:43:18 +00:00
|
|
|
self.db.tanks.last_update = util.time_ms()
|
2022-06-04 19:33:04 +00:00
|
|
|
self.db.tanks.input = m_pkt.data[1]
|
|
|
|
self.db.tanks.input_need = m_pkt.data[2]
|
|
|
|
self.db.tanks.input_fill = m_pkt.data[3]
|
|
|
|
self.db.tanks.output = m_pkt.data[4]
|
|
|
|
self.db.tanks.output_need = m_pkt.data[5]
|
|
|
|
self.db.tanks.output_fill = m_pkt.data[6]
|
|
|
|
self.db.tanks.energy = m_pkt.data[7]
|
|
|
|
self.db.tanks.energy_need = m_pkt.data[8]
|
|
|
|
self.db.tanks.energy_fill = m_pkt.data[9]
|
|
|
|
else
|
|
|
|
log.debug(log_tag .. "MODBUS transaction reply length mismatch (" .. TXN_TAGS[txn_type] .. ")")
|
|
|
|
end
|
|
|
|
elseif txn_type == nil then
|
|
|
|
log.error(log_tag .. "unknown transaction reply")
|
|
|
|
else
|
|
|
|
log.error(log_tag .. "unknown transaction type " .. txn_type)
|
|
|
|
end
|
|
|
|
end
|
|
|
|
|
|
|
|
-- update this runner
|
|
|
|
---@param time_now integer milliseconds
|
|
|
|
function public.update(time_now)
|
|
|
|
if self.periodics.next_formed_req <= time_now then
|
|
|
|
_request_formed()
|
|
|
|
self.periodics.next_formed_req = time_now + PERIODICS.FORMED
|
|
|
|
end
|
|
|
|
|
|
|
|
if self.db.formed then
|
|
|
|
if not self.has_build and self.periodics.next_build_req <= time_now then
|
|
|
|
_request_build()
|
|
|
|
self.periodics.next_build_req = time_now + PERIODICS.BUILD
|
|
|
|
end
|
|
|
|
|
|
|
|
if self.periodics.next_state_req <= time_now then
|
|
|
|
_request_state()
|
|
|
|
self.periodics.next_state_req = time_now + PERIODICS.STATE
|
|
|
|
end
|
|
|
|
|
|
|
|
if self.periodics.next_tanks_req <= time_now then
|
|
|
|
_request_tanks()
|
|
|
|
self.periodics.next_tanks_req = time_now + PERIODICS.TANKS
|
|
|
|
end
|
|
|
|
end
|
|
|
|
|
|
|
|
self.session.post_update()
|
|
|
|
end
|
|
|
|
|
2022-11-11 19:59:53 +00:00
|
|
|
-- invalidate build cache
|
|
|
|
function public.invalidate_cache()
|
|
|
|
self.periodics.next_formed_req = 0
|
|
|
|
self.periodics.next_build_req = 0
|
|
|
|
self.has_build = false
|
|
|
|
end
|
|
|
|
|
2022-06-04 19:33:04 +00:00
|
|
|
-- get the unit session database
|
2023-02-25 04:36:16 +00:00
|
|
|
---@nodiscard
|
2022-06-04 19:33:04 +00:00
|
|
|
function public.get_db() return self.db end
|
|
|
|
|
|
|
|
return public
|
|
|
|
end
|
|
|
|
|
|
|
|
return sps
|