updated for servos

2016-08-15 15:57:18 +01:00
parent f678367dea
commit d74563afc3
3 changed files with 43 additions and 2 deletions
--- a/640servotest.py
+++ b/640servotest.py
@@ -0,0 +1,36 @@
+import time
+from darkwater_640.darkwater_640 import dw_Controller, dw_Servo, dw_Motor
+
+dw = dw_Controller( addr=0x60 )
+s1 = dw.getServo(1)
+s2 = dw.getServo(2)
+
+s1.off()
+s2.off()
+time.sleep(1)
+
+##time.sleep(10)
+print "Set forward - "
+print "Servo 1"
+s1.setPWMmS(2000)
+time.sleep(1)
+print "Servo 2"
+s2.setPWMmS(2000)
+time.sleep(1)
+print "Set neutral - "
+print "Servo 1"
+s1.setPWMmS(1500)
+time.sleep(1)
+print "Servo 2"
+s2.setPWMmS(1500)
+time.sleep(1)
+print "Set reverse - "
+print "Servo 1"
+s1.setPWMmS(1000)
+time.sleep(1)
+print "Servo 2"
+s2.setPWMmS(1000)
+time.sleep(1)
+print "All off"
+s1.off()
+s2.off()