![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Slow version
Fork of SunflowerMach1 by
Motor.cpp@0:7447b8021b33, 2013-11-08 (annotated)
- Committer:
- mdraganic
- Date:
- Fri Nov 08 19:09:47 2013 +0000
- Revision:
- 0:7447b8021b33
- Child:
- 1:2e7d4aa6e79e
first ini
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
mdraganic | 0:7447b8021b33 | 1 | #include "Motor.h" |
mdraganic | 0:7447b8021b33 | 2 | |
mdraganic | 0:7447b8021b33 | 3 | Motor::Motor(PinName positivePin, PinName negativePin): positiveOut(positivePin), negativeOut(negativePin) { |
mdraganic | 0:7447b8021b33 | 4 | |
mdraganic | 0:7447b8021b33 | 5 | } |
mdraganic | 0:7447b8021b33 | 6 | |
mdraganic | 0:7447b8021b33 | 7 | void Motor::movePositive() { |
mdraganic | 0:7447b8021b33 | 8 | |
mdraganic | 0:7447b8021b33 | 9 | direction = 1; |
mdraganic | 0:7447b8021b33 | 10 | move(); |
mdraganic | 0:7447b8021b33 | 11 | } |
mdraganic | 0:7447b8021b33 | 12 | |
mdraganic | 0:7447b8021b33 | 13 | void Motor::moveNegative() { |
mdraganic | 0:7447b8021b33 | 14 | |
mdraganic | 0:7447b8021b33 | 15 | direction = -1; |
mdraganic | 0:7447b8021b33 | 16 | move(); |
mdraganic | 0:7447b8021b33 | 17 | } |
mdraganic | 0:7447b8021b33 | 18 | |
mdraganic | 0:7447b8021b33 | 19 | void Motor::move() { |
mdraganic | 0:7447b8021b33 | 20 | |
mdraganic | 0:7447b8021b33 | 21 | positiveOut = 0; |
mdraganic | 0:7447b8021b33 | 22 | negativeOut = 0; |
mdraganic | 0:7447b8021b33 | 23 | |
mdraganic | 0:7447b8021b33 | 24 | switch(direction) { |
mdraganic | 0:7447b8021b33 | 25 | case 0: |
mdraganic | 0:7447b8021b33 | 26 | return; |
mdraganic | 0:7447b8021b33 | 27 | case 1: |
mdraganic | 0:7447b8021b33 | 28 | positiveOut = 1; |
mdraganic | 0:7447b8021b33 | 29 | break; |
mdraganic | 0:7447b8021b33 | 30 | case -1: |
mdraganic | 0:7447b8021b33 | 31 | negativeOut = 1; |
mdraganic | 0:7447b8021b33 | 32 | break; |
mdraganic | 0:7447b8021b33 | 33 | } |
mdraganic | 0:7447b8021b33 | 34 | |
mdraganic | 0:7447b8021b33 | 35 | wait_ms(motorDriveTime); |
mdraganic | 0:7447b8021b33 | 36 | } |
mdraganic | 0:7447b8021b33 | 37 | |
mdraganic | 0:7447b8021b33 | 38 | void Motor::stop() { |
mdraganic | 0:7447b8021b33 | 39 | |
mdraganic | 0:7447b8021b33 | 40 | positiveOut = 0; |
mdraganic | 0:7447b8021b33 | 41 | negativeOut = 0; |
mdraganic | 0:7447b8021b33 | 42 | direction = 0; |
mdraganic | 0:7447b8021b33 | 43 | } |