calc Azimuth finished

src/driveModi/Modi/Autopilot/autopilot.cpp

@@ -29,8 +29,8 @@ void DirectionChangeSignal::action() {
 Autopilot::Autopilot(MoveControl* moveControl, const ControlPadInput *input, Navigation* navigation)
     : ManualControl(moveControl, input) {
         this->setInputMode(ManualControl::InputMode::Digital);
-        this->setDirectionChangeCallback(this->directionChangeSignal);
         this->directionChangeSignal = new DirectionChangeSignal(navigation);
+        this->setDirectionChangeCallback(this->directionChangeSignal);
         this->navigation = navigation;
         this->init();
 }

src/driveModi/Modi/Autopilot/autopilot.h

@@ -76,15 +76,6 @@ class Autopilot : public ManualControl {
          */
         void loop();
 
-        /**
-         * @brief Manges the autopilot
-         * 
-         * If the first Point is near to current location you can turn
-         * the autopilot on.
-         * Gets the course correction and decide what to do.
-         */
-        void runAutopilot();
-
         void restart();
 
         /**
@@ -120,6 +111,7 @@ class Autopilot : public ManualControl {
         void init();
         void drive();
         void rotate();
+        void runAutopilot();
         void checkButtonInput();
         void askNavigationForOrder();
         void selfDriving();