Fix projection

Do not do any projection before target coordinates have been set.

mavsdk_wrapper.cpp

@@ -55,6 +55,7 @@ static const float DEFAULT_SPEED = 16;
 static float last_override_altitude;
 static float last_override_speed;
 
+static bool first_coordinate_entered = false;
 static bool do_projection = false;
 
 // Logs functions
@@ -228,15 +229,17 @@ void updateLogAndProjection(void) {
             << metrics.airspeed_m_s << ";" << metrics.climb_rate_m_s;
         log(oss.str());
 
-        if (do_projection) {
-            updateProjection(current_position[0], current_position[1]);
-        } else {
-          doReposition_async(
-              (float)targeted_destination.latitude,
-              (float)targeted_destination.longitude,
-              targeted_radius,
-              0
-          );
+        if (first_coordinate_entered) {
+          if (do_projection) {
+              updateProjection(current_position[0], current_position[1]);
+          } else {
+            doReposition_async(
+                (float)targeted_destination.latitude,
+                (float)targeted_destination.longitude,
+                targeted_radius,
+                0
+            ); 
+          }
         }
     }
 }
@@ -384,6 +387,10 @@ int triggerParachute(void) {
 // Flight management functions
 
 void loiter(double la, double lo, float a, float radius) {
+    if (!first_coordinate_entered) {
+      first_coordinate_entered = true;
+    }
+
     targeted_destination.latitude = la;
     targeted_destination.longitude = lo;
     targeted_radius = radius;
@@ -409,6 +416,10 @@ void setTargetCoordinates(double la, double lo, float a) {
         return;
     }
 
+    if (!first_coordinate_entered) {
+      first_coordinate_entered = true;
+    }
+
     targeted_destination.latitude = la;
     targeted_destination.longitude = lo;
     do_projection = true;