h3n3/darkwater_python_escape
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

servo test code

Browse Source
This commit is contained in:
shrkey
2016-08-15 21:26:32 +01:00
parent 165df70901
commit cc4da18879
1 changed files with 79 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

82
escapeservotest.py
View File

@@ -1,7 +1,83 @@
import time
from darkwater_escape.darkwater_escape import dw_Controller, dw_Servo, dw_Motor
dw = dw_PWMCONTROL( addr=0x61 )
s = dw.getSERVO(1)
dw = dw_Controller( addr=0x61 )
s1 = dw.getServo(1)
s2 = dw.getServo(2)
s3 = dw.getServo(3)
s4 = dw.getServo(4)
s5 = dw.getServo(5)
s6 = dw.getServo(6)
s.off();
s1.off()
s2.off()
s3.off()
s4.off()
s5.off()
s6.off()
time.sleep(1)
print "Set 2000uS - "
print "Servo 1"
s1.setPWMuS(2000)
time.sleep(1)
print "Servo 2"
s2.setPWMuS(2000)
time.sleep(1)
print "Servo 3"
s3.setPWMuS(2000)
time.sleep(1)
print "Servo 4"
s4.setPWMuS(2000)
time.sleep(1)
print "Servo 5"
s5.setPWMuS(2000)
time.sleep(1)
print "Servo 6"
s6.setPWMuS(2000)
time.sleep(1)
print "Set 1500uS - "
print "Servo 1"
s1.setPWMuS(1500)
time.sleep(1)
print "Servo 2"
s2.setPWMuS(1500)
time.sleep(1)
print "Servo 3"
s3.setPWMuS(1500)
time.sleep(1)
print "Servo 4"
s4.setPWMuS(1500)
time.sleep(1)
print "Servo 5"
s5.setPWMuS(1500)
time.sleep(1)
print "Servo 6"
s6.setPWMuS(1500)
time.sleep(1)
print "Set 1000uS - "
print "Servo 1"
s1.setPWMuS(1000)
time.sleep(1)
print "Servo 2"
s2.setPWMuS(1000)
time.sleep(1)
print "Servo 3"
s3.setPWMuS(1000)
time.sleep(1)
print "Servo 4"
s4.setPWMuS(1000)
time.sleep(1)
print "Servo 5"
s5.setPWMuS(1000)
time.sleep(1)
print "Servo 6"
s6.setPWMuS(1000)
time.sleep(1)
print "All off"
s1.off()
s2.off()
s3.off()
s4.off()
s5.off()
s6.off()