add a ping command to check status of the link

LOOP_TEST is great for some things but because the state of the sentinel is not determined it's not great for checking link integrity.
betrusted-io · Jan 31, 2022 · 6102eb1 · 6102eb1
1 parent deff791
commit 6102eb1
Show file tree

Hide file tree

Showing 2 changed files with 13 additions and 1 deletion.
diff --git a/sw/com_rs b/sw/com_rs
diff --git a/sw/src/main.rs b/sw/src/main.rs
@@ -474,6 +474,18 @@ fn main() -> ! {
                 logln!(LL::Debug, "CLoop");
                 com_tx((rx & 0xFF) | ((com_sentinel as u16 & 0xFF) << 8));
                 com_sentinel += 1;
+            } else if rx == ComState::LINK_PING.verb {
+                logln!(LL::Debug, "CPing");
+                match com_rx(500) {
+                    Ok(ping) => {
+                        com_tx(!ping);
+                        com_tx(0x600d);
+                    },
+                    _ => {
+                        com_tx(0xEEEE);
+                        com_tx(0xFFFF);
+                    }
+                }
             } else if rx == ComState::GAS_GAUGE.verb {
                 logln!(LL::Trace, "CGg"); // This gets polled frequently
                 com_tx(pow.current as u16);