![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
Test code for motors, sensors and leds
Diff: main.cpp
- Revision:
- 3:d42f51bcf883
- Parent:
- 2:dfd136e31aaf
- Child:
- 4:31e5dfbe68e8
--- 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()); } }