先导入了ROS相关的头文件,然后创建了一个sensor_msgs::NavSatFix
类型的消息对象navsat_fix_msg
。接着,我们为该消息对象的各个字段赋值:
navsat_fix_msg.latitude
:设置纬度值。navsat_fix_msg.longitude
:设置经度值。navsat_fix_msg.altitude
:设置海拔值。navsat_fix_msg.position_covariance
:设置协方差矩阵,可以将其设置为0或其他合适的值。navsat_fix_msg.position_covariance_type
:设置协方差类型,可选择的值有sensor_msgs::NavSatFix::COVARIANCE_TYPE_UNKNOWN
、sensor_msgs::NavSatFix::COVARIANCE_TYPE_APPROXIMATED
或sensor_msgs::NavSatFix::COVARIANCE_TYPE_DIAGONAL_KNOWN
。navsat_fix_msg.header.stamp
:设置时间戳,可以使用ros::Time::now