この研究では、総最小二乗法を使用した単眼姿勢推定問題の理論的構造を提示します。特徴の単位ベクトル視線観測は、単眼カメラ画像から抽出されます。最初に、最適化フレームワークは、カメラの投影中心からの単位ベクトルから抽出された観測ベクトルを使用して、画像の特徴を指すポーズ推定問題に対して定式化されます。導出された最適化フレームワークを介して得られた姿勢と位置の解は、姿勢誤差の小角度近似の下で Cramér-Rao の下限に到達することが証明されています。具体的には、Fisher Information Matrix と Cramér-Rao 境界が評価され、誤差共分散式の分析的導出と比較されて、推定値の最適性が厳密に証明されます。測定モデルのセンサー データは、一連のベクトル観測によって提供され、完全に入力された 2 つのノイズ共分散行列が、本体と参照観測データに対して想定されます。前者の行列の逆行列は、コスト関数の一連の重み行列で表されます。提案されたソリューションは、エラー共分散分析を検証するために、10,000 サンプルを使用してモンテカルロ フレームワークでシミュレートされます。
This study presents a theoretical structure for the monocular pose estimation problem using the total least squares. The unit-vector line-of-sight observations of the features are extracted from the monocular camera images. First, the optimization framework is formulated for the pose estimation problem with observation vectors extracted from unit vectors from the camera center-of-projection, pointing towards the image features. The attitude and position solutions obtained via the derived optimization framework are proven to reach the Cramér-Rao lower bound under the small angle approximation of the attitude errors. Specifically, The Fisher Information Matrix and the Cramér-Rao bounds are evaluated and compared to the analytical derivations of the error-covariance expressions to rigorously prove the optimality of the estimates. The sensor data for the measurement model is provided through a series of vector observations, and two fully populated noise-covariance matrices are assumed for the body and reference observation data. The inverse of the former matrices appear in terms of a series of weight matrices in the cost function. The proposed solution is simulated in a Monte-Carlo framework with 10,000 samples to validate the error-covariance analysis.