资源描述:
《组合导航关键技术.docx》由会员上传分享,免费在线阅读,更多相关内容在工程资料-天天文库。
1、组合导航系统是将载体(飞机、舰船等)上的导航设备组合成一个统一的系统,利用两种或两种以上的设备提供多重信息,构成一个多功能、高精度的冗余系统。组合导航系统有利于充分利用各导航系统进行信息互补与信息合作,成为导航系统发展的方向。在所有的组合导航系统中,以北斗与惯性导航系统INS组合的系统最为理想,而深组合方式是北斗与惯性导航系统(INS)组合的最优方法。鉴于GPS的不可依赖性,北斗卫星导航系统与INS的组合是我国组合导航系统的发展趋势,我国自主研制北斗/INS深组合导航系统需要解决的关键技术。1北斗/惯导
2、深组合导航算法深组合导航算法是由INS导航结果推算出伪距、伪距率,与北斗定位系统观测得到的伪距、伪距率作差得到观测量。通过卡尔曼滤波对INS的误差和北斗接收机的误差进行最优估计,并根据估计出的INS误差结果对INS进行反馈校正,使INS保持高精度的导航。同时利用校正后的INS速度信息对北斗接收机的载波环、码环进行辅助跟踪,消除载波跟踪环和码跟踪环中载体的大部分动态因素,以降低载波跟踪环和码跟踪环的阶数,从而减小环路的等效带宽,增加北斗接收机在高动态或强干扰环境下的跟踪能力。其组合方式如Error!Ref
3、erencesourcenotfound.所示,图中只画出了北斗的一个通道,其他通道均相同。34积分及清零积分及清零码相关码鉴别器鉴频器低通滤波器低通滤波器ρ,ρ计算鉴相器低通滤波器IkQkIk+1Qk+1Ik+2Qk+2δρδfdδθd码环NCO星历Kalman滤波器SINS计算ρ,ρ计算星历IMUCOS映射SIN映射载波环NCO fdθdρBD,ρBDρINS,ρINSδρ,δρ+-码相位误差δXINS∆θ,∆vPINS,VINS图1深组合方式框图组合导航参数估计是组合导航系统研究的关键问题之一。
4、经典Kalman滤波方法是组合导航系统中使用最广泛的滤波方法,但由于动态条件下组合导航系统状态噪声和量测噪声的统计信息的不准确,常导致滤波精度的下降,影响组合导航的性能。滤波初值的选取与方差矩阵的初值对滤波结果的无偏性和稳定性有较大的影响,不恰当的选择可能导致滤波过程收敛速度慢,甚至有可能发散。另外系统误差模型的不准确也会导致滤波过程的不稳定。渐消记忆自适应滤波方法通过调节新量测值对估计值的修正作用来减小系统误差模型不准确对滤波过程的影响。当系统模型不准确时,增强旧测量值对估计值的修正作用,减弱新测量值
5、对估计值的修正作用。因此我们提出了以模糊控制规则为基础的渐消记忆自适应卡尔曼滤波方法。该方法对卡尔曼滤波的增益矩阵设置了权值,通过改变权值来调整观测信息对新状态估计所产生的影响,根据深组合导航系34统可观性的分析结果,设计了权值的模糊调整方法。由载体的速度、加速度和姿态测量信息,根据可观测性分析结果,实时调整权值的大小,减小不可观测状态对滤波过程的影响。模糊渐消记忆自适应卡尔曼滤波方法减小了状态可观测性短暂变化的影响,增强了滤波的精度,能够提高深组合导航系统的性能。1.1渐消记忆自适应Kalman滤波利
6、用Kalman方法进行滤波时,如果系统的模型不准确则滤波过程可能会出现发散,发散的一个重要原因是模型不准确导致新测量矢量对滤波器估计值的修正作用减小,而旧测量矢量修正作用增强。渐消记忆自适应Kalman滤波方法通过引入渐消记忆因子来调整新旧测量矢量对滤波器估计值的修正作用。假设系统的状态和量测模型可表示为:Xk=Fk,k-1+Gk,k-1wk-1(1)Zk=HkXk+vk(2)其中,Xk为n×1向量;Zk为m×1向量;Fk,k-1为系统的状态转移矩阵,Fk,k-1为n×n向量;Hk为系统的观测矩阵,为m
7、×n矩阵。wk和vk分别为系统的状态噪声和观测噪声。其中EX0=mx0,Varx0=P0,则Rk和P0直接影响了观测矢量X0对状态矢量Xk的估计,因此通过调整Rk和P0值可以实现新、旧测量矢量对估计值的修正作用。设置P0N=P0sN(3)34RkN=RksN-k(4)Qk-1N=QksN-k(5)则根据一般Kalman滤波方法可得到渐消记忆滤波的方程为(6)~(9):Pk,k-1Ns-(N-k)=Fk,k-1Pk-1Ns-(N-k)Fk,k-1T+Gk-1Qk-1Gk-1T(6)KkN=Pk,k-1Ns
8、-N-kHkTHkPk,k-1Ns-N-kHkT+Rk-1(7)PkNs-N-k=I-KkNHkPk,k-1Ns-N-kI-KkNHkT+KkNRkKkNT(8)XkN=Fk,k-1Xk-1N+KkN(Zk-HkFk,k-1Xk-1N)(9)滤波初值为:X0N=mx0P0N=P0Ns-N=P0渐消记忆Kalman滤波方法与一般的Kalman滤波方法相比,不同的是在计算Pk,k-1Ns-(N-k)过程中加入了渐消因子s。由于s>1,所以Pk,