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();        
+        
+    
+    }
+}