Added set_speed service to servo controller