Implemented getPos feature
Rearranged order of ADC samples
Changed motors 3,4 to use TIM19
Made setDuty command also take direction