Psi Swarm Robot / Mbed 2 deprecated ModularRobot

Test code for motors, sensors and leds

Dependencies:   PRRobot mbed

main.cpp@4:31e5dfbe68e8, 2017-01-13 (annotated)

Committer:
jah128
Date:
Fri Jan 13 23:16:32 2017 +0000
Revision:
4:31e5dfbe68e8
Parent:
3:d42f51bcf883 
Updated

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jah128 0:e0510fa64cef 1 #include "mbed.h"
jah128 0:e0510fa64cef 2 #include "robot.h"
jah128 0:e0510fa64cef 3
jah128 0:e0510fa64cef 4 Robot robot;
jah128 0:e0510fa64cef 5
jah128 0:e0510fa64cef 6 int main() {
jah128 0:e0510fa64cef 7 robot.init();
jah128 1:17d31177e3c0 8
jah128 4:31e5dfbe68e8 9 int count = 0;
jah128 4:31e5dfbe68e8 10 while(1){wait(1);}
jah128 0:e0510fa64cef 11 while(1) {
jah128 4:31e5dfbe68e8 12 switch(count){
jah128 4:31e5dfbe68e8 13 case 0:
jah128 4:31e5dfbe68e8 14 led.set_green_led(0,255);
jah128 4:31e5dfbe68e8 15 led.set_green_led(1,255);
jah128 4:31e5dfbe68e8 16 led.set_green_led(2,0);
jah128 4:31e5dfbe68e8 17 led.set_green_led(3,0);
jah128 4:31e5dfbe68e8 18 led.set_green_led(4,0);
jah128 4:31e5dfbe68e8 19 led.set_green_led(5,0);
jah128 4:31e5dfbe68e8 20 led.set_green_led(6,255);
jah128 4:31e5dfbe68e8 21 led.set_green_led(7,255);
jah128 4:31e5dfbe68e8 22 led.set_red_led(0,0);
jah128 4:31e5dfbe68e8 23 led.set_red_led(1,0);
jah128 4:31e5dfbe68e8 24 led.set_red_led(2,0);
jah128 4:31e5dfbe68e8 25 led.set_red_led(3,0);
jah128 4:31e5dfbe68e8 26 led.set_red_led(4,0);
jah128 4:31e5dfbe68e8 27 led.set_red_led(5,0);
jah128 4:31e5dfbe68e8 28 led.set_red_led(6,0);
jah128 4:31e5dfbe68e8 29 led.set_red_led(7,0);
jah128 4:31e5dfbe68e8 30 // motors.forwards(0.8);
jah128 4:31e5dfbe68e8 31 break;
jah128 4:31e5dfbe68e8 32 case 1:
jah128 4:31e5dfbe68e8 33 led.set_green_led(0,255);
jah128 4:31e5dfbe68e8 34 led.set_green_led(1,255);
jah128 4:31e5dfbe68e8 35 led.set_green_led(2,0);
jah128 4:31e5dfbe68e8 36 led.set_green_led(3,0);
jah128 4:31e5dfbe68e8 37 led.set_green_led(4,0);
jah128 4:31e5dfbe68e8 38 led.set_green_led(5,0);
jah128 4:31e5dfbe68e8 39 led.set_green_led(6,255);
jah128 4:31e5dfbe68e8 40 led.set_green_led(7,255);
jah128 4:31e5dfbe68e8 41 led.set_red_led(0,255);
jah128 4:31e5dfbe68e8 42 led.set_red_led(1,255);
jah128 4:31e5dfbe68e8 43 led.set_red_led(2,0);
jah128 4:31e5dfbe68e8 44 led.set_red_led(3,0);
jah128 4:31e5dfbe68e8 45 led.set_red_led(4,0);
jah128 4:31e5dfbe68e8 46 led.set_red_led(5,0);
jah128 4:31e5dfbe68e8 47 led.set_red_led(6,255);
jah128 4:31e5dfbe68e8 48 led.set_red_led(7,255);
jah128 4:31e5dfbe68e8 49 // motors.coast();
jah128 4:31e5dfbe68e8 50 break;
jah128 4:31e5dfbe68e8 51 case 2:
jah128 4:31e5dfbe68e8 52 led.set_green_led(0,0);
jah128 4:31e5dfbe68e8 53 led.set_green_led(1,0);
jah128 4:31e5dfbe68e8 54 led.set_green_led(2,255);
jah128 4:31e5dfbe68e8 55 led.set_green_led(3,255);
jah128 4:31e5dfbe68e8 56 led.set_green_led(4,255);
jah128 4:31e5dfbe68e8 57 led.set_green_led(5,255);
jah128 4:31e5dfbe68e8 58 led.set_green_led(6,0);
jah128 4:31e5dfbe68e8 59 led.set_green_led(7,0);
jah128 4:31e5dfbe68e8 60 led.set_red_led(0,0);
jah128 4:31e5dfbe68e8 61 led.set_red_led(1,0);
jah128 4:31e5dfbe68e8 62 led.set_red_led(2,0);
jah128 4:31e5dfbe68e8 63 led.set_red_led(3,0);
jah128 4:31e5dfbe68e8 64 led.set_red_led(4,0);
jah128 4:31e5dfbe68e8 65 led.set_red_led(5,0);
jah128 4:31e5dfbe68e8 66 led.set_red_led(6,0);
jah128 4:31e5dfbe68e8 67 led.set_red_led(7,0);
jah128 4:31e5dfbe68e8 68 // motors.backwards(0.8);
jah128 4:31e5dfbe68e8 69 break;
jah128 4:31e5dfbe68e8 70 case 3:
jah128 4:31e5dfbe68e8 71 led.set_green_led(0,0);
jah128 4:31e5dfbe68e8 72 led.set_green_led(1,0);
jah128 4:31e5dfbe68e8 73 led.set_green_led(2,0);
jah128 4:31e5dfbe68e8 74 led.set_green_led(3,0);
jah128 4:31e5dfbe68e8 75 led.set_green_led(4,0);
jah128 4:31e5dfbe68e8 76 led.set_green_led(5,0);
jah128 4:31e5dfbe68e8 77 led.set_green_led(6,0);
jah128 4:31e5dfbe68e8 78 led.set_green_led(7,0);
jah128 4:31e5dfbe68e8 79 led.set_red_led(0,0);
jah128 4:31e5dfbe68e8 80 led.set_red_led(1,0);
jah128 4:31e5dfbe68e8 81 led.set_red_led(2,255);
jah128 4:31e5dfbe68e8 82 led.set_red_led(3,255);
jah128 4:31e5dfbe68e8 83 led.set_red_led(4,255);
jah128 4:31e5dfbe68e8 84 led.set_red_led(5,255);
jah128 4:31e5dfbe68e8 85 led.set_red_led(6,0);
jah128 4:31e5dfbe68e8 86 led.set_red_led(7,0);
jah128 4:31e5dfbe68e8 87 // motors.brake();
jah128 4:31e5dfbe68e8 88 break;
jah128 0:e0510fa64cef 89 }
jah128 4:31e5dfbe68e8 90 count++;
jah128 4:31e5dfbe68e8 91 if(count==4) count = 0;
jah128 4:31e5dfbe68e8 92 wait(0.25);
jah128 0:e0510fa64cef 93 }
jah128 0:e0510fa64cef 94 }