motor i senzor
Dependencies: TextLCD mbed PinDetect
main.cpp
- Committer:
- mdraganic
- Date:
- 2013-11-08
- Revision:
- 0:7447b8021b33
- Child:
- 1:3500bf8487d0
File content as of revision 0:7447b8021b33:
#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(); } }