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