Test code for motors, sensors and leds

Dependencies:   PRRobot mbed

Files at this revision

API Documentation at this revision

Comitter:
jah128
Date:
Mon Nov 28 22:41:25 2016 +0000
Parent:
2:dfd136e31aaf
Child:
4:31e5dfbe68e8
Commit message:
Added first RPi input;

Changed in this revision

PRRobot.lib Show annotated file Show diff for this revision Revisions of this file
main.cpp Show annotated file Show diff for this revision Revisions of this file
--- a/PRRobot.lib	Sat Nov 26 21:50:27 2016 +0000
+++ b/PRRobot.lib	Mon Nov 28 22:41:25 2016 +0000
@@ -1,1 +1,1 @@
-https://developer.mbed.org/teams/Psi-Swarm-Robot/code/PRRobot/#bf34b86aa0f3
+https://developer.mbed.org/teams/Psi-Swarm-Robot/code/PRRobot/#8762f6b2ea8d
--- 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());
     }
 }