基于捷联惯性导航的组合导航系统研究.docVIP

基于捷联惯性导航的组合导航系统研究 　　摘 要：分析了矿山水下轮式采煤车的定位定向导航的可实现问题。惯性导航组合系统是现代导航技术的发展重点。考虑到捷联惯性导航的自主性，采用捷联惯导组合系统实现对采煤车的定位导航。设计了捷联惯性导航和里程计组合的自主性水下导航系统。通过对该系统的实物应用试验，试验结果验证了此组合导航方案的有效性。 　　关键词：水下轮式采煤车；组合导航；里程计；捷联惯导系统 　　中图分类号：TN97文献标识码：A 　　文章编号：1004-373X(2009)03-111-03 　　 　　Research of Integrated Navigation System Based on Strapdown Inertial Navigation System 　　LIU Lina，LIU Renqing 　　(Zhuzhou Professional Technology College,Zhuzhou,412001,China) 　　Abstract：The problems of under water navigation by mine roller tram are discussed.Inertial integrated navigation system is the development emphasis of modern navigation technology.Considering the request of independence and reliability of strapdown inertial navigation,mining vehicle is navigated by strapdown inertial integrated navigation system.Strapdown Inertial Navigation System/Odometer(SINS/OD) integrated navigation system is designed in this thesis.The results of dynamic experiment prove the efficiency of above integrated navigation system. 　　Keywords：under water roller mining vehicle;integrated navigation system;odometer;strapdown inertial navigation system 　　 　　0 引 言 　　 　　水下导航系统，其工作环境位于水下，不利于实现人为的控制，而且卫星信号在水下和地下往往无法接收到，且易受干扰，所以人和卫星信号都无法实现对其定位定向的要求。惯性导航这种自主式导航系统可以实现对轮式水下采矿车的定位定向。 　　惯性导航系统［1］ (Inertial Navigation System，INS)是一种既不依赖外部信息、又不发射能量的自主式导航系统，隐蔽性好，不怕干扰。惯性导航系统所提供的导航数据又十分完整，它除能提供载体的位置和速度外，还能给出航向和姿态角，而且又具有数据更新率高，短期精度和稳定性好的优点。然而惯性导航系统并非十全十美，从初始对准开始，其导航误差就随时间而增长，尤其是位置误差，这是惯导系统的主要缺点\。所以需要利用外部信息进行辅助，实现组合导航［3］，使其有效地减小误差随时间积累的问题。里程计［4］(Odometer,OD)是测量车辆行使速度和路程的装置，高分辨率的里程计可以精确测量车辆行驶的速度和路程，可以从捷联惯导中获得姿态和航向信息，进行定位解算，而且随时间累积的定位误差较小，可作为SINS的参考信息。所以建立以SINS为主，里程计为辅加以卡尔曼滤波\的水下组合导航系统,该组合模式工作能有效利用各自的优点，在低成本的情况下实现高精度的惯导组合系统。 　　 　　1 SINS/OD水下组合导航系统模型的建立 　　 　　1.1 里程计的误差分析 　　设采矿车的行使速度为vD，它指向载车的正前方，写成矢量形式为: 　　vbD=vbEvbNvbU＝0vD0 　　(1) 　　其中：vbE,vbN和vbU分别为vD在东北天方向的分量。 　　因此采矿车的速度在n系的表达形式为: 　　vnD=CnbvbD 　　(2) 　　其中：Cnb为捷联姿态矩阵。 　　先来分析定位误差: 　　里程仪的位置方程［4］： 　　D=vnDNRM+h 　　(3) 　　D=vnDE(RN+h)cos LD 　　(4) 　　D=vnDU 　　(5) 　　其中：地球表面上的