44import time
55import busio
66import board
7+ from digitalio import DigitalInOut , Direction
78from adafruit_pca9685 import PCA9685
89from adafruit_motor import servo
9- from digitalio import DigitalInOut , Direction , Pull
1010
1111i2c = busio .I2C (board .SCL , board .SDA )
1212pca = PCA9685 (i2c , address = 0x68 )
2121servoAngle = [1000 , 630 , 500 , 600 , 240 , 600 , 1000 , 720 ]
2222motionSpeed = 15
2323servos = []
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 ))
2626
2727def servoInitialSet ():
2828 print ("Initialize servos" )
2929 for n in range (8 ):
3030 servos [n ].angle = servoSetInit [n ] / 10
3131
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
3636 else :
3737 print ("Release all servos" )
38- for n in range ( 8 ) :
39- servos [ n ] .angle = None
38+ for ser in servos :
39+ ser .angle = None
4040
4141def servoWrite (num , degrees ):
4242 degrees = min (max (degrees , 0 ), 180 )
@@ -49,10 +49,10 @@ def setAngle(angle, msec):
4949 for val in range (8 ):
5050 target = servoSetInit [val ] - angle [val ]
5151 target = min (max (target , 0 ), 1800 )
52- if ( target != servoAngle [val ]) : # Target != Present
52+ if target != servoAngle [val ]: # Target != Present
5353 step [val ] = (target - servoAngle [val ]) / msec
5454 #print(step)
55- for i in range (msec ):
55+ for _ in range (msec ):
5656 for val in range (8 ):
5757 servoAngle [val ] += step [val ]
5858 #print("setting servo %d to %d" % (val, int(servoAngle[val] / 10)))
@@ -61,8 +61,7 @@ def setAngle(angle, msec):
6161 print (servoAngle )
6262
6363servoInitialSet ()
64- #time.sleep(1)
65- #servoFree()
64+ time .sleep (1 )
6665setAngle ([0 , 0 , - 200 , 0 , 0 , 0 , 0 , 0 ], 500 )
6766setAngle ([0 , 0 , - 1800 , 0 , 0 , 0 , 1800 , 0 ], 500 )
6867setAngle ([900 , 0 , - 1800 , 0 , - 900 , 0 , 1800 , 0 ], 500 )
0 commit comments