Slow version

Dependencies:   mbed

Fork of SunflowerMach1 by Milan Draganic

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?

UserRevisionLine numberNew 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 }