ROS中costmap_converter插件的配置与使用

最新推荐文章于 2025-06-30 14:23:11 发布

原创最新推荐文章于 2025-06-30 14:23:11 发布 · 5.3k 阅读

55 ·

CC 4.0 BY-SA版权

文章标签：

#github

ROS 专栏收录该内容

9 篇文章

订阅专栏

本文介绍了在ROS中使用TEB算法时，如何通过costmap_converter插件优化代价地图的表示方式，以提高局部规划效率。实验了四种不同的转换算法：CostmapToPolygonsDBSMCCH、CostmapToLinesDBSRANSAC、CostmapToLinesDBSMCCH和CostmapToPolygonsDBSConcaveHull，分别用多边形、线段等表示障碍物，并探讨了它们的适用场景和效果。通过配置参数和启动文件，可以调整算法以适应不同需求。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

在学习TEB算法的过程中，作者提供了一个插件用于转换代价地图，原始的代价地图是由栅格地图中单元格组成，用于表示障碍物，但单元格占用的计算资源较大，故采用插件将单元格转换成点，线，多边形表示。

插件激活

rospack plugins --attrib=plugin costmap_converter

配置cfg文件
在导航配置文件下，新建costmap_converter_params.yaml

###########################################################################################
## NOTE: Costmap conversion is experimental. Its purpose is to combine many point        ##
## obstales into clusters, computed in a separate thread in order to improve the overall ## 
## efficiency of local planning. However, the implemented conversion algorithms are in a ##
## very early stage of development. Contributions are welcome!                           ##
###########################################################################################

TebLocalPlannerROS:

  ## Costmap converter plugin   
  # costmap_converter_plugin: "costmap_converter::CostmapToPolygonsDBSMCCH"
  costmap_converter_plugin: "costmap_converter::CostmapToLinesDBSRANSAC"
  #costmap_converter_plugin: "costmap_converter::CostmapToLinesDBSMCCH"
  #costmap_converter_plugin: "costmap_converter::CostmapToPolygonsDBSConcaveHull"
  costmap_converter_spin_thread: True
  costmap_converter_rate: 5
 
 
  ## Configure plugins (namespace move_base/costmap_to_lines or move_base/costmap_to_polygons)
  ## costmap_converter/CostmapToLinesDBSRANSAC, costmap_converter/CostmapToLinesDBSMCCH, costmap_converter/CostmapToPolygonsDBSMCCH
  costmap_converter/CostmapToLinesDBSRANSAC:
    cluster_max_distance: 0.4
    cluster_min_pts: 2
    ransac_inlier_distance: 0.15
    ransac_min_inliers: 10
    ransac_no_iterations: 1500
    ransac_remainig_outliers: 3
    ransac_convert_outlier_pts: True
    ransac_filter_remaining_outlier_pts: False
    convex_hull_min_pt_separation: 0.1

在启动文件中，增加costmap_converter启动项

<!-- Here we load our costmap conversion settings -->
		<rosparam file="$(find teb_local_planner_tutorials)/cfg/diff_drive/costmap_converter_params.yaml" command="load" />

未调用costmap_converter插件

由方格表示障碍物位置
请添加图片描述
修改costmap_converter
通过修改插件调用不同的转换算法

1 调用CostmapToPolygonsDBSMCCH
将其余三个注释，只调用polygon算法
显而易见，用多边形表征障碍物
请添加图片描述

2 调用CostmapToLinesDBSRANSAC
用单线段表示
请添加图片描述
3. 调用CostmapToLinesDBSMCCH
用单线段与栅格组合表示？
这个没搞懂

4. 调用CostmapToPolygonsDBSConcaveHull
这个与第一个的区别？

后续了解原理再补充