Winkelerkennung

AutonomousMode/ControlModule/control_module.cpp

@@ -1,9 +1,29 @@
 #include "control_module.h"
 
-ControlModule::ControlModule(/* args */)
+ControlModule::ControlModule(){    
+}
+
+ControlModule::ControlModule(float forwardSpeed, float rotateSpeed, float moveSideSpeed)
 {
+    this->forwardSpeed = forwardSpeed;
+    this->rotateSpeed = rotateSpeed;
+    this->moveSideSpeed = moveSideSpeed;
 }
 
 ControlModule::~ControlModule()
 {
+}
+
+void ControlModule::moveForward(){
+    for(int i = 0; motors; i++){
+
+    }
+};
+
+void ControlModule::moveSide(){
+
+}
+
+void ControlModule::rotate(){
+
 }

AutonomousMode/ControlModule/control_module.h

@@ -3,9 +3,15 @@
 class ControlModule
 {
 private:
-    /* data */
+    float motors[4]; //LeftFront; RightFront; LeftBack; RightBack
+    float forwardSpeed;
+    float rotateSpeed;
+    float moveSideSpeed;
 public:
     ControlModule(/* args */);
-
+    ControlModule(float forwardSpeed, float rotateSpeed, float moveSideSpeed);
     ~ControlModule();
+    void moveForward();
+    void rotate();
+    void moveSide();
 };