-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathtest.py
25 lines (25 loc) · 913 Bytes
/
test.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
import termios,sys,select,tty
from adafruit_servokit import ServoKit
kit = ServoKit(channels=16)
kit.servo[0].set_pulse_width_range(350, 2250)
kit.servo[0].angle = 90
settings = termios.tcgetattr(sys.stdin)
while(1):
tty.setraw(sys.stdin.fileno())
rlist, _, _ = select.select([sys.stdin], [], [], None)
if rlist:
key = sys.stdin.read(1)
else:
key = ''
termios.tcsetattr(sys.stdin, termios.TCSADRAIN, settings)
if key == 'f' and kit.servo[0].angle<180:
print(min(kit.servo[0].angle+3,180))
kit.servo[0].angle = min(kit.servo[0].angle+3,180)
elif key == 'j' and kit.servo[0].angle>0:
print(max(kit.servo[0].angle-3,0))
kit.servo[0].angle = max(kit.servo[0].angle-3,0)
elif key == 'q':
kit.servo[0].angle = None
termios.tcsetattr(sys.stdin, termios.TCSADRAIN, settings)
break
else: kit.servo[0].angle = None