Add motor PWM testing code