how to integrate Velodyne-16 with costmap_2d for costmap clearing

asked 2016-07-19 14:29:44 -0500

hardy gravatar image

Hi Everyone , I am working on integrating the 16 channel velodyne puck for obtacle avoidance with ros navigation stack. I am having issues with costmap clearance. Please find below the globalcostmap.yaml file that i am using to integrate the velodyne .

global_costmap: #Set the global and robot frames for the costmap global_frame: /map robot_base_frame: base_link

#Set the update and publish frequency of the costmap update_frequency: 5.0 publish_frequency: 5.0

#We'll use a map served by the map_server to initialize this costmap static_map: true rolling_window: false

use_dijkstra: false

inflation_radius: 0.55

plugins: - {name: static_layer, type: "costmap_2d::StaticLayer"} - {name: obstacle_layer2, type: "costmap_2d::ObstacleLayer"} - {name: inflation_layer, type: "costmap_2d::InflationLayer"}

#Configuration for the sensors that the costmap will use to update a map obstacle_layer2: observation_sources: VLP_sensor VLP_sensor: {data_type: PointCloud2, sensor_frame: /velodyne, topic: /velodyne_points_filtered, expected_update_rate: 0.4, observation_persistence: 0.0, marking: true, clearing: true, max_obstacle_height: 1.3, min_obstacle_height: 0.04}

So, I am having a specific issue of costmap clearing. Since, the velodyne has a 30 degree vertical field of view. As my robot moves close to the object, small objects which are initially in the field of view of the velodyne move out of the field of view. Hence, the costmap_2d is cleared and the robot goes over the object which is not desired.

So, if somebody can help me figure out how to avoid such a scenario and integrate this velodyne as a 3D lidar in a 2D map for obstacle avoidance.

edit retag flag offensive close merge delete

Comments

Similar issues happen with almost any sensor. One does not normally clear objects not in the field of view. That sometimes leaves ghost objects in the map, but navigation will generally clear them if it gets stuck.

joq gravatar image joq  ( 2016-09-21 11:06:43 -0500 )edit