Getting descriptive outcomes from ExePathAction [closed]
I am trying to design some recovery behaviors for a bot following a set of waypoints, with velocities issued by TEB. I am using ExePathAction to start the navigation with TEB.
I would like to know when the path is blocked (BLOCKED_PATH = 109) in order to trigger either a GetPathAction until the next waypoint, or maybe some other recovery behaviour.
Are the descriptive outcomes + messages already implemented in MBF? Or do these descriptive outcomes have to be implemented in the controller (in this case: TEBLocalPlannerROS)? Or should it be implemented by extending some function of the controller_action or abstract_controller_execution?
Thank you for your time, any help will be appreciated! :)