-
Notifications
You must be signed in to change notification settings - Fork 0
/
Servo_Example.py
55 lines (47 loc) · 1.48 KB
/
Servo_Example.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
#!/usr/bin/python
from Adafruit_PWM_Servo_Driver import PWM
import time
# ===========================================================================
# Example Code
# ===========================================================================
# Initialise the PWM device using the default address
# bmp = PWM(0x40, debug=True)
pwm = PWM(0x40, debug=True)
servoMin = 150 # Min pulse length out of 4096
servoMax = 600 # Max pulse length out of 4096
def setServoPulse(channel, pulse):
pulseLength = 1000000 # 1,000,000 us per second
pulseLength /= 60 # 60 Hz
print "%d us per period" % pulseLength
pulseLength /= 4096 # 12 bits of resolution
print "%d us per bit" % pulseLength
pulse *= 1000
pulse /= pulseLength
pwm.setPWM(channel, 0, pulse)
pwm.setPWMFreq(60) # Set frequency to 60 Hz
while (True):
# oldcomment Change speed of continuous servo on channel O
pwm.setPWM(0, 0, servoMin)
time.sleep(1)
pwm.setPWM(0, 0, servoMax)
time.sleep(1)
pwm.setPWM(1, 0, servoMin)
time.sleep(1)
pwm.setPWM(1, 0, servoMax)
time.sleep(1)
pwm.setPWM(2, 0, servoMin)
time.sleep(1)
pwm.setPWM(2, 0, servoMax)
time.sleep(1)
pwm.setPWM(6, 0, servoMin)
time.sleep(1)
pwm.setPWM(6, 0, servoMax)
time.sleep(1)
pwm.setPWM(10, 0, servoMin)
time.sleep(1)
pwm.setPWM(10, 0, servoMax)
time.sleep(1)
pwm.setPWM(11, 0, servoMin)
time.sleep(1)
pwm.setPWM(11, 0, servoMax)
time.sleep(1)