Additional checks for POCSAG mode

IO.cpp

@@ -140,11 +140,13 @@ void CIO::process()
     if(m_cwid_state) { // check for CW ID end of transmission
       m_cwid_state = false;
       // Restoring previous mode
+      if (m_TotalModes)
         io.ifConf(m_modemState_prev, true);
     }
     if(m_pocsag_state) { // check for POCSAG end of transmission
       m_pocsag_state = false;
       // Restoring previous mode
+      if (m_TotalModes)
         io.ifConf(m_modemState_prev, true);
     }
     setRX(false);

SerialPort.cpp

@@ -330,6 +330,8 @@ uint8_t CSerialPort::setConfig(const uint8_t* data, uint8_t length)
       io.ifConf(STATE_P25, true);
     else if(m_nxdnEnable)
       io.ifConf(STATE_NXDN, true);
+    else if(m_pocsagEnable)
+      io.ifConf(STATE_POCSAG, true);
   }
 
   io.start();