MOTORS

- Motor output should be working with timer interrupt (might need
external timer for more accurate timing)
- Motor Code is now a FSM with 0001-Step1, 0010-Step2, 0100-Step3,
1000-Step4
- BUG1: Keys is still not fixed