zhaw_st16b_pes2_10 / Mbed 2 deprecated PES-Yanick2

ahah

Dependencies:   Servo mbed

Fork of PES_Official by zhaw_st16b_pes2_10

Diff: Sources/main.cpp

Revision:
6:9627ef490cd5
Parent:
5:1aaf5de776ff
--- a/Sources/main.cpp	Wed Apr 26 08:05:25 2017 +0000
+++ b/Sources/main.cpp	Tue May 02 10:35:15 2017 +0000
@@ -54,6 +54,12 @@
     int found = 0;                      //0:= no block available, 1 := a lego is ready to be picked up
     
     while( 1 ){
+        if(sam.sensors[FWD_L]<0.14) leds[2]=1;
+        else leds[2]=0;
+        if(sam.sensors[RIGHT_L]<0.14) leds[1]=1;
+        else leds[1]=0;
+        if(sam.sensors[LEFT_L]<0.14) leds[5]=1;
+        else leds[5]=0;
         if ( timer > TIMEOUT ){
             NVIC_SystemReset();         //Resets Sam.
         }
@@ -68,7 +74,7 @@
         
         wait( 0.1f );
     }
-    return 0;
+   // return 0;
 }
 
 /* * /