Do the safety dance
Improved PWM motor control