Initial commit

2022-03-15 22:44:03 +02:00
commit dc7b625ab0
3 changed files with 75 additions and 0 deletions
--- a/modules/main.py
+++ b/modules/main.py
@@ -0,0 +1,29 @@
+from utime import  sleep_ms
+from machine import Pin, PWM
+
+class ServoMotor():
+    def __init__(self, pin):
+        self.pwm = PWM(Pin(pin), freq=50, duty=0)
+        self.prev = 0
+
+    def set(self, speed):
+        if self.prev == speed:
+            # Prevent jerkiness
+            return
+        self.prev = speed
+        if speed == 0:
+            self.pwm.duty(0)
+        else:
+            self.pwm.duty(int(33 + speed * 66 / 100))
+        print(self.pwm, 33 + speed * 66 / 100)
+
+left_motor = ServoMotor(13)
+right_motor = ServoMotor(15)
+
+while True:
+    left_motor.set(100)
+    right_motor.set(0)
+    sleep_ms(500)
+    left_motor.set(0)
+    right_motor.set(100)
+    sleep_ms(500)