Test servo, IR sensor, and motor setup on Sparkfun Shadow robot base

Dependencies:   Motordriver mbed

Fork of Magician_Motor_Test by jim hamblen

main.cpp

Committer:
4180_1
Date:
2011-10-26
Revision:
0:5c26b3940003

File content as of revision 0:5c26b3940003:

// Magician robot motor test

#include "mbed.h"
#include "motordriver.h"
 
DigitalOut myled(LED1);

//See http://mbed.org/cookbook/Motor
//Connections to dual H-brdige driver for the two drive motors
Motor  left(p21, p22, p23, 1); // pwm, fwd, rev, has brake feature
Motor right(p26, p25, p24, 1);

int main() {
    while (1) {
        myled=1;
// Sweep the motor speed from full-speed reverse (-1.0) to full speed forwards (1.0)
        for (float s= -1.0; s < 1.0 ; s += 0.01) {
            left.speed(s);
            right.speed(s);
            wait(0.02);
        }
// Turn off motors - coast one and brake one
        left.coast();
        right.stop(1);
        myled=0;
        wait(1);
    }
}