motor i senzor
Dependencies: TextLCD mbed PinDetect
main.cpp@1:3500bf8487d0, 2013-11-09 (annotated)
- Committer:
- mdraganic
- Date:
- Sat Nov 09 06:49:43 2013 +0000
- Revision:
- 1:3500bf8487d0
- Parent:
- 0:7447b8021b33
- Child:
- 2:0bf41ad96558
added pwm motor driver
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
mdraganic | 0:7447b8021b33 | 1 | #include "mbed.h" |
mdraganic | 0:7447b8021b33 | 2 | #include "Motor.h" |
mdraganic | 1:3500bf8487d0 | 3 | #include "MotorPwm.h" |
mdraganic | 0:7447b8021b33 | 4 | |
mdraganic | 0:7447b8021b33 | 5 | AnalogIn ainSensA(p17); |
mdraganic | 0:7447b8021b33 | 6 | AnalogIn ainSensB(p18); |
mdraganic | 0:7447b8021b33 | 7 | AnalogIn ainSensC(p19); |
mdraganic | 0:7447b8021b33 | 8 | AnalogIn ainSensD(p20); |
mdraganic | 0:7447b8021b33 | 9 | |
mdraganic | 0:7447b8021b33 | 10 | int valAzimut = 0; |
mdraganic | 0:7447b8021b33 | 11 | int valElevacija = 0; |
mdraganic | 0:7447b8021b33 | 12 | |
mdraganic | 0:7447b8021b33 | 13 | int main() { |
mdraganic | 0:7447b8021b33 | 14 | |
mdraganic | 1:3500bf8487d0 | 15 | Motor *motorEl = new MotorPwm(p25, p26); |
mdraganic | 1:3500bf8487d0 | 16 | Motor *motorAz = new MotorPwm(p23, p24); |
mdraganic | 0:7447b8021b33 | 17 | |
mdraganic | 0:7447b8021b33 | 18 | while(1) { |
mdraganic | 0:7447b8021b33 | 19 | |
mdraganic | 0:7447b8021b33 | 20 | valAzimut = (ainSensA.read_u16() + ainSensB.read_u16()) |
mdraganic | 0:7447b8021b33 | 21 | - (ainSensC.read_u16() + ainSensD.read_u16()); |
mdraganic | 0:7447b8021b33 | 22 | valElevacija = (ainSensB.read_u16() + ainSensC.read_u16()) |
mdraganic | 0:7447b8021b33 | 23 | - (ainSensA.read_u16() + ainSensD.read_u16()); |
mdraganic | 0:7447b8021b33 | 24 | |
mdraganic | 0:7447b8021b33 | 25 | (*motorEl).stop(); |
mdraganic | 0:7447b8021b33 | 26 | (*motorEl).movePositive(); |
mdraganic | 0:7447b8021b33 | 27 | (*motorEl).moveNegative(); |
mdraganic | 0:7447b8021b33 | 28 | |
mdraganic | 0:7447b8021b33 | 29 | |
mdraganic | 0:7447b8021b33 | 30 | } |
mdraganic | 0:7447b8021b33 | 31 | } |