床の向きに基づいて 3D 点群を回転させようとしています。床を検出し、その法線ベクトルを計算しました。この法線ベクトルを使用して、床のすべてのポイントが同じ y 値を持つようにします。
正規化された 2 つのベクトルの内積は、それらの間の角度の余弦であるため、最初に現在の法線ベクトル (0.856、0.958、2.58) と目的の法線ベクトル (0.0、0.958、0.0) を正規化します。内積 = 0.917 したがって、角度 = 70.586 ですが、3 次元であるため、これは役に立たないようです。2 回ローテーションする必要がありますか? もしそうなら、最善のアプローチに関する提案はありますか?