motor i senzor
Dependencies: TextLCD mbed PinDetect
Diff: main.cpp
- Revision:
- 0:7447b8021b33
- Child:
- 1:3500bf8487d0
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Fri Nov 08 19:09:47 2013 +0000 @@ -0,0 +1,30 @@ +#include "mbed.h" +#include "Motor.h" + +AnalogIn ainSensA(p17); +AnalogIn ainSensB(p18); +AnalogIn ainSensC(p19); +AnalogIn ainSensD(p20); + +int valAzimut = 0; +int valElevacija = 0; + +int main() { + + Motor *motorEl = new Motor(p25, p26); + Motor *motorAz = new Motor(p23, p24); + + while(1) { + + valAzimut = (ainSensA.read_u16() + ainSensB.read_u16()) + - (ainSensC.read_u16() + ainSensD.read_u16()); + valElevacija = (ainSensB.read_u16() + ainSensC.read_u16()) + - (ainSensA.read_u16() + ainSensD.read_u16()); + + (*motorEl).stop(); + (*motorEl).movePositive(); + (*motorEl).moveNegative(); + + + } +}