OpenCV三角测量原理公式
1. 共线原理 双相机立体重建时, 利用物体点-光心-像点三者共线的原理, 在找到左右匹配的像点并且完成去畸变之后, 就能够在三维空间中形成两条直线, 物体点就是这两个直线的交点. 交点指最小二乘交点, 因为这两个直线由于偏差通常不会交于一点. 共线方程描述了物体点-光心-像点三者共线的含义, 也相当于三维点到二维点的投影过程, 该投影过程可表达为 $$ \left[\begin{array}{l}\mathrm{x}_{\mathrm{c}} \\\mathrm{y}_{\mathrm{c}} \\\mathrm{z}_{\mathrm{c}}\end{array}\right]=\left[\begin{array}{llll}\mathrm{R}_{11} & \mathrm{R}_{12} & \mathrm{R}_{13} & \mathrm{~T}_{\mathrm{x}} \\\mathrm{R}_{21} & \mathrm{R}_{22} & \mathrm{R}_{23} & \mathrm{~T}_{\mathrm{y}} \\\mathrm{R}_{31} & \mathrm{R}_{32} & \mathrm{R}_{33} & \mathrm{~T}_{\mathrm{z}}\end{array}\right]\left[\begin{array}{c}\mathrm{x}_{\mathrm{w}} \\\mathrm{y}_{\mathrm{w}} \\\mathrm{z}_{\mathrm{w}} \\1\end{array}\right] \quad\quad \text{(1)} $$ ...