Yey

platformio.ini

@@ -17,4 +17,4 @@ lib_deps =
 	dfrobot/DFRobot_QMC5883@^1.0.0
 	juerd/ESP-WiFiSettings@^3.8.0
 	https://github.com/sivar2311/WebMonitor
-;upload_flags = --auth=senha1234
+upload_flags = --auth=senha1234

src/servo.cpp

@@ -58,6 +58,30 @@ void ServoController::updateHeading() {
 }
 
 void ServoController::moveToAzAlt(float azimuth, float altitude) {
+    azimuth -= headingDegrees;
+
+    if (azimuth < 0) {
+        azimuth += 360;
+    }
+
+    if (altitude >= 0) {
+        if (azimuth <= 180) {
+            HrzSrv.write(azimuth);
+            delay(100);
+            VrtSrv.write(altitude);
+            delay(100);
+        } else {
+            HrzSrv.write(azimuth - 180);
+            delay(100);
+            VrtSrv.write(180 - altitude);
+            delay(100);
+        }
+    } else {
+        HrzSrv.write(0);
+        delay(100);
+        VrtSrv.write(90);
+        delay(100);
+    }
 
 }