Skip to content

feat(rmf_nav2_traffic): add opennav_docking DockRobot/UndockRobot dispatch and pre-dock progress holding - #75

Open
arjo129 wants to merge 1 commit into
arjoc/feat/corridor_nav2_gz_demofrom
arjoc/feat/nav2_docking
Open

arjo129 wants to merge 1 commit into
arjoc/feat/corridor_nav2_gz_demofrom
arjoc/feat/nav2_docking

Conversation

@arjo129

@arjo129 arjo129 commented Oct 27, 2026 •

Copy link
Copy Markdown
Member

New feature implementation

This PR adds docking capability to the nav2 adapter.

Implemented feature

Here you can see an end to end demo. The most important thing that you see is that while the robot is docking, it does not free up the space it holds till it is fully docked. We also do not allow replanning of the specific robot till the docking is complete.

my_cut_dock_clip.mp4

Implementation description

We hijack the ActiveInnerGoal to now switch between docking and NavigateToPose. In addition we hijack ProgressTracker, during a dock we do not update progress till the dock is complete.

Some things to note:

  • This approach is very hard-coded. It would make sense to explore ways in which we can provide more flexibility.
  • We need to better handle failures to execute. This is not something that we currently support yet.

GenAI Use

We follow OSRA's policy on GenAI tools

  • I used a GenAI tool in this PR.
  • I did not use GenAI

Generated-by: Gemini 4 Argon

…patch and pre-dock progress holding

Signed-off-by: Arjo Chakravarty <arjoc@intrinsic.ai>
@arjo129
arjo129 added this pull request to stack #55 October 27, 2026 15:12
@mxgrey mxgrey added this to PMC Board Oct 27, 2026
@github-project-automation github-project-automation Bot moved this to Inbox in PMC Board Oct 27, 2026
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

Status: Inbox

Development

Successfully merging this pull request may close these issues.

2 participants