Repository navigation
NavMap maps manager: local NavMap around the robot - #120
Merged
Merged
Conversation
Fixes #119 - Local mode (local.* parameters): the maps manager keeps a NavMap around the robot, in its frame, rebuilt at local.freq from the point perceptions in NavState (accumulated in odom over local.accumulate_time, cropped to the window and meshed with navmap_ros::from_points). Each rebuild is published and replaces the map in NavState. - A new map (received or rebuilt) now replaces the one in NavState; before, only the first one ever got there. - ObstacleFilter works in the NavMap's own frame, not always in map. - InflationFilter skips an empty NavMap instead of logging an error. Signed-off-by: Francisco Martín Rico <fmrico@gmail.com>
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.
Fixes #119
With
<plugin>.local.enabled, the NavMap maps manager keeps a NavMap around the robot, in its frame, rebuilt continuously from the point perceptions in NavState. Each rebuild:odomoverlocal.accumulate_time(a single 3D scan is sparse rings);local.range,local.min_z/max_z) inlocal.frameand voxelizes them;navmap_ros::from_points(local.resolution,max_dz,max_slope_deg,min_clearance,min_surface_area,max_hole_area);<plugin>/mapand puts it in NavState, where the filters run on it as usual.Grabacion.de.pantalla.desde.2026-10-15.12-59-24.mp4
The parameters are documented in the package README.
Fixes found on the way
incoming_occ_map/incoming_pc2_mapwas published but never used.map.Validation
Summit XL in the URJC excavation (launch in EasyNavigation/easynav_playgrounds, separate PR), headless, driving 15 s with
/cmd_vel:local.freq: 2), always inbase_footprint, following the robot.Tests
navmap_local_mode_tests):odom→ robot transform.