this is the demo for the dancing robot for ECE 4180
Dependencies: Motordriver mbed
main.cpp@0:a05a28ae0c99, 2017-02-08 (annotated)
- 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?
User | Revision | Line number | New 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 | } |