ADD: added the whole tunction to calculate the movement with gegraphiclib

include/Entities/Entity.hpp

@@ -68,7 +68,7 @@ namespace Entities {
             virtual void specificPhysicsCalculations(std::chrono::milliseconds::rep duration) = 0;
             virtual void specificReloadCharacteristicts() = 0;
 
-            std::unique_ptr<Entities::Movement> Movement_;
+            std::unique_ptr<Entities::Movement> Movement_ = nullptr;
 
         private:
 

src/Entities/Entity.cpp

@@ -104,7 +104,13 @@ namespace Entities
     auto end = std::chrono::steady_clock::now();
     std::chrono::milliseconds::rep duration =  std::chrono::duration_cast<std::chrono::milliseconds>(end - start).count();
 
-    Movement_->updatePosition(duration);
+
+    if(Movement_ != nullptr)
+    {
+    // Movement_->updatePosition(duration);
+    Movement_->updatePositionSimple(duration);
+
+    }
 
 
     specificPhysicsCalculations(duration);

src/Entities/Movement.cpp

@@ -100,8 +100,30 @@ namespace Entities
 
     void Movement::updatePositionSimple(double dt)
     {
+        double lat = ownPosition_.getGeodesicPos()(SimCore::LATITUDE);  // in degree
+        double lon = ownPosition_.getGeodesicPos()(SimCore::LONGITUDE);  // in degree
+        double alt = ownPosition_.getGeodesicPos()(SimCore::HEIGHT);  // in meters
 
+        double vx = this->speed_ * cos(this->getPitch());
+        double vy = this->speed_ * sin(this->getPitch());
+
+        LOG_S(INFO)<<"VX: " << vx << " VY: " <<vy;
+
+        double movedDistance = vx * dt / 1000;
+        double climedHeight = vy * dt / 1000;
+
+        LOG_S(INFO)<<"moved distance: " <<movedDistance; 
+        GeographicLib::Geodesic geod(GeographicLib::Constants::WGS84_a(), GeographicLib::Constants::WGS84_f());
+
+        double lat2,lon2;
+
+        geod.Direct(lat,lon,this->course_,movedDistance,lat2,lon2);
+
+        LOG_S(INFO)<< "lat: "<<lat<<" lon: "<<lon;
+        LOG_S(INFO)<< "lat: "<<lat2<<" lon: "<<lon2;
+         ownPosition_.setGeodesicPos(lat2,lon2,climedHeight);
         
+
     }