this is the demo for the dancing robot for ECE 4180

Dependencies:   Motordriver mbed

main.cpp

Committer:
macenzofan
Date:
2017-02-08
Revision:
0:a05a28ae0c99

File content as of revision 0:a05a28ae0c99:

// test code, this demonstrates working motor drivers. 
// full reverse to full stop, dynamicaly brake and switch off.
#include "motordriver.h"
Motor A(p25, p20, p19, 1); // pwm, fwd, rev, can brake 
Motor B(p24, p18, p17, 1); // pwm, fwd, rev, can brake

int main() {
    for (float s= -1.0; s < 1.0 ; s += 0.01) {
        A.speed(s); 
        B.speed(s); 
        wait(0.02);
    }
    A.stop(1.0);
    B.stop(1.0);
    wait(1);
    A.coast();
    B.coast();
    for (float s= -1.0; s < 1.0 ; s += 0.01) {
        A.speed(s); 
        B.speed(-s); 
        wait(0.02);
    }
    A.stop(1.0);
    B.stop(1.0);
    wait(1);
    A.coast();
    B.coast();
}