63 lines
1.2 KiB
Python
63 lines
1.2 KiB
Python
import serial
|
|
from time import sleep
|
|
|
|
move1 = [
|
|
b'D1\n',
|
|
b'S1\n',
|
|
b'L95\n',
|
|
b'T75\n',
|
|
b'R118\n',
|
|
b'G185\n',
|
|
b'R90\n',
|
|
# b'D1\n',
|
|
b'L110\n',
|
|
b'T160\n',
|
|
b'R115\n',
|
|
b'L95\n',
|
|
b'G90\n',
|
|
]
|
|
move2 = [
|
|
b'D1\n',
|
|
b'S1\n',
|
|
b'L95\n',
|
|
b'T160\n',
|
|
b'R115\n',
|
|
b'G185\n',
|
|
b'R90\n',
|
|
# b'D1\n',
|
|
b'L110\n',
|
|
b'T75\n',
|
|
b'R118\n',
|
|
b'L95\n',
|
|
b'G90\n',
|
|
]
|
|
|
|
if __name__ == '__main__':
|
|
with serial.Serial('/dev/ttyACM0', 9600, timeout=1) as ser:
|
|
for cmd in move1:
|
|
while(1):
|
|
line = ser.readline()
|
|
print(line)
|
|
if(line == b'READY\r\n'):
|
|
break
|
|
ser.write(cmd)
|
|
sleep(1)
|
|
|
|
sleep(5)
|
|
ser.write(b'D1\n')
|
|
sleep(5)
|
|
|
|
for cmd in move2:
|
|
while(1):
|
|
line = ser.readline()
|
|
print(line)
|
|
if(line == b'READY\r\n'):
|
|
break
|
|
ser.write(cmd)
|
|
sleep(1)
|
|
|
|
sleep(5)
|
|
ser.write(b'D1\n')
|
|
|
|
|