一种鲁棒的2D激光雷达和摄像机最小解标定方法

因为P3P问题固有的结构缺陷,二维激光雷达和摄像机的最小解标定方法存在数值稳定性差、精度较差等问题。针对上述问题,本文提出了一种鲁棒的最小解标定方法,对P3P问题的求解算法和最优解选择误差度量进行改进。首先,根据3个棋盘格构建的P3P问题,利用改进的RP3P算法进行求解,提高了解的稳定性。然后,基于可信度加权观测概率设计了一种的最优解选择策略,提高了所选解的准确性。根据实验结果可知,本文的算法在标定结果的精度和有效性上得到明显改善。仿真实验中,在不同噪声水平下,相比于Francisco方法和Hu方法,本文方法的有效解概率提高了5%~41%和2%~20%,旋转矩阵精度提高了2°~6°和1.5°~2°,平移向量精度提高了180~520 mm和150~180 mm,性能提高明显。