added magDec to manualDrive Menu

2023-08-07 23:25:31 +02:00
parent d6bc7e4239
commit ebe4d32523
3 changed files with 18 additions and 4 deletions
@@ -65,6 +65,20 @@ void MenuManualControl::printPage() const {
            lineTwo.concat(this->driveManager->getNavigation()->getAzimuth());
            break;

+        case 8: {
+            UBX_NAV_PVT_data_t* gpsData = this->driveManager->getNavigation()->getUbxData();
+            lineOne = "magDec: ";
+            lineTwo = "magAcc: ";
+            if (gpsData->valid.bits.validMag) {
+                lineOne.concat(gpsData->magDec);
+                lineTwo.concat(gpsData->magAcc);
+            } else {
+                lineOne.concat("invalid");
+                lineTwo.concat("invalid");   
+            }
+            break;
+        }
+
        default:
            this->printDefault();
        return;
@@ -77,7 +91,7 @@ void MenuManualControl::init() {
    this->firstPrint = false;
    this->driveManager->changeModus(Modi::ManualControl);
    this->manualControl = (ManualControl*) this->driveManager->getDriveModiPtr();
-    this->setCountPages(8);
+    this->setCountPages(9);
    this->updateDelay = 500; 
 }