[发明专利]一种基于激光测速仪航位推算系统的里程计标定方法

说明书

技术领域：

本发明涉及一种基于激光测速仪航位推算系统的里程计标定方法，属于惯性技术领域。

背景技术：

里程计是测量车辆行驶速度和路程的一种传感器，具有完全自主、精度高、测速范围宽、动态性能好、测量误差不随时间发散的优点。单独的里程计不具备导航定位功能，但是与惯导系统组合能优势互补，能实现全自主、高精度导航定位。

组合导航系统实际使用中捷联惯导系统和里程计分别装在载体的不同位置，需要标定里程计安装角，而且由于车轮周长受轮胎温度、充气压力以及表面磨损等因素的影响，需要同时对里程计标度因数误差进行标定。目前公开文献中用于导航定位领域的里程计并没有统一的标定方法，本文提出了一种里程计安装角和标度因数误差的标定方法。

发明内容：

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

2、技术方案：

本发明一种基于激光测速仪航位推算系统的里程计标定方法，该方法具体步骤如下：

步骤1、将惯组、激光测速仪和里程计安装到载体上，系统上电启动。

步骤2、装订初始参数(包括初始的经度、纬度、高度、激光测速仪的标度、激光测速仪的安装角、里程计标度初值)至导航计算机。

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

步骤4、导航系统由对准模式切换到惯导/激光测速仪航位推算模式，切换完成后载体开始运动，运动过程中保持航位推算模式。

步骤5、采集保存激光测速仪与捷联惯导构成的航位推算系统输出的姿态矩阵和导航系下的速度以及里程计的速度输出，至少采集保存三个不同时刻的数据。

步骤6、利用激光测速仪航位推算系统输出的姿态矩阵，将其在导航系下的速度转换成载体系下的速度。

步骤7、用最小二乘法辨识里程计的安装角及标度因数误差。

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

其中，步骤6中所述“利用激光测速仪航位推算系统输出的姿态矩阵，将其在导航系下的速度转换成载体系下的速度”，进行过程说明如下：

分别为激光测速仪航位推算系统在导航系下的速度输出，分别为激光测速仪航位推算系统在载体系x、y、z三个轴向上的速度输出，为激光测速仪航位推算系统输出的姿态矩阵，导航系下的速度转换成载体下的速度公式如下：

VxbVybVzb=CnbVEnVNnVUn]]>

其中，步骤7中所述“用最小二乘法辨识里程计的安装角和标度因数误差”，进行过程说明如下：