Update servo_controller.ino