added restart to autopilot menu and

disable autopilot by pressing the actionbutton

src/driveModi/Modi/Autopilot/autopilot.h

@@ -76,6 +76,8 @@ class Autopilot : public ManualControl {
          */
         void runAutopilot();
 
+        void restart();
+
         /**
          * @brief Get the Route Info object
          * 
@@ -106,6 +108,7 @@ class Autopilot : public ManualControl {
         bool shouldUpdate();
 
     private:
+        void init();
         void checkNtrip();
         void setSpeedInRelToDistance(double distance);
         void setRotInRelToDistance(int16_t course);