Ljubivoj Cvitas / Mbed 2 deprecated SunflowerMach1_Danchi

v1

Dependencies:   PinDetect TextLCD mbed

Fork of SunflowerMach1 by Milan Draganic

main.cpp

Committer:
mdraganic
Date:
2013-11-09
Revision:
1:3500bf8487d0
Parent:
0:7447b8021b33
Child:
2:0bf41ad96558

File content as of revision 1:3500bf8487d0:

#include "mbed.h"
#include "Motor.h"
#include "MotorPwm.h"

AnalogIn ainSensA(p17);
AnalogIn ainSensB(p18);
AnalogIn ainSensC(p19);
AnalogIn ainSensD(p20);

int valAzimut = 0;
int valElevacija = 0;

int main() {

    Motor *motorEl = new MotorPwm(p25, p26);
    Motor *motorAz = new MotorPwm(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();        
        
    
    }
}