#4 Now I-commands are transmitted to upper level

robot-mitya · Mar 25, 2014 · 7396309 · 7396309
1 parent 55f9cac
commit 7396309
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/robo_body/rm_equ.cpp b/robo_body/rm_equ.cpp
@@ -132,26 +132,32 @@ void Equipment::executeInstruction(int value)
     case Cfg::INSTRUCTION_HEADLIGHTS_OFF:
       digitalWrite(Cfg::LIGHT_PIN, LOW);
       Cfg::stateHeadlights = value;
+      Message::send("I", value);
       break;
     case Cfg::INSTRUCTION_HEADLIGHTS_ON:
       digitalWrite(Cfg::LIGHT_PIN, HIGH);
       Cfg::stateHeadlights = value;
+      Message::send("I", value);
       break;
     case Cfg::INSTRUCTION_MAIN_ACCUMULATOR_CHARGE_OFF:
       digitalWrite(Cfg::MAIN_ACCUMULATOR_CHARGER_PIN, LOW);
       Cfg::stateMainAccumulatorCharge = value;
+      Message::send("I", value);
       break;
     case Cfg::INSTRUCTION_MAIN_ACCUMULATOR_CHARGE_ON:
       digitalWrite(Cfg::MAIN_ACCUMULATOR_CHARGER_PIN, HIGH);
       Cfg::stateMainAccumulatorCharge = value;
+      Message::send("I", value);
       break;
     case Cfg::INSTRUCTION_PHONE_ACCUMULATOR_CHARGE_OFF:
       digitalWrite(Cfg::PHONE_ACCUMULATOR_CHARGER_PIN, LOW);
       Cfg::statePhoneAccumulatorCharge = value;
+      Message::send("I", value);
       break;
     case Cfg::INSTRUCTION_PHONE_ACCUMULATOR_CHARGE_ON:
       digitalWrite(Cfg::PHONE_ACCUMULATOR_CHARGER_PIN, HIGH);
       Cfg::statePhoneAccumulatorCharge = value;
+      Message::send("I", value);
       break;
   }
 }