Psi Swarm Robot / Mbed 2 deprecated ModularRobot

Test code for motors, sensors and leds

Dependencies:   PRRobot mbed

main.cpp

Committer:
jah128
Date:
2016-11-26
Revision:
2:dfd136e31aaf
Parent:
1:17d31177e3c0
Child:
3:d42f51bcf883

File content as of revision 2:dfd136e31aaf:

#include "mbed.h"
#include "robot.h"

Robot robot;

int main() {
    robot.init();
    motors.init();
    led.start_test();
   
    while(1) {
        mbed_led1 = 1;
        /*
        for(int i=0;i<8;i++){
          pc.printf("Sensor %d: %d\n",i,sensors.read_adc_value(i));
          wait(0.05);   
        }
        */
        
        robot.debug("Sensor 2: %d\n",sensors.get_adc_value(2));
        wait(0.1);
        mbed_led1 = 0;
        wait(0.1);
       // pc.printf("V: %3.3f\n",robot.get_battery_voltage());
    }
}