Repository navigation
golem_slam: the local costmap's footprint follows the arms - #13
Merged
Merged
Conversation
dynamic_footprint publishes the local costmap's footprint (Humble's geometry_msgs/Polygon on /local_costmap/footprint) at 5 Hz: the convex hull of nav2.yaml's local footprint (the body, never shrunk) and the padded collision boxes of pipeline.yaml's footprint.arm_links, posed by TF. During a /frame_task or /named_config goal, and while an arm link has no fresh TF, it is the body alone, so a hand reaching for a handle does not stop the base. The global costmap keeps the fixed footprint. The H1-2's body footprint's front edge moves from 0.20 m to 0.45 m. Checked in the RoboCasa sims: tests/sim/test_sim_stack.sh --h12 and --g1 pass 14/14; the H1-2's footprint is 0.52 m2 at home and 0.94 m2 in T-pose, the G1's 0.31 m2 (its body box) at home and 0.68 m2 in T-pose. Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com> Claude-Session: https://claude.ai/code/session_015EG7p8sgY1ZVi6unbbLp4J
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
Add this suggestion to a batch that can be applied as a single commit.This suggestion is invalid because no changes were made to the code.Suggestions cannot be applied while the pull request is closed.Suggestions cannot be applied while viewing a subset of changes.Only one suggestion per line can be applied in a batch.Add this suggestion to a batch that can be applied as a single commit.Applying suggestions on deleted lines is not supported.You must change the existing code in this line in order to create a valid suggestion.Outdated suggestions cannot be applied.This suggestion has been applied or marked resolved.Suggestions cannot be applied from pending reviews.Suggestions cannot be applied on multi-line comments.Suggestions cannot be applied while the pull request is queued to merge.Suggestion cannot be applied right now. Please check back later.
What
golem_slam/dynamic_footprint: it publishes the local costmap's footprint at 5 Hz. The footprint is the convex hull of the body polygon (nav2.yaml's localfootprint) and the padded collision boxes of the arm links, as TF places them. It never shrinks below the body polygon.pipeline.yamlfootprint.arm_links, withfootprint.padding0.05 m.geometry_msgs/Polygonon/local_costmap/footprint, the type Humble's costmap subscribes to./frame_taskor/named_configgoal is accepted, executing or cancelling, so a hand reaching for a handle or counter doesn't read as a collision and stop the base;base_footprint).Testing
golem_slamunit tests: 67 passed, including the newtest_dynamic_footprint.pyand the updated launch tests.tests/sim/test_sim_stack.sh --h12: 14/14.tests/sim/test_sim_stack.sh --g1: 14/14 (walking to a Nav2 goal while doingt_pose→home)./local_costmap/published_footprintfollowed every change):homeTo note
The H1-2's forearms at
homereach past the body box, so its footprint at rest is about 45% larger than the box. Reducefootprint.paddingor drop the elbows fromarm_linksif that is too conservative.🤖 Generated with Claude Code
https://claude.ai/code/session_015EG7p8sgY1ZVi6unbbLp4J