Test code for motors, sensors and leds

Dependencies:   PRRobot mbed

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);
    }
}