-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathneck_motor_test.py
60 lines (55 loc) · 1.29 KB
/
neck_motor_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
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
54
55
56
57
58
59
60
from servo_motor import ServoMotor
servoLR = ServoMotor(18)
servoUD = ServoMotor(19)
servoLR.setAngle(90)
servoUD.setAngle(90)
cmd_menu = '''
fl: face left
fr: face right
ff: face forward
fu: face up
fd: face down
flu: face left upward
fru: face right upward
fld: face left down
frd: face right down
>> '''
while True:
cmd = input(cmd_menu)
print(cmd)
# face left
if cmd == 'fl':
servoLR.setAngle(120)
servoUD.setAngle(90)
# face right
elif cmd == 'fr':
servoLR.setAngle(60)
servoUD.setAngle(90)
# face forward
elif cmd == 'ff':
servoLR.setAngle(90)
servoUD.setAngle(90)
# face up
elif cmd == 'fu':
servoLR.setAngle(90)
servoUD.setAngle(60)
# face down
elif cmd == 'fd':
servoLR.setAngle(90)
servoUD.setAngle(120)
# face left upward
elif cmd == 'flu':
servoLR.setAngle(120)
servoUD.setAngle(60)
# face right upward
elif cmd == 'fru':
servoLR.setAngle(60)
servoUD.setAngle(60)
# face left down
elif cmd == 'fld':
servoLR.setAngle(120)
servoUD.setAngle(120)
# face right down
elif cmd == 'frd':
servoLR.setAngle(60)
servoUD.setAngle(120)