base ultimate + line following HYBRID

Dependencies:   ESC Motor PS_PAD hadah mbed Ping

Fork of Ultimate_Hybrid by KRAI 2016

Revision:
5:256f6eac0358
Parent:
4:7a7a8aa33fd5
--- a/main.cpp	Wed Apr 27 14:28:05 2016 +0000
+++ b/main.cpp	Thu Apr 28 13:56:52 2016 +0000
@@ -174,12 +174,17 @@
         //if(read_jarak() <= 45.0)        vcurr -= ax;
         //else                        vcurr += ax;
         vcurr += ax;
-    }
+        
+        for(int i=0; i<6; i++){
+            printf("%d  ",datasensor[i]);
+        }
+        printf("%d  \n",g_flag);
+        
     }
-    motor1.brake(1);
-    motor2.brake(1);
-    motor3.brake(1);
-    motor4.brake(1);
+    motor1.brake(0);
+    motor2.brake(0);
+    motor3.brake(0);
+    motor4.brake(0);
     
     timer.detach();