unedited
Dependencies: Motordriver mbed
main.cpp@0:53dd64d2eabd, 2013-05-18 (annotated)
- Committer:
- kit3
- Date:
- Sat May 18 04:37:36 2013 +0000
- Revision:
- 0:53dd64d2eabd
OBSTACLE AVOIDING ROBOT USING ULTRASONIC SENSOR
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
kit3 | 0:53dd64d2eabd | 1 | #include "mbed.h" |
kit3 | 0:53dd64d2eabd | 2 | #include "motordriver.h" |
kit3 | 0:53dd64d2eabd | 3 | Motor A(p22, p6, p5, 1); // pwm, fwd, rev, can brake |
kit3 | 0:53dd64d2eabd | 4 | Motor B(p21, p7, p8, 1); // pwm, fwd, rev, can brake |
kit3 | 0:53dd64d2eabd | 5 | int main() |
kit3 | 0:53dd64d2eabd | 6 | { |
kit3 | 0:53dd64d2eabd | 7 | |
kit3 | 0:53dd64d2eabd | 8 | //for (float s= -1.0; s < 1.0 ; s += 0.01) |
kit3 | 0:53dd64d2eabd | 9 | //{ |
kit3 | 0:53dd64d2eabd | 10 | // A.speed(s); |
kit3 | 0:53dd64d2eabd | 11 | //B.speed(s); |
kit3 | 0:53dd64d2eabd | 12 | //wait(0.01); |
kit3 | 0:53dd64d2eabd | 13 | //} |
kit3 | 0:53dd64d2eabd | 14 | |
kit3 | 0:53dd64d2eabd | 15 | //A.coast(); |
kit3 | 0:53dd64d2eabd | 16 | //B.coast(); |
kit3 | 0:53dd64d2eabd | 17 | //void right(); |
kit3 | 0:53dd64d2eabd | 18 | while(1) |
kit3 | 0:53dd64d2eabd | 19 | { |
kit3 | 0:53dd64d2eabd | 20 | A.speed(1.0); |
kit3 | 0:53dd64d2eabd | 21 | B.speed(1.0); |
kit3 | 0:53dd64d2eabd | 22 | wait (2); |
kit3 | 0:53dd64d2eabd | 23 | |
kit3 | 0:53dd64d2eabd | 24 | A.speed(-1.0); |
kit3 | 0:53dd64d2eabd | 25 | B.speed(-1.0); |
kit3 | 0:53dd64d2eabd | 26 | } |
kit3 | 0:53dd64d2eabd | 27 | //void left(); |
kit3 | 0:53dd64d2eabd | 28 | } |
kit3 | 0:53dd64d2eabd | 29 | |
kit3 | 0:53dd64d2eabd | 30 | void right() |
kit3 | 0:53dd64d2eabd | 31 | { |
kit3 | 0:53dd64d2eabd | 32 | A.speed(1.0); |
kit3 | 0:53dd64d2eabd | 33 | B.speed(-1.0); |
kit3 | 0:53dd64d2eabd | 34 | } |
kit3 | 0:53dd64d2eabd | 35 | |
kit3 | 0:53dd64d2eabd | 36 | void left() |
kit3 | 0:53dd64d2eabd | 37 | { |
kit3 | 0:53dd64d2eabd | 38 | A.speed(-1.0); |
kit3 | 0:53dd64d2eabd | 39 | B.speed(1.0); |
kit3 | 0:53dd64d2eabd | 40 | } |