Added Servo examples

mithru · mithru · commit 42b9d71d85c2 · 2014-08-19T02:38:01.000+08:00
diff --git a/05.Servos/ServoGetAngle/boot.py b/05.Servos/ServoGetAngle/boot.py
@@ -0,0 +1,2 @@
+import pyb
+
diff --git a/05.Servos/ServoGetAngle/main.py b/05.Servos/ServoGetAngle/main.py
@@ -0,0 +1,19 @@
+servo = pyb.Servo(1) # id can be 1-4 (corresponds to pins X1 - X4)
+
+while True:
+  # generates a random 30-bit number
+  # dividing so we get a smaller number to work with roughly 0 - 200
+  random_angle = pyb.rng() // 5500000
+  
+  # subtracting by 90 to bring range to roughly between -90 and 90
+  # since many common servos have a range between -90 and 90 degrees
+  random_angle -= 90 
+  
+  #set servo's position immediately to random_angle
+  servo.angle(random_angle) # in degrees
+  
+  pyb.delay(500) # wait half a second
+  
+  print(servo.angle()) # prints the servo's current position
+  
+  pyb.delay(500)
diff --git a/05.Servos/ServoSetAngle/boot.py b/05.Servos/ServoSetAngle/boot.py
@@ -0,0 +1,2 @@
+import pyb
+
diff --git a/05.Servos/ServoSetAngle/main.py b/05.Servos/ServoSetAngle/main.py
@@ -0,0 +1,21 @@
+servo = pyb.Servo(1) # id can be 1-4 (corresponds to pins X1 - X4)
+
+while True:
+  
+  #set servo's position immediately
+  servo.angle(90) # in degrees
+  # many common servos have a range between -90 and 90 degrees
+  
+  pyb.delay(500) # wait half a second
+  
+  # change servo position to specified angle 
+  # and take a specified time to reach that angle
+  servo.angle(-90, 2000) # 2000 millis = 2 seconds
+  
+  pyb.delay(3000) # delaying by 3 seconds since it'll take two seconds for the motor to reach its final state
+  
+  # the above statement makes the motor spin to -90 and then move on.
+  # if your motors range does not hold -90, it could stall at this point
+  # run servo.angle() to get your motor's position 
+  
+
