Update servo_relay.c