一种带有非线性补偿滤波器的捷联惯导系统技术方案

本发明专利技术公开了一种带有非线性补偿滤波器的捷联惯导系统，是在传统捷联惯导系统中增加了非线性补偿滤波器。非线性补偿滤波器一方面接收加速度计组合输出的比力信息

A strapdown inertial navigation system with nonlinear compensation filter

The invention discloses a strapdown inertial navigation system with a nonlinear compensation filter, which adds a nonlinear compensation filter to the traditional strapdown inertial navigation system. Nonlinear compensation filter, on the one hand, receives the specific force information of the accelerometer output.

【技术实现步骤摘要】
一种带有非线性补偿滤波器的捷联惯导系统
本专利技术涉及一种非线性补偿滤波器，更确切地说，是一种基于加速度计输出能提高捷联惯导系统姿态精度的非线性无源补偿滤波器。
技术介绍
捷联惯导系统(SINS，strapdowninertialnavigationsystem)是在平台式惯导系统基础上发展而来的。它是一种无框架系统，由三个速率陀螺、三个线加速度计和微型导航计算机组成。捷联式惯导系统原理简图(在本申请中称为图1)请参考科学出版社于2006年5月第一版，作者秦永元，《惯性导航》第287页。制约传统的SINS姿态精度主要有以下两个因素：一是惯性元件(包括加速度计和陀螺仪)本身的精度；二是导航姿态解算的算法精度。对于惯性元件而言，可靠性、可维修性和成本依然制约着惯性元件精度的提高，因此，惯性元件本身精度的提高是困难的、有限的。而提高姿态算法精度成本低，但是实现难度大，这主要是由姿态算法本身的成熟以及复杂性决定的。
技术实现思路
本专利技术的目的是设计一种能提高捷联惯性导航系统姿态精度的非线性补偿滤波器。传统的SINS姿态解算是利用陀螺输出进行姿态矩阵解算，进而进行姿态、航向解算，而忽略了加速度计输出对于姿态的反映。本专利技术是将加速度计输出作为约束，对角速率解算得到的姿态矩阵进行非线性补偿滤波，抑制了姿态的发散，提高姿态精度。本专利技术是一种带有非线性补偿滤波器的捷联惯导系统，其特征在于：非线性补偿滤波器PCF设置在传统SINS的姿态阵解算模块与比力坐标变换模块之间；非线性补偿滤波器一方面接收加速度计组合输出的比力信息另一方面接收姿态阵解算模块输出的姿态矩阵第三方面是将比力信息与姿态矩阵进行姿态非线性补偿，得到补偿后姿态矩阵所述补偿后姿态矩阵输出给比力坐标变换模块。在本专利技术中，非线性补偿滤波器PCF进行的非线性补偿处理步骤为：步骤一，构造测量矩阵C测量；根据加速度计输出的X轴的比力Y轴的比力和Z轴的比力计算姿态角的约束和θ表示俯仰角，γ表示横滚角，g表示重力加速度；根据姿态角θ和γ构造得到测量姿态矩阵C测量；sinγ表示横滚角的正弦；sinθ表示姿态角的正弦；sinψ表示航向角的正弦；cosγ表示横滚角的余弦；cosθ表示姿态角的余弦；cosψ表示航向角的余弦；步骤二，比力对于姿态矩阵的约束；步骤21，将姿态阵解算模块输出的姿态矩阵作为非线性补偿滤波器中估计矩阵的初值，记为即i＝0；i为迭代次数；步骤22，应用与C测量来计算误差估计矩阵且为估计矩阵的转置；步骤23，判断的对角线元素否是为1；是，则在非线性补偿滤波器中将赋值给补偿后姿态矩阵然后将补偿后姿态矩阵输出给比力坐标变换模块；否，则执行步骤三；步骤三，非线性滤波补偿；步骤31，计算残差矢量为误差估计矩阵的转置；ka为残差矢量增益系数；步骤32，计算陀螺仪偏差kg为陀螺仪偏差增益系数；步骤33，计算中间矩阵矢量其中为角速度计输出，的反对称矩阵记为Ai；步骤34，更新估计矩阵得到更新后的估计矩阵然后将返回步骤二；为以自然对数e为底、以反对称矩阵Ai为变更的对数函数值；Δt为惯性设备的输出周期。经本专利技术设计得到的应用于提高捷联惯性导航系统姿态解算精度的非线性补偿滤波器的优点在于：①成本低；本专利技术是从捷联惯性导航姿态解算结构方面提高系统姿态精度，其成本远远低于一般从硬件方面提高捷联惯导系统姿态精度。②本专利技术设计的非线性补偿滤波器易于实现。③精度明显提高；本专利技术基于加速度计约束姿态，明显抑制了姿态的发散(即达到姿态收敛)，相比传统姿态解算方法有了明显的精度提升。附图说明图1是传统SINS的结构框图。图2是本专利技术设计的具有非线性补偿滤波器的SINS的结构框图。图3是本专利技术中非线性补偿滤波器的流程图。图4A是本专利技术中加入非线性补偿滤波器后的俯仰角结果图。图4B是本专利技术中加入非线性补偿滤波器前的俯仰角结果图。图5A是本专利技术中加入非线性补偿滤波器后的横滚角结果图。图5B是本专利技术中加入非线性补偿滤波器前的横滚角结果图。具体实施方式下面将结合附图和实施例对本专利技术做进一步的详细说明。参见图2所示，本专利技术设计了一种带有非线性补偿滤波器的捷联惯导系统(简称为PCF_SINS)，该PCF_SINS能够提高传统SINS的姿态精度。本专利技术的非线性补偿滤波器PCF设置在传统SINS的姿态阵解算模块与比力坐标变换模块之间。本专利技术的非线性补偿滤波器(简称为PCF)一方面接收加速度计组合输出的比力信息另一方面接收姿态阵解算模块输出的姿态矩阵第三方面是将比力信息与姿态矩阵进行姿态非线性补偿，得到补偿后姿态矩阵所述补偿后姿态矩阵输出给比力坐标变换模块。在本专利技术中，姿态矩阵请参考科学出版社于2006年5月第一版，作者秦永元，《惯性导航》第297页的公式9.2.40。上角标n表示导航坐标系，下角标b表示载体坐标系。传统SINS输出有姿态角(θ和γ)和航向角ψ，姿态角包括有俯仰角θ和横滚角γ，ψ表示航向角。参见图3所示，非线性补偿滤波器PCF进行的非线性补偿处理步骤为：步骤一，构造测量矩阵C测量；在本专利技术中，根据加速度计输出的X轴的比力Y轴的比力和Z轴的比力计算姿态角的约束和θ表示俯仰角，γ表示横滚角，g表示重力加速度；根据姿态角θ和γ构造得到测量姿态矩阵C测量；sinγ表示横滚角的正弦；sinθ表示姿态角的正弦；sinψ表示航向角的正弦；cosγ表示横滚角的余弦；cosθ表示姿态角的余弦；cosψ表示航向角的余弦。构造的C测量充值利用了加速度计输出的比力信息，而传统SINS中的姿态阵解算模块是不应用比力信息的。在本专利技术中应用比力信息，相当于在姿态解算中增加了三个约束条件，从而使得解算出的姿态矩阵更加符合实际情况。步骤二，比力对于姿态矩阵的约束；步骤21，将姿态阵解算模块输出的姿态矩阵作为非线性补偿滤波器中估计矩阵的初值，记为中i为迭代次数；在本专利技术中，只有首次进行非线性补偿滤波时，才用姿态矩阵作为初始值，继首次后的均用前一次作为当前次的初值。步骤22，应用与C测量来计算误差估计矩阵且为估计矩阵的转置；步骤23，判断的对角线元素否是为1；是，则在非线性补偿滤波器中将赋值给补偿后姿态矩阵然后将补偿后姿态矩阵输出给比力坐标变换模块；否，则执行步骤三；步骤三，非线性滤波补偿；步骤31，计算残差矢量为误差估计矩阵的转置；ka为残差矢量增益系数，与所用惯性设备有关。在本专利技术中，应用残差矢量克服传统SINS单纯依靠陀螺信息进行姿态解算，有效地抑制了利用姿态矩阵解算出的姿态角(θ和γ)的发散。步骤32，计算陀螺仪偏差kg为陀螺仪偏差增益系数，与所用惯性设备有关；步骤33，计算中间矩阵矢量其中为角速度计输出，的反对称矩阵记为Ai；在本专利技术中，通过对中间矩阵的引用，有效地对传统SINS中姿态解算时陀螺仪误差进行补偿。步骤34，更新估计矩阵得到更新后的估计矩阵然后将返回步骤二；为以自然对数e为底、以反对称矩阵Ai为变更的对数函数值；Δt为惯性设备的输出周期，本专利技术中选用0.05s。实施例1本专利技术中定义导航坐标系(n系)与地理坐标系(g系)重合，其xn轴指东，yn轴指北，zn轴指天；机体坐标系(b系)的xb轴指向机体的右侧，yb轴沿机体纵轴指向机头，zb轴指向机体的上方。采集了MEMS陀螺在低动态情况的输出，MEMS加速度计零偏为本文档来自技高网...

【技术保护点】
1.一种带有非线性补偿滤波器的捷联惯导系统，其特征在于：非线性补偿滤波器PCF设置在传统SINS的姿态阵解算模块与比力坐标变换模块之间；非线性补偿滤波器一方面接收加速度计组合输出的比力信息

【技术特征摘要】
2017.12.25 CN 20171142211451.一种带有非线性补偿滤波器的捷联惯导系统，其特征在于：非线性补偿滤波器PCF设置在传统SINS的姿态阵解算模块与比力坐标变换模块之间；非线性补偿滤波器一方面接收加速度计组合输出的比力信息另一方面接收姿态阵解算模块输出的姿态矩阵第三方面是将比力信息与姿态矩阵进行姿态非线性补偿，得到补偿后姿态矩阵所述补偿后姿态矩阵输出给比力坐标变换模块。2.根据权利要求1所述的带有非线性补偿滤波器的捷联惯导系统，其特征在于：非线性补偿滤波器PCF进行的非线性补偿处理步骤为：步骤一，构造测量矩阵C测量；根据加速度计输出的X轴的比力Y轴的比力和Z轴的比力计算姿态角的约束和θ表示俯仰角，γ表示横滚角，g表示重力加速度；根据姿态角θ和γ构造得到测量姿态矩阵C测量；sinγ表示横滚角的正弦；sinθ表示姿态角的正弦；sinψ表示航向角的正弦；cosγ表示横滚角的余弦；cosθ表示姿态角的余弦；cosψ表示航...

【专利技术属性】
技术研发人员：富立，刘永永，王玲玲，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：北京,11