costmap_2d简单理解

来源：互联网发布：手机音频格式转换软件编辑：程序博客网时间：2024/06/18 09:23

具体内容见 http://wiki.ros.org/costmap_2d

收集传感器信息用于建立和更新二维或三维的地图。ROS的代价地图（costmap）采用网格（grid）形式，每个网格的值（cell cost）从0~255。分成三种状态：被占用（有障碍）、自由区域（无障碍）、未知区域；

具体状态和值对应有下图：

上图可分为五部分，其中红色多边形区域为机器人的轮廓：

1、“lethal”/“W-space”（致命的）：假如cost_lethal=254,则x>=254时，机器人的中心与网格中心重合，必然与障碍物发生冲突（defintely in collision）；

2、“inscribed”/“C-space”（内接）：假如cost_inscribed =253，则253<=x<254时，网格值小于机器人轮廓的内接半径与实际障碍物距离，也会与障碍物发生冲突（defintely in collision）；（网格的内接圆与机器人轮廓外切或相交？？）

3、“circumscribed”（外接）：假如cost_possibly_circumscribed=128，则128<=x<253时，网格的外接圆与机器人轮廓外切或相交，机器人向障碍物靠近，所以可能与障碍物发生冲突（possibly in collision），取决于方向/定位（orientation）；

4、自由区域：1<=x<128,没有障碍物区域，一定不会发生冲突（defintely not in collision）；

5、未知区域：0<=x<1。

根据离最近的致命障碍物网格的距离划分：

【inscribed radius】内接半径；

【circumscribed radius】外接半径>>两者之间为缓冲区域<<【inflation radius】膨胀半径；

0 0