add pwm test to servo.c