Psi Swarm Robot
/
ModularRobot
Test code for motors, sensors and leds
main.cpp
- Committer:
- jah128
- Date:
- 2017-01-13
- Revision:
- 4:31e5dfbe68e8
- Parent:
- 3:d42f51bcf883
File content as of revision 4:31e5dfbe68e8:
#include "mbed.h" #include "robot.h" Robot robot; int main() { robot.init(); int count = 0; while(1){wait(1);} while(1) { switch(count){ case 0: led.set_green_led(0,255); led.set_green_led(1,255); led.set_green_led(2,0); led.set_green_led(3,0); led.set_green_led(4,0); led.set_green_led(5,0); led.set_green_led(6,255); led.set_green_led(7,255); led.set_red_led(0,0); led.set_red_led(1,0); led.set_red_led(2,0); led.set_red_led(3,0); led.set_red_led(4,0); led.set_red_led(5,0); led.set_red_led(6,0); led.set_red_led(7,0); // motors.forwards(0.8); break; case 1: led.set_green_led(0,255); led.set_green_led(1,255); led.set_green_led(2,0); led.set_green_led(3,0); led.set_green_led(4,0); led.set_green_led(5,0); led.set_green_led(6,255); led.set_green_led(7,255); led.set_red_led(0,255); led.set_red_led(1,255); led.set_red_led(2,0); led.set_red_led(3,0); led.set_red_led(4,0); led.set_red_led(5,0); led.set_red_led(6,255); led.set_red_led(7,255); // motors.coast(); break; case 2: led.set_green_led(0,0); led.set_green_led(1,0); led.set_green_led(2,255); led.set_green_led(3,255); led.set_green_led(4,255); led.set_green_led(5,255); led.set_green_led(6,0); led.set_green_led(7,0); led.set_red_led(0,0); led.set_red_led(1,0); led.set_red_led(2,0); led.set_red_led(3,0); led.set_red_led(4,0); led.set_red_led(5,0); led.set_red_led(6,0); led.set_red_led(7,0); // motors.backwards(0.8); break; case 3: led.set_green_led(0,0); led.set_green_led(1,0); led.set_green_led(2,0); led.set_green_led(3,0); led.set_green_led(4,0); led.set_green_led(5,0); led.set_green_led(6,0); led.set_green_led(7,0); led.set_red_led(0,0); led.set_red_led(1,0); led.set_red_led(2,255); led.set_red_led(3,255); led.set_red_led(4,255); led.set_red_led(5,255); led.set_red_led(6,0); led.set_red_led(7,0); // motors.brake(); break; } count++; if(count==4) count = 0; wait(0.25); } }