Skip to content

Conversation

@jpcastillo26
Copy link

Priorities definition

🟡 PRIORITY_MEDIUM:
Affects operation but has a temporary workaround. Should be fixed in the next release. May impact reputation or departmental data.


🚀 Basic Info

Main Goal: Implement partial path planning for compute_path_through_poses action to allow robots to navigate to the last reachable pose when obstacles block later goals in a multi-waypoint navigation sequence.

closes


Summary of Changes

  • Added allow_partial_paths boolean field to ComputePathThroughPoses.action goal definition
  • Modified planner_server.cpp to handle planning failures gracefully with partial path support
  • Updated compute_path_through_poses_action.cpp to read and pass the new allow_partial_paths parameter
  • Added allow_partial_paths input port to behavior tree action node in compute_path_through_poses_action.hpp
  • Updated behavior tree XML files to enable partial path planning by default
  • Implemented exception handling around getPlan() calls to catch NoValidPathCouldBeFound exceptions
  • Added logic to break out of planning loop and return partial path when later goals are unreachable

📚 Docs Updated

  • N/A

- Introduced a new input port 'allow_partial_paths' to enable partial path planning when obstacles block later goals.
- Modified the action definition to include the new parameter.
@jpcastillo26 jpcastillo26 requested a review from pepisg October 3, 2025 00:12
@jpcastillo26 jpcastillo26 self-assigned this Oct 3, 2025
@jpcastillo26 jpcastillo26 added the enhancement New feature or request label Oct 3, 2025
@jpcastillo26 jpcastillo26 changed the title Feat/partial path planning [PLANNER_SERVER] Path planning until last reachable pose Oct 3, 2025
@pepisg pepisg merged commit bb153e0 into kiwi-main Oct 9, 2025
2 of 5 checks passed
Sunart24 pushed a commit that referenced this pull request Oct 15, 2025
* Add support for partial path planning in ComputePathThroughPoses action

- Introduced a new input port 'allow_partial_paths' to enable partial path planning when obstacles block later goals.
- Modified the action definition to include the new parameter.

* Remove unnecessary logic and debug logs

* [PLANNER_SERVER][COMPUTE_PATH_THROUGH_POSES][FEAT] Return blocked poses in response
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

enhancement New feature or request

Projects

None yet

Development

Successfully merging this pull request may close these issues.

3 participants