#248, Adaptation of StayAlive message to latest format, tested with H…

…alo20+ and Halo3008
opencpn-radar-pi · Sep 19, 2023 · 576545a · 576545a
1 parent 6e9e65b
commit 576545a
Show file tree

Hide file tree

Showing 4 changed files with 31 additions and 8 deletions.
diff --git a/CHANGELOG-PLUGIN.md b/CHANGELOG-PLUGIN.md
@@ -11,6 +11,8 @@ Sections can be: Added Changed Deprecated Removed Fixed Security.
 
 ## [Unreleased]
 
+- #248: Adaptation of StayAlive message to latest format, tested with Halo20+ and Halo3008
+
 ## [5.5.0]
 
 This release is mainly focused on compatibility with OpenCPN 5.8.0 which uses a new UI library

diff --git a/include/RadarInfo.h b/include/RadarInfo.h
@@ -168,6 +168,7 @@ class RadarInfo {
     RadarControlItem m_coarse_tune;
     RadarControlItem m_magnetron_current;
     RadarControlItem m_color_gain;
+    uint8_t m_stay_alive_type;
 
     bool m_showManualValueInAuto; // Does radar adjust manual value in auto
                                   // mode? True for Garmin, False for others
@@ -195,7 +196,7 @@ class RadarInfo {
     time_t m_data_timeout; // When we consider the data to be obsolete (radar no
                            // longer sending data)
     time_t m_stayalive_timeout; // When we will send another stayalive ping
-#define STAYALIVE_TIMEOUT (5) // Send data every 5 seconds to ping radar
+#define STAYALIVE_TIMEOUT (1) // Send data every 1 seconds to ping radar
 #define DATA_TIMEOUT (5)
 
     bool m_status_text_hide;

diff --git a/src/RadarInfo.cpp b/src/RadarInfo.cpp
@@ -125,6 +125,7 @@ RadarInfo::RadarInfo(radar_pi *pi, int radar) {
   m_rotation_period.Update(0);
   m_magnetron_current.Update(0);
   m_rotation_period.Update(0);
+  m_stay_alive_type = 0;
 
   m_range_adjustment.Update(0, RCS_MANUAL);
   m_quantum2type = false;

diff --git a/src/navico/NavicoControl.cpp b/src/navico/NavicoControl.cpp
@@ -39,10 +39,11 @@ static const uint8_t COMMAND_TX_OFF_B[3] = {0x01, 0xc1, 0x00};  // OFF part 1, n
 static const uint8_t COMMAND_TX_ON_A[3] = {0x00, 0xc1, 0x01};  // ON part 1
 static const uint8_t COMMAND_TX_ON_B[3] = {0x01, 0xc1, 0x01};  // ON part 2
 
-static const uint8_t COMMAND_STAY_ON_A[2] = {0xA0, 0xc1};
+static const uint8_t COMMAND_STAY_ON_A[2] = {0xa0, 0xc1};
 static const uint8_t COMMAND_STAY_ON_B[2] = {0x03, 0xc2};
 static const uint8_t COMMAND_STAY_ON_C[2] = {0x04, 0xc2};
 static const uint8_t COMMAND_STAY_ON_D[2] = {0x05, 0xc2};
+static const uint8_t COMMAND_STAY_ON_E[2] = {0x0a, 0xc2};
 
 bool NavicoControl::Init(radar_pi *pi, RadarInfo *ri, NetworkAddress &ifadr, NetworkAddress &radaradr) {
   int r;
@@ -128,15 +129,33 @@ void NavicoControl::RadarTxOn() {
   IF_LOG_AT(LOGLEVEL_VERBOSE | LOGLEVEL_TRANSMIT, wxLogMessage(wxT("%s transmit: turn on"), m_name.c_str()));
   TransmitCmd(COMMAND_TX_ON_A, sizeof(COMMAND_TX_ON_A));
   TransmitCmd(COMMAND_TX_ON_B, sizeof(COMMAND_TX_ON_B));
+  m_ri->m_stay_alive_type = 0;
 }
 
 bool NavicoControl::RadarStayAlive() {
-  LOG_TRANSMIT(wxT("%s transmit: stay alive"), m_name.c_str());
-
-  TransmitCmd(COMMAND_STAY_ON_A, sizeof(COMMAND_STAY_ON_A));
-  TransmitCmd(COMMAND_STAY_ON_B, sizeof(COMMAND_STAY_ON_B));
-  TransmitCmd(COMMAND_STAY_ON_C, sizeof(COMMAND_STAY_ON_C));
-  return TransmitCmd(COMMAND_STAY_ON_D, sizeof(COMMAND_STAY_ON_D));
+  LOG_TRANSMIT(wxT("%s transmit: stay alive, sequence=%i"), m_name.c_str(), m_ri->m_stay_alive_type);  //$$$
+  bool tx = false;
+  switch (m_ri->m_stay_alive_type) {
+    case 0:
+      TransmitCmd(COMMAND_STAY_ON_A, sizeof(COMMAND_STAY_ON_A));       // a0, c1
+      TransmitCmd(COMMAND_STAY_ON_B, sizeof(COMMAND_STAY_ON_B));       // 03, c2
+      TransmitCmd(COMMAND_STAY_ON_C, sizeof(COMMAND_STAY_ON_C));       // 04, c2
+      TransmitCmd(COMMAND_STAY_ON_D, sizeof(COMMAND_STAY_ON_D));       // 05, c2
+      tx = TransmitCmd(COMMAND_STAY_ON_E, sizeof(COMMAND_STAY_ON_E));  // 0a, c2
+      break;
+    case 1:
+    case 2:
+    case 3:
+      tx = TransmitCmd(COMMAND_STAY_ON_A, sizeof(COMMAND_STAY_ON_A));  // a0, c1
+      break;
+    default:
+      break;
+  }
+  m_ri->m_stay_alive_type++;
+  if (m_ri->m_stay_alive_type == 4) {
+    m_ri->m_stay_alive_type = 0;
+  }
+  return tx;
 }
 
 bool NavicoControl::SetRange(int meters) {