#34 RTU modem disconnect/reconnect handling, bugfix in comms thread

rtu/rtu.lua

@@ -153,6 +153,16 @@ function rtu_comms(modem, local_port, server_port)
 
     -- PUBLIC FUNCTIONS --
 
+    -- reconnect a newly connected modem
+    local reconnect_modem = function (modem)
+        self.modem = modem
+
+        -- open modem
+        if not self.modem.isOpen(self.l_port) then
+            self.modem.open(self.l_port)
+        end
+    end
+
     -- parse a MODBUS/SCADA packet
     local parse_packet = function(side, sender, reply_to, message, distance)
         local pkt = nil
@@ -270,6 +280,7 @@ function rtu_comms(modem, local_port, server_port)
     end
 
     return {
+        reconnect_modem = reconnect_modem,
         parse_packet = parse_packet,
         handle_packet = handle_packet,
         send_advertisement = send_advertisement,

rtu/startup.lua

@@ -19,7 +19,7 @@ os.loadAPI("dev/boiler_rtu.lua")
 os.loadAPI("dev/imatrix_rtu.lua")
 os.loadAPI("dev/turbine_rtu.lua")
 
-local RTU_VERSION = "alpha-v0.4.5"
+local RTU_VERSION = "alpha-v0.4.6"
 
 local print = util.print
 local println = util.println

rtu/threads.lua

@@ -36,6 +36,15 @@ function thread__main(smem)
                 -- handle loss of a device
                 local device = ppm.handle_unmount(param1)
 
+                if device.type == "modem" then
+                    -- we only care if this is our wireless modem
+                    if device.dev == rtu_dev.modem then
+                        println_ts("wireless modem disconnected!")
+                        log._warning("comms modem disconnected!")
+                    else
+                        log._warning("non-comms modem disconnected")
+                    end
+                else
                     for i = 1, #units do
                         -- find disconnected device
                         if units[i].device == device.dev then
@@ -45,10 +54,24 @@ function thread__main(smem)
                             println_ts("lost the " .. unit.type .. " on interface " .. unit.name)
                         end
                     end
+                end
             elseif event == "peripheral" then
-                -- relink lost peripheral to correct unit entry
+                -- peripheral connect
                 local type, device = ppm.mount(param1)
 
+                if type == "modem" then
+                    if device.isWireless() then
+                        -- reconnected modem
+                        rtu_dev.modem = device
+                        rtu_comms.reconnect_modem(rtu_dev.modem)
+
+                        println_ts("wireless modem reconnected.")
+                        log._info("comms modem reconnected.")
+                    else
+                        log._info("wired modem reconnected.")
+                    end
+                else
+                    -- relink lost peripheral to correct unit entry
                     for i = 1, #units do
                         local unit = units[i]
 
@@ -70,6 +93,7 @@ function thread__main(smem)
                             println_ts("reconnected the " .. unit.type .. " on interface " .. unit.name)
                         end
                     end
+                end
             elseif event == "timer" and param1 == loop_clock then
                 -- start next clock timer
                 loop_clock = os.startTimer(MAIN_CLOCK)
@@ -87,8 +111,6 @@ function thread__main(smem)
                 if packet ~= nil then
                     smem.q.mq_comms.push_packet(packet)
                 end
-
-                rtu_comms.handle_packet(packet, units, link_ref)
             end
 
             -- check for termination request
@@ -121,7 +143,7 @@ function thread__comms(smem)
         -- thread loop
         while true do
             -- check for messages in the message queue
-            while comms_queue.ready() and not plc_state.shutdown do
+            while comms_queue.ready() and not rtu_state.shutdown do
                 local msg = comms_queue.pop()
 
                 if msg.qtype == mqueue.TYPE.COMMAND then