Diff: main.cpp

Revision:

14:f114e57c3795

Parent:

13:e8b8b035abbd

Child:

15:e9439eac1342

--- a/main.cpp	Mon Oct 31 13:52:51 2016 +0000
+++ b/main.cpp	Mon Oct 31 13:55:32 2016 +0000
@@ -259,30 +259,30 @@
     // To indicate that the function is working, the LED is on
     if (outRechts >= 0.04){
         BicepsRight = true;
-        red = 1;
+        red = 0;
         }
     else{
         BicepsRight = false;
-        red = 0;
+        red = 1;
     }
 
     // If Biceps links is actuated then:
     if (outLinks >= 0.04){
         BicepsLeft = true;
-        blue = 1;
+        blue = 0;
         }
     else{
         BicepsLeft = false;
-        blue = 0;
+        blue = 1;
     }
      // If upper leg is actuated then:
     if (outBeen >= 0.01){
         Leg = true;
-        green = 1;
+        green = 0;
         }
     else{
         Leg = false;
-        green = 0;
+        green = 1;
     }
 }
 
@@ -668,6 +668,11 @@
     led = 1;
     BlinkLedTicker.attach(BlinkLed,0.5);
     
+    // Setup other leds
+    red = 1;
+    blue = 1;
+    green = 1;
+    
     // Setup motor PWM speeds
     motor1_pwm.period(1.0/1000);
     motor2_pwm.period(1.0/1000);