this is the demo for the dancing robot for ECE 4180

Dependencies:   Motordriver mbed

Committer:
macenzofan
Date:
Wed Feb 08 21:45:46 2017 +0000
Revision:
0:a05a28ae0c99
ECE 4180 Dancing robot demo

Who changed what in which revision?

UserRevisionLine numberNew contents of line
macenzofan 0:a05a28ae0c99 1 // test code, this demonstrates working motor drivers.
macenzofan 0:a05a28ae0c99 2 // full reverse to full stop, dynamicaly brake and switch off.
macenzofan 0:a05a28ae0c99 3 #include "motordriver.h"
macenzofan 0:a05a28ae0c99 4 Motor A(p25, p20, p19, 1); // pwm, fwd, rev, can brake
macenzofan 0:a05a28ae0c99 5 Motor B(p24, p18, p17, 1); // pwm, fwd, rev, can brake
macenzofan 0:a05a28ae0c99 6
macenzofan 0:a05a28ae0c99 7 int main() {
macenzofan 0:a05a28ae0c99 8 for (float s= -1.0; s < 1.0 ; s += 0.01) {
macenzofan 0:a05a28ae0c99 9 A.speed(s);
macenzofan 0:a05a28ae0c99 10 B.speed(s);
macenzofan 0:a05a28ae0c99 11 wait(0.02);
macenzofan 0:a05a28ae0c99 12 }
macenzofan 0:a05a28ae0c99 13 A.stop(1.0);
macenzofan 0:a05a28ae0c99 14 B.stop(1.0);
macenzofan 0:a05a28ae0c99 15 wait(1);
macenzofan 0:a05a28ae0c99 16 A.coast();
macenzofan 0:a05a28ae0c99 17 B.coast();
macenzofan 0:a05a28ae0c99 18 for (float s= -1.0; s < 1.0 ; s += 0.01) {
macenzofan 0:a05a28ae0c99 19 A.speed(s);
macenzofan 0:a05a28ae0c99 20 B.speed(-s);
macenzofan 0:a05a28ae0c99 21 wait(0.02);
macenzofan 0:a05a28ae0c99 22 }
macenzofan 0:a05a28ae0c99 23 A.stop(1.0);
macenzofan 0:a05a28ae0c99 24 B.stop(1.0);
macenzofan 0:a05a28ae0c99 25 wait(1);
macenzofan 0:a05a28ae0c99 26 A.coast();
macenzofan 0:a05a28ae0c99 27 B.coast();
macenzofan 0:a05a28ae0c99 28 }