Enable FET
Support reading last switch setting
Fixed reading some registers
Stop PWM when programmer attached
Declare the setup_servo_pwm() function