add error emergency switch

f1dff934 · Hideaki Tai · ebd8c8ee · f1dff934
Commit f1dff934 authored Nov 30, 2018 by Hideaki Tai
Show whitespace changes
Inline Side-by-side

Showing with 4 additions and 0 deletions

include/main.h
+4 -0

No files found.
--- a/include/main.h
+++ b/include/main.h
@@ -277,7 +277,11 @@ void sendStatus()
 {
    if (b_streaming)
    {
+        if (b_motor_active)
            packer.pack(HARDWARE_ID, whill.battery(WhillOmni::LR::L), whill.battery(WhillOmni::LR::R), whill.errorCode(WhillOmni::LR::L), whill.errorCode(WhillOmni::LR::R));
+        else
+            packer.pack(HARDWARE_ID, whill.battery(WhillOmni::LR::L), whill.battery(WhillOmni::LR::R), 252, 252);
+
        XBEE_SERIAL.write(packer.data(), packer.size());
    }
 }