Implement speedometer and encoder

src/moveControl.h

@@ -4,22 +4,25 @@
 #include <cstdint>
 
 #include "motorControl.h"
+#include "speedometer.h"
 
 class MoveControl {
     public:
         MoveControl();
-        void init(MotorControl *left_motor, MotorControl *right_motor);
-        void rotate(int16_t degree);
-        void rotate(int16_t degree, uint8_t radius);
-        void forward();
-        void backward();
-        void setSpeed(uint8_t speed);
+        void init(MotorControl *left_motor, MotorControl *right_motor,
+                    Speedometer *left_encoder, Speedometer *right_encoder);
+        void runMoveControl();
+        void setSpeed(int8_t speed);
+        void setRotationspeed(double speed);
 
     private:
         MotorControl *left_motor;
         MotorControl *right_motor;
+        Speedometer *left_speedometer;
+        Speedometer *right_speedometer;
 
-        uint8_t speed = 0;
+        int8_t speed = 0;
+        double rotation_speed = 0;
 };
 
 #endif // MOVE_CONTROL_H