motor i senzor
Dependencies: TextLCD mbed PinDetect
main.cpp@0:7447b8021b33, 2013-11-08 (annotated)
- Committer:
- mdraganic
- Date:
- Fri Nov 08 19:09:47 2013 +0000
- Revision:
- 0:7447b8021b33
- Child:
- 1:3500bf8487d0
first ini
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 | 0:7447b8021b33 | 3 | |
mdraganic | 0:7447b8021b33 | 4 | AnalogIn ainSensA(p17); |
mdraganic | 0:7447b8021b33 | 5 | AnalogIn ainSensB(p18); |
mdraganic | 0:7447b8021b33 | 6 | AnalogIn ainSensC(p19); |
mdraganic | 0:7447b8021b33 | 7 | AnalogIn ainSensD(p20); |
mdraganic | 0:7447b8021b33 | 8 | |
mdraganic | 0:7447b8021b33 | 9 | int valAzimut = 0; |
mdraganic | 0:7447b8021b33 | 10 | int valElevacija = 0; |
mdraganic | 0:7447b8021b33 | 11 | |
mdraganic | 0:7447b8021b33 | 12 | int main() { |
mdraganic | 0:7447b8021b33 | 13 | |
mdraganic | 0:7447b8021b33 | 14 | Motor *motorEl = new Motor(p25, p26); |
mdraganic | 0:7447b8021b33 | 15 | Motor *motorAz = new Motor(p23, p24); |
mdraganic | 0:7447b8021b33 | 16 | |
mdraganic | 0:7447b8021b33 | 17 | while(1) { |
mdraganic | 0:7447b8021b33 | 18 | |
mdraganic | 0:7447b8021b33 | 19 | valAzimut = (ainSensA.read_u16() + ainSensB.read_u16()) |
mdraganic | 0:7447b8021b33 | 20 | - (ainSensC.read_u16() + ainSensD.read_u16()); |
mdraganic | 0:7447b8021b33 | 21 | valElevacija = (ainSensB.read_u16() + ainSensC.read_u16()) |
mdraganic | 0:7447b8021b33 | 22 | - (ainSensA.read_u16() + ainSensD.read_u16()); |
mdraganic | 0:7447b8021b33 | 23 | |
mdraganic | 0:7447b8021b33 | 24 | (*motorEl).stop(); |
mdraganic | 0:7447b8021b33 | 25 | (*motorEl).movePositive(); |
mdraganic | 0:7447b8021b33 | 26 | (*motorEl).moveNegative(); |
mdraganic | 0:7447b8021b33 | 27 | |
mdraganic | 0:7447b8021b33 | 28 | |
mdraganic | 0:7447b8021b33 | 29 | } |
mdraganic | 0:7447b8021b33 | 30 | } |