4
4
import time
5
5
import busio
6
6
import board
7
+ from digitalio import DigitalInOut , Direction
7
8
from adafruit_pca9685 import PCA9685
8
9
from adafruit_motor import servo
9
- from digitalio import DigitalInOut , Direction , Pull
10
10
11
11
i2c = busio .I2C (board .SCL , board .SDA )
12
12
pca = PCA9685 (i2c , address = 0x68 )
21
21
servoAngle = [1000 , 630 , 500 , 600 , 240 , 600 , 1000 , 720 ]
22
22
motionSpeed = 15
23
23
servos = []
24
- for n in range (8 ):
25
- servos .append (servo .Servo (pca .channels [n ], min_pulse = 800 , max_pulse = 2200 ))
24
+ for s in range (8 ):
25
+ servos .append (servo .Servo (pca .channels [s ], min_pulse = 800 , max_pulse = 2200 ))
26
26
27
27
def servoInitialSet ():
28
28
print ("Initialize servos" )
29
29
for n in range (8 ):
30
30
servos [n ].angle = servoSetInit [n ] / 10
31
31
32
- def servoFree (n = None ):
33
- if n :
34
- print ("Release servo #" , n )
35
- servos [n ].angle = None
32
+ def servoFree (serv = None ):
33
+ if serv :
34
+ print ("Release servo #" , serv )
35
+ servos [serv ].angle = None
36
36
else :
37
37
print ("Release all servos" )
38
- for n in range ( 8 ) :
39
- servos [ n ] .angle = None
38
+ for ser in servos :
39
+ ser .angle = None
40
40
41
41
def servoWrite (num , degrees ):
42
42
degrees = min (max (degrees , 0 ), 180 )
@@ -49,10 +49,10 @@ def setAngle(angle, msec):
49
49
for val in range (8 ):
50
50
target = servoSetInit [val ] - angle [val ]
51
51
target = min (max (target , 0 ), 1800 )
52
- if ( target != servoAngle [val ]) : # Target != Present
52
+ if target != servoAngle [val ]: # Target != Present
53
53
step [val ] = (target - servoAngle [val ]) / msec
54
54
#print(step)
55
- for i in range (msec ):
55
+ for _ in range (msec ):
56
56
for val in range (8 ):
57
57
servoAngle [val ] += step [val ]
58
58
#print("setting servo %d to %d" % (val, int(servoAngle[val] / 10)))
@@ -61,8 +61,7 @@ def setAngle(angle, msec):
61
61
print (servoAngle )
62
62
63
63
servoInitialSet ()
64
- #time.sleep(1)
65
- #servoFree()
64
+ time .sleep (1 )
66
65
setAngle ([0 , 0 , - 200 , 0 , 0 , 0 , 0 , 0 ], 500 )
67
66
setAngle ([0 , 0 , - 1800 , 0 , 0 , 0 , 1800 , 0 ], 500 )
68
67
setAngle ([900 , 0 , - 1800 , 0 , - 900 , 0 , 1800 , 0 ], 500 )
0 commit comments