Robotcontrol groep 2

Dependencies:   Encoder MODSERIAL mbed HIDScope

Revision:
12:e30bc8446379
Parent:
11:97759ceeb638
Child:
13:74035e04584a
--- a/main.cpp	Tue Nov 04 10:53:04 2014 +0000
+++ b/main.cpp	Tue Nov 04 10:56:19 2014 +0000
@@ -345,10 +345,11 @@
 uint8_t badje (uint8_t y1, uint8_t y2)
 {
     if (y1>0 && y2>0 && check>0) {
+        rood = 0;
+        groen = 0;
+        blauw = 1;
         badjedone=1;
         check=0;
-        /*rood = 1;
-        groen = 0;*/
         cout<<"ga naar mode 2"<<endl;
         wait(1);
     } else if (y1>0 && y2>0) {
@@ -475,6 +476,9 @@
 {
     static int stand=0;
     if (y1>0 && y2>0 && check>0) {
+        rood=0;
+        groen=0;
+        blauw=1;
         badjedone=2;
         check=0;
         /*rood = 0;