- added calc azimuth to autopilot menu

- getters in navigation for calc azimuth
- wrapper for manualControl for automatic orintaion change

src/SpecialMenus/driveModi/Autopilot/menuAutopilot.cpp

@@ -166,10 +166,41 @@ void MenuAutopilot::printPage() const {
                 lineTwo = "accuracy is low";
             break;
 
-        default:
-            this->printDefault();
-            return;
-    }
+        case 11:
+            lineOne = "CalcAzi: ";
+            lineTwo = "State: ";
+            lineOne.concat(this->driveManager->getNavigation()->getCalcAzimuth());
+            switch (this->driveManager->getNavigation()->getCalcAzimuthState()) {
+                case Navigation::CalcAzimuthState::Bad :
+                    lineTwo.concat("Bad");
+                    break;
+                
+                case Navigation::CalcAzimuthState::Good :
+                    lineTwo.concat("Good");
+                    break;
+
+                case Navigation::CalcAzimuthState::Invalid :
+                    lineTwo.concat("Invalid");
+                    break;
+
+                case Navigation::CalcAzimuthState::Ok :
+                    lineTwo.concat("Ok");
+                    break;
+
+                case Navigation::CalcAzimuthState::Super :
+                    lineTwo.concat("Super");
+                    break;
+
+                default:
+                    lineTwo.concat("Unkown");
+                    break;
+            }
+            break;
+
+            default:
+                this->printDefault();
+                return;
+            }
 
     this->print(lineOne, lineTwo);
 }
@@ -219,7 +250,7 @@ void MenuAutopilot::update() {
 }
 
 void MenuAutopilot::init() {
-    this->setCountPages(11);
+    this->setCountPages(12);
     this->driveManager->changeModus(Modi::Autopilot);
     this->autopilot = (Autopilot*) this->driveManager->getDriveModiPtr();
     this->routeInfo = this->autopilot->getRouteInfo();