use state_error instead of desired_state velocity as suggested by @adolfo-rt