通过matlab提取rosbag数据

最近在做AGV导航实验，导航小车是基于ROS实现的，判断小车导航是否运行稳定，可以直接通过rviz直观看出来。但是如何通过数据定性地分析数据，这就需要提取其定位数据，然后通过方差或拟合等数值分析的方法。那首先需要做的就是如何提取数据，matlab是个好工具，用matlab可以提取rosbag中的相关的数据。

代码如下：

% 定义rosbag所在位置
filePath = fullfile('E:\WLL\Desktop\', 'rosbag', '2019_06_29.bag');

%提取bag中消息格式信息
bag=rosbag(filePath)

%选择对应的消息，这里就只选择了nav_msgs/Odometry
Odometry = select(bag,'MessageType','nav_msgs/Odometry');

%提取信息，因为经过实际测试，可能由于Odometry消息包含较多信息，导致readMessages函数运行较慢，因此这里用了两个for循环，目的是让position保持较少数据，防止电脑卡死。共取40000个三维坐标数据，j为几就是几万。将数据保存到A.txt文件夹。
position=zeros(10000,3);
 fp=fopen('A.txt','w');
fo