1. 二维激光雷达和摄像头联合标定原理
理论上激光雷达点要先从世界坐标系经过旋转、平移、缩放等变换转换到相机坐标,再乘以相机内参矩阵转换到图像坐标。但其实二维激光雷达坐标到图像坐标的变换可以更简洁地看成是一个射影变换,二维激光的激光点就相当于俯视图,摄像头拍到的图像可以想象为主视图,而俯视图通过乘以一个单应矩阵变换到主视图的过程就是射影变换。转换的一般形式如下:
[ u v 1 ] = [ h 1 h 2 h 3 h 4 h 5 h 6 h 7 h 8 h 9 ] ∗ [ x y 1 ] ( 1.1 ) \left[\begin{matrix} u\\v\\1\end{matrix}\right] = \left[\begin{matrix} h_1&h_2&h_3\\ h_4&h_5&h_6\\ h_7&h_8&h_9\end{matrix}\right] * \left[\begin{matrix} x\\y\\1\end{matrix}\right] (1.1) ⎣⎡uv1⎦⎤=⎣⎡h1h4h7h2h5h8h3h6h9⎦⎤∗⎣⎡xy1⎦⎤(1.1)
其中[x y 1]是激光雷达的齐次坐标,[u v 1]是激光转换到图像坐标系后的图像齐次坐标,我们提出h矩阵中的h_9并放到等式左边作为缩放因子λ后,可将公式写成如下形式 λ ∗ [ u v 1 ] = [ n 1 n 2 n 3 n 4 n 5 n 6 n 7 n 8 1 ] ∗ [ x y 1 ] ( 1.2 ) λ*\left[\begin{matrix} u\\v\\1\end{matrix}\right] = \left[\begin{matrix} n_1&n_2&n_3\\ n_4&n_5&n_6\\ n_7&n_8&1\end{matrix}\right] * \left[\begin{matrix} x\\y\\1\end{matrix}\right] (1.2) λ∗⎣⎡uv1⎦⎤=⎣⎡n1n4n7n2n5n8n3n61