Milan Draganic / Mbed 2 deprecated SunflowerMach1

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?

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