一. 读取话题时间戳
1. 添加头文件
#include "ros/time.h"
2. 定义变量
ros::Time time1;
3. 将时间戳保存到变量中
先通过话题查看格式:
header:
seq: 278
stamp:
secs: 173
nsecs: 427000000
frame_id: "camera_link"
接着对变量赋值:
void Control::getImuData(const sensor_msgs::ImuConstPtr &msg)
{
time1 = msg-><