[发明专利]惯性及激光扫描仪联合在线标定方法

权利要求书

1.一种惯性及激光扫描仪联合在线标定方法，其特征在于，所述惯性及激光扫描仪联合在线标定方法包括：

制作标准轨道模型，获取标准轨道模型的标准廓形；

将两自由度摇摆台调整至水平状态，将轨检梁放置于所述两自由度摇摆台的台面上；

对惯性导航系统进行初始对准，初始对准完成后，同步采集激光扫描仪廓形和惯导姿态信息；

基于迭代最近邻算法将各个激光扫描仪输出廓形调整至与标准廓形接近重合以完成惯性及激光扫描仪的标定粗调；

标定粗调完成后，在激光测量点云上选取轨腰处R20圆区域数据和轨顶部1：20直线区域数据；

分别对所述轨腰处R20圆区域数据和所述轨顶部1：20直线区域数据进行拟合；

以拟合后的所述轨顶部1：20直线与标准廓形直线间的夹角为旋转角，所述轨腰处R20圆区域的圆心与标准廓形R20圆心之间的距离矢量为平移量，基于所述旋转角和所述平移量计算获取精调变换矩阵；

根据标定粗调结果以及所述精调变换矩阵完成对横滚安装角的标定；

将所述两自由度摇摆台沿所述轨检梁的X轴转动，持续计算所述精调变换矩阵，基于所述精调变换矩阵记录所述轨顶部1：20直线段数据点云与标准廓形点云之间的Hausdorff距离，当所述轨顶部1：20直线段数据点云与标准廓形点云之间的Hausdorff距离达到最小时，此时的航向角变化值即为所述激光扫描仪的航向偏角，基于所述激光扫描仪的航向偏角完成航向安装角的标定；将所述两自由度摇摆台沿所述轨检梁的Z轴转动，持续计算所述精调变换矩阵，基于所述精调变换矩阵记录所述轨腰处R20圆区域数据点云与标准廓形点云之间的Hausdorff距离，当所述轨腰处R20圆区域数据点云与标准廓形点云之间的Hausdorff距离达到最小时，此时的俯仰角变化值即为所述激光扫描仪的俯仰偏角，基于所述激光扫描仪的俯仰偏角完成俯仰安装角的标定。

2.根据权利要求1所述的惯性及激光扫描仪联合在线标定方法，其特征在于，基于迭代最近邻算法将各个激光扫描仪输出廓形调整至与标准廓形接近重合以完成惯性及激光扫描仪的标定粗调具体包括：采用迭代最近邻算法，分别将各个激光扫描仪的测量点云与标准廓形点云相匹配；根据相匹配的激光扫描仪的测量点云以及标准廓形点云计算获取粗调变换矩阵；调整所述粗调变换矩阵以使粗调误差函数取得极小值，记录各个所述激光扫描仪点云的旋转角度和惯性导航系统的横滚角，根据各个所述激光扫描仪点云的旋转角度和惯性导航系统的横滚角计算获取标定粗调结果。

3.根据权利要求2所述的惯性及激光扫描仪联合在线标定方法，其特征在于，所述粗调变换矩阵T_coarse可根据来获取，所述粗调误差函数J(T)可根据来获取，其中，R为旋转矩阵，t为平移向量，r_ij为旋转矩阵R中的各项元素，i＝1,2,3，j＝1,2,3；x、y、z为平移向量t中的各项元素，p_i∈P，p_i为标准廓形点云P中的点集，q_i∈Q，q_i为激光测量点云Q中与点集p_i相对应的点集。

4.根据权利要求1至3中任一项所述的惯性及激光扫描仪联合在线标定方法，其特征在于，所述精调变换矩阵可根据来获取，其中，ΔR为由旋转角构成的旋转矩阵的增量，Δt为由平移量构成的平移向量的增量分别表示分别旋转矩阵和平移向量的增量，T_fine,k为k时刻的精调变换矩阵，T_fine,k+1为k+1时刻的精调变换矩阵，ΔT_k为采样时间，R_k为激光扫描仪与惯导之间的姿态转换矩阵，t_k为激光扫描仪与惯导之间的平移矩阵，Δt为平移矩阵的调整量。

5.根据权利要求4所述的惯性及激光扫描仪联合在线标定方法，其特征在于，所述惯性及激光扫描仪联合在线标定方法根据γ_k+1＝Δα_γ+γ_k，完成对横滚安装角的标定，其中，γ_k+1为k+1时刻的横滚安装角，Δα_γ为，γ_k为粗调后的k时刻的横滚安装角。