Milan Draganic / Mbed 2 deprecated SunflowerMach1

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?

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