fast-feedback virtual target task code on STM Nucleo

Dependencies:   mbed

Revision:
32:1416e015016c
Parent:
31:b320ca61a8c0
--- a/task.cpp	Sun Oct 14 14:45:02 2018 +0000
+++ b/task.cpp	Thu Dec 13 07:18:43 2018 +0000
@@ -25,7 +25,8 @@
 { }
 
 const char ModeSelection::CMD_ID_MODE        = '_';
-const char ModeSelection::CMD_MODE_CONDITION = 'C';
+const char ModeSelection::CMD_MODE_PAIR      = 'P';
+const char ModeSelection::CMD_MODE_STAGE     = 'S';
 const char ModeSelection::CMD_MODE_REPORT    = 'R';
 const char ModeSelection::CMD_MODE_ASSOCIATE = 'A';
 const char ModeSelection::CMD_MODE_MOTION    = 'M';
@@ -42,8 +43,9 @@
 
 bool ModeSelection::parse(const char& c) {
     switch(c) {
-    case CMD_MODE_CONDITION:    value = Condition; return true;
+    case CMD_MODE_PAIR:         value = Pair; return true;
     case CMD_MODE_REPORT:       value = Report;    return true;
+    case CMD_MODE_STAGE:        value = Stage;    return true;
     case CMD_MODE_ASSOCIATE:    value = Associate; return true;
     case CMD_MODE_MOTION:       value = Motion;    return true;
     case CMD_MODE_MOTION_ALT:   value = MotionAlt; return true;
@@ -54,8 +56,9 @@
 
 bool ModeSelection::writeSettings() {
 #define WRITE(CHR, VAL) if (value == (VAL)) { IO::write("[%c]",CHR); } else { IO::write("%c",CHR); }
-    WRITE(CMD_MODE_CONDITION,   Condition)
+    WRITE(CMD_MODE_PAIR,        Pair)
     WRITE(CMD_MODE_REPORT,      Report)
+    WRITE(CMD_MODE_STAGE,       Stage)
     WRITE(CMD_MODE_ASSOCIATE,   Associate)
     WRITE(CMD_MODE_MOTION,      Motion)
     WRITE(CMD_MODE_MOTION_ALT,  MotionAlt)