Robotcontrol groep 2
Dependencies: Encoder MODSERIAL mbed HIDScope
Diff: main.cpp
- Revision:
- 12:e30bc8446379
- Parent:
- 11:97759ceeb638
- Child:
- 13:74035e04584a
diff -r 97759ceeb638 -r e30bc8446379 main.cpp --- 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;