6. 计算摄像机矩阵P
由3维空间与图像平面元素间的对应来估计摄像机投影矩阵成为摄像机参数确定,假定3维空间到图像的映射是线性的(镜头失真在标定过程矫正)。
6.1 基本方程
[ 0 ⊤ − w i X i ⊤ y i X i ⊤ w i X i ⊤ 0 ⊤ − x i X i ⊤ − y i X i ⊤ x i X i ⊤ 0 ⊤ ] [ P 1 P 2 P 3 ] = 0 \left[ \begin{array}{ccc} \textbf{0}^\top && -w_i\textbf{X}_i^\top&&y_i\textbf{X}_i^\top\\ w_i\textbf{X}_i^\top&&\textbf{0}^\top&&-x_i\textbf{X}_i^\top\\ -y_i\textbf{X}_i^\top&&x_i\textbf{X}_i^\top&&\textbf{0}^\top\\ \end{array} \right] \left[ \begin{array}{ccc} \textbf{P}^1\\ \textbf{P}^2\\ \textbf{P}^3\\ \end{array} \right]=\textbf{0} ⎣⎡0⊤wiXi⊤−yiXi⊤−wiXi⊤0⊤xiXi⊤yiXi⊤−xiXi⊤0⊤⎦⎤⎣⎡P1P2P3⎦⎤=0
因为三个方程线性相关,只选择前两个方程:
[ 0 ⊤ − w i X i ⊤ y i X i ⊤ w i X i ⊤ 0 ⊤ − x i X i ⊤ ] [ P 1 P 2 P 3 ] = 0 \left[ \begin{array}{cc} \textbf{0}^\top && -w_i\textbf{X}_i^\top&&y_i\textbf{X}_i^\top\\ w_i\textbf{X}_i^\top&&\textbf{0}^\top&&-x_i\textbf{X}_i^\top\\ \end{array} \right] \left[ \begin{array}{ccc} \textbf{P}^1\\ \textbf{P}^2\\ \textbf{P}^3\\ \end{array} \right]=\textbf{0} [0⊤wiXi⊤−wiXi⊤0⊤yiXi⊤−xiXi⊤]⎣⎡P1P2P3⎦⎤=0
矩阵 P P P有12个元素和11个自由度,六组对应点构成最小配置解; n ≥ 6 n\ge{6} n≥6组点对应, A p = 0 A\textbf{p}=\textbf{0} Ap=0将不存在精确解,可通过最小化代数误差(归一化约束下 ∣ ∣ A p ∣ ∣ ||A\textbf{p}|| ∣∣Ap∣∣最小值)或几何误差获得近似解;
- 约束条件:(1) ∣ ∣ p ∣ ∣ = 1 ||\textbf{p}||=1 ∣∣p∣∣=1,(2) ∣ ∣ p ^ 3 ∣ ∣ = 1 ||\hat\textbf{p}^3||=1 ∣∣