Brake function added

IngeniumTeam · Feb 17, 2024 · 79cd4fe · 79cd4fe
1 parent 446b6ca
commit 79cd4fe
Show file tree

Hide file tree

Showing 3 changed files with 9 additions and 1 deletion.
diff --git a/src/Mecanum.cpp b/src/Mecanum.cpp
@@ -51,6 +51,14 @@ void Mecanum::stop()
     motors[Right][Back].stop();
 }
 
+void Mecanum::brake()
+{
+    motors[Left][Front].brake();
+    motors[Left][Back].brake();
+    motors[Right][Front].brake();
+    motors[Right][Back].brake();
+}
+
 void Mecanum::sideway(int speed)
 {
     if (speed > 0)

diff --git a/src/Mecanum.h b/src/Mecanum.h
@@ -18,6 +18,7 @@ class Mecanum
 	void backward(int speed);
 	void move(int speed);
 	void stop();
+	void brake();
 	void sideway(int speed);
 	void sidewayLeft(int speed);
 	void sidewayRight(int speed);

diff --git a/src/Mecaside.h b/src/Mecaside.h
@@ -20,7 +20,6 @@ class Mecaside
     }
     void move(int speed)
     {
-        Serial.println(speed);
         if (speed > 0)
             forward(speed);
         if (speed == 0)