Switch to timer2. Interrupt priority to pwm handler
Move programSelector switch logic to separate file
Ready for PID tunings
PI tunings on empty shaft good enough