ROS中的map

ROS的map和costmap使用nav_msgs::OccupancyGrid消息类型,数据存储在data数组中,按像素点顺序排列。map的data包含0(空白)、100(障碍物)、-1(未知),而costmap的data则包含0、100、99、1-98(距离障碍物的代价)和-1(未知)。实际应用中,1-99被视为无障碍物。
摘要由CSDN通过智能技术生成
map与costmap都是以nav_msgs::OccupancyGrid类型发布其topic。其中整张地图的障碍物信息存放在data数据成员中,data是一个int8类型的vector向量,即一维数组。假设一张pgm的map地图,宽:width,高:height,单位为像素,分辨路为resolution,左下角像素点在世界坐标系下的位置为:(ox,oy),单位米,那么世界坐标系下一点(x,y)单位米,假设其在地图中,那么该点对应的data中的索引index为:

index = (x-ox)/resolution+(y-oy)/resolution*width

评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值