IMO, if the controller is incapable of handling the global plan, it should reject the global plan, not alter it to its liking. This filter_plan call does exactly that. I think we should just check it, and return REJECTED if it does not satisfy the controller's constraints to the global plan.
IMO, if the controller is incapable of handling the global plan, it should reject the global plan, not alter it to its liking. This
filter_plan
call does exactly that. I think we should just check it, and returnREJECTED
if it does not satisfy the controller's constraints to the global plan.https://github.com/nobleo/path_tracking_pid/blob/61c6cc828bd98dddd8cc14cbabdd62353a89ad3c/src/controller.cpp#L183-L188