major change in servo_controller