摘要： geometry_msgs::Quaternion orientation = map->info.origin.orientation; tf::Matrix3x3 mat(tf::Quaternion(orientation.x, orientation.y, orientation.z, or 阅读全文