add motors

1 files changed, 29 insertions, 0 deletions

diff --git a/lib/motors/motors.h b/lib/motors/motors.h
new file mode 100644
index 0000000..bcba09c
--- /dev/null
+++ b/lib/motors/motors.h
@@ -0,0 +1,29 @@
+#include <Arduino.h>
+#include "settings.h"
+
+#pragma once
+
+class MOTORS
+{
+public:
+    MOTORS();
+    void init();
+
+    void forward(int speed, int duration = 0);
+    void backward(int speed, int duration = 0);
+
+    void leftForward(int speed, int duration = 0);
+    void leftBackward(int speed, int duration = 0);
+    void rightForward(int speed, int duration = 0);
+    void rightBackward(int speed, int duration = 0);
+
+    void leftTurn(int speed, int duration = 0);
+    void rightTurn(int speed, int duration = 0);
+
+    void leftStop();
+    void rightStop();
+    void stop();
+
+private:
+    int scaleSpeed(int speed);
+};
\ No newline at end of file