Merge multiple static_layer costmaps in Foxy

asked 2021-11-26 10:54:40 -0500

PatoInso gravatar image

updated 2021-11-29 15:26:43 -0500

Hello,

I'm trying to define keepout zones in ROS2 Foxy. The idea was to draw the keepout zones manually as obstacles on a PNG map, publish this map with a map_server, and use it in a static_layer plugin of the global_costmap to generate high cost area on the keepout zones (the same as here in ROS1).

But the final published costmap corresponds to only one of the static map, and not a merging/stacking of the two. In rviz both maps can be visualized correctly (when displaing the Maps published by the map servers).

Here is my configuration of the global_cosmap:

global_costmap:
  global_costmap:
    ros__parameters:
      update_frequency: 1.0
      publish_frequency: 1.0
      global_frame: map
      robot_base_frame: base_link
      map_topic: ""
      use_sim_time: false
      footprint: "[ [-0.48, -0.29], [0.46, -0.29], [0.46, 0.29], [-0.48, 0.29] ]" 
      footprint_padding: 0.02
      resolution: 0.05
      track_unknown_space: true        
      always_send_full_costmap: true
      use_maximum: true           # Tried to play with this param, also trying at the level of the static_layers
      plugins: ["static_layer", "keepout_layer", "obstacle_layer", "inflation_layer"] 
      static_layer:
        plugin: "nav2_costmap_2d::StaticLayer"
        map_topic: /map
      keepout_layer:
        plugin: "nav2_costmap_2d::StaticLayer"    # The second static_layer
        map_topic: /map_keepout_layer             # Published by a dedicated map_server
      obstacle_layer:
        plugin: "nav2_costmap_2d::ObstacleLayer"
        observation_sources: scan
        scan:
          topic: /scan
          data_type: "LaserScan"
          clearing: true                
          marking: true               
          inf_is_valid: true            
          obstacle_range: 4.0           
          raytrace_range: 4.5           
          max_obstacle_height: 2.0    
      inflation_layer:
        plugin: "nav2_costmap_2d::InflationLayer"
        cost_scaling_factor: 5.0
        inflation_radius: 0.6   

  global_costmap_client:
    ros__parameters:
      use_sim_time: false
  global_costmap_rclcpp_node:
    ros__parameters:
      use_sim_time: false

Am I missing something in the configuration for ROS2, or do you see any issue ?

NB1: I made sure to apply 'use_maximum' as suggested here (again for ROS1), both at the global_costmap node level and static_layers plugins levels.

NB2: Also when my ros stack starts, I briefly see that the costmap corresponds one map (my keepout map), then few second later, it is overriden by the costmap corresponding to the environment (maybe one is loaded faster than the other, but the last map loaded overrides the first one in the costmap).

Thanks for your insights,

edit retag flag offensive close merge delete