Psi Swarm Robot
/
ModularRobot
Test code for motors, sensors and leds
Revision 3:d42f51bcf883, committed 2016-11-28
- 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()); } }