refactore and fixes

first route successfully absolved

src/SpecialMenus/driveModi/Autopilot/menuAutopilot.cpp

@@ -66,6 +66,10 @@ void MenuAutopilot::printPage() const {
                     lineTwo = "Autopilot active";
                     break;
 
+                case Autopilot::State::SelfDrivingRotate :
+                    lineTwo = "Rotating";
+                    break;
+
                 case Autopilot::State::TargetReached :
                     lineTwo = "Target reached";
                     break;
@@ -204,17 +208,17 @@ void MenuAutopilot::printPage() const {
 
         case 13:
             lineOne = "Test rotate";
-            lineTwo = "45 degree";
+            lineTwo = "270 degree";
             break;
 
         case 14:
             lineOne = "Test rotate";
-            lineTwo = "15 degree";
+            lineTwo = "45 degree";
             break;
 
         case 15:
             lineOne = "Test rotate";
-            lineTwo = "5 degree";
+            lineTwo = "20 degree";
             break;
 
         default:
@@ -257,19 +261,19 @@ void MenuAutopilot::runCommand() const {
             break;
 
         case 12:
-            this->autopilot->rotate(180);
+            this->autopilot->testRotate(180);
             break;
 
         case 13:
-            this->autopilot->rotate(45);
+            this->autopilot->testRotate(270);
             break;
 
         case 14:
-            this->autopilot->rotate(15);
+            this->autopilot->testRotate(45);
             break;
 
         case 15:
-            this->autopilot->rotate(5);
+            this->autopilot->testRotate(20);
             break;
         
         default: