ros中订阅/map话题,获取地图尺寸,获取机器人原点position,获取地图分辨率resolution
1.
#include <ros/ros.h>
#include <nav_msgs/OccupancyGrid.h>
//订阅地图
void callBack_map(nav_msgs::OccupancyGrid msg){
cout<<"原点位置 x: "<<to_string(msg.info.origin.position.x)<<endl;
cout<<"原点位置 y: "<<to_string(msg.info.origin.position.y)<<endl;
cout<<"原点位置 z: "<<to_string(msg.info.origin.position.z)<<endl;
cout<<"原点姿态 qx: "<<to_string(msg.info.origin.orientation.x)<<endl;
cout<<"原点姿态 qy: "<<to_string(msg.info.origin.orientation.y)<<endl;
cout<<"原点姿态 qz: "<<to_string(msg.info.origin.orientation.z)<<endl;
cout<<"原点姿态 qw: "<<to_string(msg.info.origin.orientation.w)<<endl;
cout<<"地图分辨率 f: "<<to_string(msg.info.resolution)<<endl;
cout<&
本文内容由网友自发贡献,版权归原作者所有,本站不承担相应法律责任。如您发现有涉嫌抄袭侵权的内容,请联系:hwhale#tublm.com(使用前将#替换为@)