from A4988 import A4988
from time import sleep
from machine import Pin
direct = Pin(16, Pin.OUT)
step = Pin(15, Pin.OUT)
motor_driver = A4988(direct, step)

motor_driver.set_ms_mode(A4988.MS_FULL_STEP)
while True:
    command = input ("> ")
    command_parts = command.split(" ")
    if command == 'help':
        print("move_sync [steps] [speed=1000.0]")
    if len(command_parts) >= 2:
        if command_parts[1] == '1':
            motor_driver.set_direction(int(command_parts[2]))
            motor_driver.move_steps(int(command_parts[1]))
        elif command_parts[0] == 'A':
            motor_driver.move_to_angle(int(command_parts[1]))
    else:
        print('Invalid Command')