Start with Capture Route

src/driveModi/driveManager.h

@@ -12,8 +12,16 @@
 #ifndef DRIVE_MANAGER_H
 #define DRIVE_MANAGER_H
 
+//GPS Serial Pins
+#define GPS_RX 17
+#define GPS_TX 16
+#define GPS_BAUD 9600
+
+#include <Arduino.h>
+
 #include "moveControl.h"
 #include "driveModi/driveModi.h"
+#include "navigation.h"
 
 // All Drive Modi
 #include "driveModi/Modi/ManualControl/manualControl.h"
@@ -23,28 +31,31 @@
 #include "driveModi/Modi/TestMode/testMode.h"
 
 enum class Modi {   
-                    Off,
-                    ManualControl,
-                    CaptureRoute,
-                    Autopilot,
-                    ConsolControl,
-                    TestMode
-                };
+    Off,
+    ManualControl,
+    CaptureRoute,
+    Autopilot,
+    ConsolControl,
+    TestMode
+};
 
 class DriveManager {
     public:
         DriveManager(MoveControl *moveControl);
-
         void loop();
-        void runDriveManager();
 
         void nextModus();
         void changeModus(Modi modus);
 
-    private:
-        MoveControl *moveControl;
-        DriveModi *currentModus;
+        Navigation* getNavigation() {return this->navigation;}
+        DriveModi* getDriveModiPtr() { return this->currentModusPtr; }
+        Modi getDriveModi() { return this->currentModus; }
 
+    private:
+        Modi currentModus = Modi::Off;
+        MoveControl *moveControl;
+        DriveModi *currentModusPtr;
+        Navigation* navigation;
 };