trajectory_error 依赖 ros eigen sophus 数据格式 [t tx ty tz qx qy qz qw]; 中间是空格 运行 roslaunch trajectory_error trajectory_error.launch RMSE计算 数据文件 trajectory_error.launch 中修改自己的数据文件