Test code for motors, sensors and leds

Dependencies:   PRRobot mbed

Revision:
3:d42f51bcf883
Parent:
2:dfd136e31aaf
Child:
4:31e5dfbe68e8
diff -r dfd136e31aaf -r d42f51bcf883 main.cpp
--- a/main.cpp	Sat Nov 26 21:50:27 2016 +0000
+++ b/main.cpp	Mon Nov 28 22:41:25 2016 +0000
@@ -5,8 +5,6 @@
 
 int main() {
     robot.init();
-    motors.init();
-    led.start_test();
    
     while(1) {
         mbed_led1 = 1;
@@ -17,10 +15,21 @@
         }
         */
         
-        robot.debug("Sensor 2: %d\n",sensors.get_adc_value(2));
+        //robot.debug("Sensor 2: %d\n",sensors.get_adc_value(2));
         wait(0.1);
         mbed_led1 = 0;
         wait(0.1);
+        
+        motors.set_left_motor_speed(0.25);
+        robot.update_status_message();
+        robot.debug("Status message:[");
+        for(int i=0;i<16;i++){
+            robot.debug("%2X ",status_message[i]);
+        }
+        
+        robot.debug("]\n");
+        
+        
        // pc.printf("V: %3.3f\n",robot.get_battery_voltage());
     }
 }