Fixed timer problem with motor PWM and servo/tone