From 11b2c845acb98073fbe53a202ac15bfc3c82fe27 Mon Sep 17 00:00:00 2001
From: marisa <marisa@fwmari.net>
Date: Sun, 29 Oct 2023 20:56:03 -0300
Subject: [PATCH] Add basic controller program

---
 motor_passo/exec/control/__init__.py |  0
 motor_passo/exec/control/__main__.py | 29 ++++++++++++++++++++++++++++
 2 files changed, 29 insertions(+)
 create mode 100644 motor_passo/exec/control/__init__.py
 create mode 100644 motor_passo/exec/control/__main__.py

diff --git a/motor_passo/exec/control/__init__.py b/motor_passo/exec/control/__init__.py
new file mode 100644
index 0000000..e69de29
diff --git a/motor_passo/exec/control/__main__.py b/motor_passo/exec/control/__main__.py
new file mode 100644
index 0000000..9c57145
--- /dev/null
+++ b/motor_passo/exec/control/__main__.py
@@ -0,0 +1,29 @@
+import sys
+
+from motor_passo.motor import Motor
+from motor_passo.encoder import Encoder
+from motor_passo.utils import setup_cleanup, _cleanup
+
+
+def main(args: list):
+    setup_cleanup()
+
+    motor = Motor([13, 19, 26])
+    motor.setup()
+    motor.set_speed(50)
+
+    encoder = Encoder(6, 5)
+    encoder.setup()
+
+    while encoder.angle <= 360:
+        motor.step(-5)
+        print(encoder.angle)
+
+
+if __name__ == "__main__":
+    try:
+        main(sys.argv)
+    except Exception as e:
+        print(str(e))
+    finally:
+        _cleanup()