quite some fixes

src/driveModi/Modi/Autopilot/autopilot.cpp

@@ -18,20 +18,20 @@ DirectionChangeSignal::DirectionChangeSignal(Autopilot* pilot) {
 }
 
 DirectionChangeSignal::~DirectionChangeSignal() {
-    pilot->getSensorData()->getCalcCompass()->disableCalcAzimuth();
+    CalcAzimuth* calcAzimuth = pilot->getSensorData()->getCalcCompass();
+    if (calcAzimuth)
+        calcAzimuth->disableCalcAzimuth();
 }
 
 void DirectionChangeSignal::action() {
-    pilot->getSensorData()->getCalcCompass()->drivingDirectionChange(pilot->getSensorData()->getCurrentPos());
+    CalcAzimuth* calcAzimuth = pilot->getSensorData()->getCalcCompass();
+    if (calcAzimuth)
+        calcAzimuth->drivingDirectionChange(pilot->getSensorData()->getCurrentPos());
 }
 
 
 Autopilot::Autopilot() {
-        this->setInputMode(ManualControl::InputMode::Digital);
-        this->directionChangeSignal = new DirectionChangeSignal(this);
-        this->setDirectionChangeCallback(this->directionChangeSignal);
-        this->navigation = new Navigation(this->sensorData);
-        this->init();
+        
 }
 
 Autopilot::~Autopilot() {
@@ -247,3 +247,11 @@ void Autopilot::restartLoop() {
     this->lastOrderStatus = this->navigation->getCourseCorrection(this->courseCorrection, true);
     this->updateDisplay = true;
 }
+
+void Autopilot::afterActivate() {
+    this->setInputMode(ManualControl::InputMode::Digital);
+    this->directionChangeSignal = new DirectionChangeSignal(this);
+    this->setDirectionChangeCallback(this->directionChangeSignal);
+    this->navigation = new Navigation(this->sensorData);
+    this->init();
+}

src/driveModi/Modi/Autopilot/autopilot.h

@@ -102,6 +102,7 @@ class Autopilot : public ManualControl {
         void askNavigationForOrder();
         void selfDriving();
         void restartLoop();
+        void afterActivate() override;
 
         Navigation* navigation;
         CourseCorrection courseCorrection;

src/driveModi/Modi/CaptureRoute/captureRoute.cpp

@@ -10,16 +10,14 @@
  */
 
 #include "driveModi/Modi/CaptureRoute/captureRoute.h"
-
-CaptureRoute::CaptureRoute() {
-        this->navigation = new Navigation(this->sensorData);
-        this->navigation->getRoute()->clear();
-        this->sensorData->getNtripClient()->setAutoReconnect(true);
-        this->routeInfo = navigation->getRouteInfo();
-}
+#include "captureRoute.h"
 
 CaptureRoute::~CaptureRoute() {
-    // this->navigation->getNTRIPClient()->setActivated(false);
+    if (this->navigation)
+        delete this->navigation;
+
+    if (this->sensorData->getNtripClient())
+        this->sensorData->getNtripClient()->setActivated(false);
 }
 
 void CaptureRoute::run() {
@@ -34,6 +32,13 @@ void CaptureRoute::run() {
     }
 }
 
+void CaptureRoute::afterActivate() {
+    this->navigation = new Navigation(this->sensorData);
+        this->navigation->getRoute()->clear();
+        this->sensorData->getNtripClient()->setAutoReconnect(true);
+        this->routeInfo = navigation->getRouteInfo();
+}
+
 double CaptureRoute::getDistanceToLastPoint() const {
     if (!this->lastSavedPoint.isInit())
         return 0;

src/driveModi/Modi/CaptureRoute/captureRoute.h

@@ -27,8 +27,6 @@
  */
 class CaptureRoute : public ManualControl {
     public:
-        CaptureRoute();
-
         /**
          * @brief Destroy the Capture Route object
          * 
@@ -68,8 +66,9 @@ class CaptureRoute : public ManualControl {
         bool shouldUpdate();
     private:
         void run() override;
+        void afterActivate() override;
 
-        Navigation* navigation;
+        Navigation* navigation = nullptr;
         RouteInfo routeInfo;
         Point lastSavedPoint;
         Navigation::Status status = Navigation::Status::Complete;

src/driveModi/driveModi.cpp

@@ -27,4 +27,5 @@ void DriveModi::activate(DriveModiParams params){
 void DriveModi::init() {
     this->moveControl->setDrivingStatus(MoveControl::Status::Drive);
     this->loopDelay = 40;
+    this->afterActivate();
 }

src/driveModi/driveModi.h

@@ -60,6 +60,8 @@ class DriveModi : public Component {
         double getMaxRotation() const { return this->maxRotationSpeed; }
 
     protected:
+        virtual void afterActivate() {}
+
         MoveControl *moveControl;
         const ControlPadInput* input;
         const SensorData* sensorData;