test_trajectory_ctrl uses URControllerManager

Small cleanup to ur_controller_manager