高博SLAM基础课第三次作业——轨迹绘图计算误差

作业描述 我为你准备了一个轨迹文件(code/trajectory.txt)。该文件的每一行由若干个数据组成,格式为 [t, t x , t y , t z , q x , q y , q z , q w ], 其中 t 为时间,t x , t y , t z 为 T W C 的平移部分,q x , q y , q z , q w 是四元数表示的 T W C 的旋转部分,q w 为四元数实部。同时

>>阅读原文<<