Skip to content
Snippets Groups Projects
hand_controller.py 655 B
from comms_wrapper import Arduino, Key

def main():
    arduino = Arduino("Hand motor controller Arduino", "/dev/ttyACM0", 115200)
    key = Key()

    fwd_keys = ["1", "2", "3", "4", "5", "6", "7", "8", "9"]
    rev_keys = ["q", "w", "e", "r", "t", "y", "u", "i", "o"]
    while 1:
        motor_command = []
        for i in range(9):
            if key.keyPress == fwd_keys[i]:
                motor_command.append("1")
            elif key.keyPress == rev_keys[i]:
                motor_command.append("-1")
            else:
                motor_command.append("0")

        arduino.send_message(motor_command)

if __name__ == "__main__":
    main()