KITTI データセットの理解 オドメトリ座標系変換

元のデータの Tr は、Velodyne 座標系から P0 カメラへの変換を表します。

Tr=A^{P_0}_{ベール}

GroundTruth ラベルは、P0 座標での変換関係を示します。

T_{diff}=A_{p_0,t_1}^{p_0,t_2}

ベロダイン座標系での t0->t1 の変換が必要な場合、次のようになります。

T_{velo,t_0}^{velo,t_1} = {Tr}^{-1} \cdot T_{diff} \cdot Tr                (1)

に相当

A_{P_0}^{ベール} \cdot A^{p_0,t_1}_{p_0,t_0} \cdot A^{P_0}_{ベール} = A_{P_0}^{ベール} \cdot A^{P_0, t_1}_{w} \cdot A_{P_0,t_1}^{w} \cdot A^{P_0}_{ベール} =(A_{ベール}^{P_0})^{-1} \cdot(A_{ P_0,t_1}^{w}) ^{-1} \cdot A_{P_0,t_1}^{w} \cdot A^{P_0}_{velo}

最終的には以下と同等

 (A_{velo,t_1}^{w})^{-1} \cdot A_{velo,t_0}^{w}                            (2)

つまり、上記 2 つの変換 (1) (2) は同等です。

(1) 計算効率が高い

(2) 計算はより複雑で、最初に P0 座標系に変換してから逆変換する必要があります。

おすすめ

転載: blog.csdn.net/li4692625/article/details/131360512