[发明专利]一种基于导航系统的三波束激光测速仪标定方法

说明书

技术领域：

本发明涉及一种基于导航系统的三波束激光测速仪标定方法，属于惯性导航技术/组合导航技术领域。 

背景技术：

激光测速仪作为一种速度传感器，具有完全自主、精度高、测速范围宽、动态性能好及非接触测量的优点。单独的激光测速仪不具备导航定位功能，但是与惯导系统组合能优势互补，能实现全自主、高精度导航定位。 

组合导航系统实际使用中惯导系统和三波束激光测速仪分别装在载体的不同位置，需要标定测速仪安装角，同时实验室中测得的激光测速仪标度因数在实际使用中会有变化，需要标定标度因数误差。目前公开文献中用于导航定位领域的激光测速仪并没有统一的标定方法，本文提出了一种三波束激光测速仪安装角和标度因数误差的标定方法，解决了工程实际中激光测速仪与惯导组合系统导航定位的基础问题。 

发明内容：

1、目的：本发明的目的是提供了一种基于导航系统的三波束激光测速仪标定方法，它克服了现有技术的不足，解决了激光测速仪装到载体上时需要标定安装角和标度因数误差的问题。 

2、技术方案：本发明一种基于导航系统的三波束激光测速仪标定方法，该方法具体步骤如下： 

步骤1、将捷联惯导系统、差分GPS和激光测速仪安装到载体上，装订初始位置参数（包括初始的经度、纬度和高度）至惯导的导航计算机。 

步骤2、捷联惯导预热，然后采集陀螺和加速度计的输出数据。 

步骤3、对采集到的陀螺和加速度计数据进行处理，根据捷联惯导系统误差传播特性和古典控制理论，采用二阶调平和方位估算法来完成系统的粗对准，初步确定载体姿态角。粗对准时间为1分钟。粗对准后利用卡尔曼滤波技术精对准5分钟。 

步骤4、启动差分GPS和激光测速仪，惯导系统由对准模式切换到SINS/DGPS（捷联惯导系统/差分GPS）组合导航模式（组合算法框图见图1），切换完成后载体开始运动。 

步骤5、采取载体不同运动状态下测速仪的输出及SINS/DGPS组合导航系统输出，至少采三个不同时刻的输出。 

步骤6、利用最小二乘法分别辨识激光测速仪三个波束的安装角及标度因数误差。 

步骤7、标定精度评价分析。 

步骤1—7分为三个阶段，步骤1—3为准备阶段，步骤4—6为激光测速仪标定阶段（标定方法框图见图2），步骤7为标定结果评价阶段。 

其中，步骤6中所述的最小二乘法辨识三波束激光测速仪的安装角和标度因数误差，具体实现过程说明如下： 

以三波束激光测速仪中某波束为例介绍它的安装角和标度因数误差标定方法，另外两个波束的安装角和标度因数误差标定方法与此相同。 

定义V_L为激光测速仪输出， 分别为SINS/DGPS在载体系x、y、z三个轴向上的输出，δK为激光测速仪标度因数误差，α、β、γ分别为激光测速仪与载体系x、y、z三个轴向的夹角。测得n个点（n≥3）单波束测速仪输出V_L(1)、V_L(2)…V_L(n)及n个点（n≥3）SINS/DGPS输出 

由VL=(1+δK)(Vxbcosα+Vybcosβ+Vzbcosγ)]]>可得