motor i senzor

Dependencies:   TextLCD mbed PinDetect

Revision:
6:902bec57d9ae
Parent:
5:7e28f4b64a55
Child:
7:ac67f44120a5
--- a/main.cpp	Sat Nov 09 18:37:53 2013 +0000
+++ b/main.cpp	Mon Nov 11 11:45:55 2013 +0000
@@ -1,8 +1,8 @@
 #include "mbed.h"
 #include "Motor.h"
 
-#define sensorStartTreshold     0.07
-#define sensorStopTreshold      0.02
+#define sensorStartTreshold     0.05
+#define sensorStopTreshold      0.01
 
 #define calibrateFactorSenzA    1
 #define calibrateFactorSenzB    0.97
@@ -67,6 +67,16 @@
 
     while(1) {
     
+        (*motorEl).movePositive();
+        (*motorAz).movePositive();
+        wait(5);
+        (*motorAz).moveNegative();
+        (*motorEl).moveNegative();
+        wait(3);
+        continue;
+
+    
+    
         readValuesForAveraging();
         
 // ----- azimut -----