finished PWM and QEI hardware setup. Needs testing