fix bug in route add akku menu begin with akkuread

src/SpecialMenus/Akku/menuAkku.cpp

@@ -50,13 +50,13 @@ void MenuAkku::printMenu() {
     else sprintf(buf, "UNDEF");
 
     if (this->lcd) {
-
-    } else {
         lcd->clear();
         lcd->setCursor(0, 0);
         lcd->printf("Controller: %s", buf);
         lcd->setCursor(0, 1);
         lcd->printf("Main: %u%%", mainBattery);
+    } else {
+        std::cout << "Controller: " << buf << "Main: " << mainBattery << "%" << std::endl;
     }
 }
 
@@ -66,4 +66,4 @@ void MenuAkku::update() {
     }
     this->printMenu();
     this->last_millis = millis();
-}
+}

src/SpecialMenus/Akku/menuAkku.h

@@ -36,4 +36,4 @@ class MenuAkku : public MenuControl {
 
 };
 
-#endif // MENU_AKKU_H
+#endif // MENU_AKKU_H

src/SpecialMenus/GPS/menuGPS.cpp

@@ -129,4 +129,4 @@ void MenuGPS::printPage(uint8_t page) const {
             }
             break;
     }
-}
+}

src/SpecialMenus/driveModi/Autopilot/menuAutopilot.cpp

@@ -71,7 +71,6 @@ void MenuAutopilot::printMenu() {
 
         } else
             std::cout << buf1 << " " << buf2 << std::endl;
-    
 }
 
 void MenuAutopilot::update() {
@@ -91,4 +90,4 @@ void MenuAutopilot::init() {
     this->driveManager->changeModus(Modi::Autopilot);
     this->autopilot = (Autopilot*) this->driveManager->getDriveModiPtr();
     this->routeInfo = this->autopilot->getRouteInfo();
-}
+}

src/SpecialMenus/driveModi/Autopilot/menuAutopilot.h

@@ -27,7 +27,7 @@ class MenuAutopilot : public MenuDriveMode {
         RouteInfo routeInfo;
 
         uint32_t last_millis = 0;
-        uint16_t minDelay = 500;
+        uint16_t minDelay = 1500;
 };
 
-#endif // MENU_AUTOPILOT_DRIVE_H
+#endif // MENU_AUTOPILOT_DRIVE_H

src/main.cpp

@@ -6,19 +6,18 @@
 
 #include "config.h"
 
-
-#include "driveModi/Modi/ManualControl/manualControl.h"
 #include "driveModi/driveManager.h"
 #include "moveControl.h"
 #include "network.h"
 
 #include "menu.h"
 #include "menuAction.h"
-#include "SpecialMenus/PID/menuPidSettings.h"
 #include "SpecialMenus/driveModi/ManualDrive/menuManualDrive.h"
 #include "SpecialMenus/driveModi/CaptureRoute/menuCaptureRoute.h"
 #include "SpecialMenus/driveModi/Autopilot/menuAutopilot.h"
+#include "SpecialMenus/PID/menuPidSettings.h"
 #include "SpecialMenus/GPS/menuGPS.h"
+#include "SpecialMenus/Akku/menuAkku.h"
 
 MoveControl moveController;
 DriveManager driveManager(&moveController);
@@ -69,6 +68,7 @@ void setup() {
     MenuCaptureRoute* cap_m = new MenuCaptureRoute(&driveManager);
     MenuAutopilot* auto_m = new MenuAutopilot(&driveManager);
     MenuGPS* gps_m = new MenuGPS(driveManager.getNavigation()->getGPS());
+    MenuAkku* akku_m = new MenuAkku();
 
     // Set Menus on LCD
     main_m->setLcd(lcd);
@@ -80,6 +80,7 @@ void setup() {
     cap_m->setLcd(lcd);
     auto_m->setLcd(lcd);
     gps_m->setLcd(lcd);
+    akku_m->setLcd(lcd);
 
 
     // Entry for the main menu
@@ -87,9 +88,11 @@ void setup() {
     MenuAction* gps_e = new MenuAction("GPS", gps_m);
     MenuAction* pid_e = new MenuAction("PID", pid_m);
     MenuAction* restart_e = new MenuAction("Restart", restart);
+    MenuAction* akku_e = new MenuAction("Akku", akku_m);
     main_m->addEntry(mode_e);
     main_m->addEntry(gps_e);
     main_m->addEntry(pid_e);
+    main_m->addEntry(akku_e);
     main_m->addEntry(restart_e);
 
     // Entry for the mode Menu
@@ -100,8 +103,8 @@ void setup() {
     MenuAction* testMode_e = new MenuAction("Test Mode", dummy);
     mode_m->addEntry(autopilot_e);
     mode_m->addEntry(captureRoute_e);
-    mode_m->addEntry(consolControl_e);
     mode_m->addEntry(manualControl_e);
+    mode_m->addEntry(consolControl_e);
     mode_m->addEntry(testMode_e);
 
     // Entry for the PID Menu
@@ -143,9 +146,7 @@ void callbackControllerAction() {
         else if (Ps3.data.button.circle)
             main_m->yes();
         else if (Ps3.data.button.cross)
-            main_m->no();   
-        else if (Ps3.data.button.ps)
-            controllerPrintBattery();
+            main_m->no();
 
         isDelayReached(true);        
     }
@@ -162,26 +163,9 @@ void callbackControllerConnect() {
     main_m->printMenu();
 }
 
-void controllerPrintBattery() {
-    static uint8_t controller_battery = -1;
-    if( controller_battery != Ps3.data.status.battery ){
-        controller_battery = Ps3.data.status.battery;
-    }
-
-    Serial.print("The controller battery is ");
-    if( controller_battery == ps3_status_battery_charging )      printf("charging\n");
-    else if( controller_battery == ps3_status_battery_full )     printf("FULL\n");
-    else if( controller_battery == ps3_status_battery_high )     printf("HIGH\n");
-    else if( controller_battery == ps3_status_battery_low)       printf("LOW\n");
-    else if( controller_battery == ps3_status_battery_dying )    printf("DYING\n");
-    else if( controller_battery == ps3_status_battery_shutdown ) printf("SHUTDOWN\n");
-    else printf("UNDEFINED\n");
-}
-
 void i2cScanner() {
     std::cout << "\nI2C Scanner" << std::endl;
 
-
     byte error, address;
     int nDevices;
     Serial.println("Scanning...");
@@ -211,4 +195,4 @@ void i2cScanner() {
 
 void restart() {
     ESP.restart();
-}
+}