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')