Add basic controller program

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()