ros中计算地图坐标,rosweb计算画布对应的坐标
视频讲解:
SLAM无人车计算地图坐标,图片像素坐标公式推导
1.订阅话题 /map
nav_msgs::OccupancyGrid 这个消息中可以获得地图信息
nav_msgs::OccupancyGrid msg
x = msg.info.origin.position.x;//原点位置 x
y = msg.info.origin.position.y;//原点位置 y
z = msg.info.origin.position.z;//原点位置 z
qx = msg.info.origin.orientation.x;//原点姿态 x
qy = msg.info.origin