Moving implementation of RGB LED setting from header to source file.

Author: aentinger

src/Braccio++.cpp

@@ -273,12 +273,24 @@ bool BraccioClass::expander_init()
 
   /* Set all motor status LEDs to red. */
   for (int id = SmartServoClass::MIN_MOTOR_ID; id <= SmartServoClass::MAX_MOTOR_ID; id++) {
-    setRed(id);
+    expander_setRed(id);
   }
 
   return true;
 }
 
+void BraccioClass::expander_setGreen(int const i)
+{
+  _expander.writePin(i * 2 - 1, 0);
+  _expander.writePin(i * 2 - 2, 1);
+}
+
+void BraccioClass::expander_setRed(int const i)
+{
+  _expander.writePin(i * 2 - 1, 1);
+  _expander.writePin(i * 2 - 2, 0);
+}
+
 bool BraccioClass::isPingAllowed()
 {
   mbed::ScopedLock<rtos::Mutex> lock(_motors_connected_mtx);
@@ -305,9 +317,9 @@ void BraccioClass::motorConnectedThreadFunc()
 
       for (int id = SmartServoClass::MIN_MOTOR_ID; id <= SmartServoClass::MAX_MOTOR_ID; id++) {
         if (connected(id))
-          setGreen(id);
+          expander_setGreen(id);
         else
-          setRed(id);
+          expander_setRed(id);
       }
     }
     delay(1000);

src/Braccio++.h

@@ -97,6 +97,8 @@ class BraccioClass
   PD_UFP_log_c PD_UFP;
   TCA6424A _expander;
   bool expander_init();
+  void expander_setGreen(int const i);
+  void expander_setRed(int const i);
 
   bool _is_ping_allowed;
   bool _is_motor_connected[SmartServoClass::NUM_MOTORS];
@@ -150,16 +152,6 @@ class BraccioClass
     pd_events.set(1);
   }
 
-  void setGreen(int i) {
-    _expander.writePin(i * 2 - 1, 0);
-    _expander.writePin(i * 2 - 2, 1);
-  }
-
-  void setRed(int i) {
-    _expander.writePin(i * 2 - 1, 1);
-    _expander.writePin(i * 2 - 2, 0);
-  }
-
   void pd_thread();
 };