高博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 爲四元數實部。同時

>>阅读原文<<