Added consolControl & PID

src/driveModi/consolControl.h

@@ -0,0 +1,24 @@
+#ifndef CONSOL_CONTROL_H
+#define CONSOL_CONTROL_H
+
+#include "moveControl.h"
+#include "debugMqtt.h"
+
+class ConsolControl {
+    public:
+        ConsolControl();
+        void init(MoveControl *moveControl);
+        void run();
+
+    private:
+        void printManual();
+
+        MoveControl *moveControl;
+        DebugMqtt *debug;
+        PID *left_pid;
+        PID *right_pid;
+
+
+};
+
+#endif // CONSOL_CONTROL_H