[发明专利]临近空间飞行器传递对准模型不确定性的鲁棒滤波方法

摘要

本发明公开了一种临近空间飞行器传递对准模型不确定性的鲁棒滤波方法，包括四个步骤：步骤一，根据临近空间飞行器传递对准系统的工作原理和特点，建立系统的数学平台失准角误差方程、速度误差方程、位置误差方程和观测方程；步骤二，根据系统的误差方程建立模型不确定的状态方程和观测方程；步骤三，给出状态变量初始值(x0)和预测误差方差矩阵初始值(Σ0|0)，给出稀疏网格求积分点集(ξj，εj；j＝1,2，…Np)，给出鲁棒滤波参数γ和ε；步骤四，利用鲁棒滤波对系统状态进行估计并对子惯导系统进行误差修正，完成传递对准过程。本发明适用于临近空间飞行器动态条件下主子惯导系统具有模型不确定性的传递对准。

主权项

1.一种临近空间飞行器传递对准模型不确定性的鲁棒滤波方法，其特征在于，该鲁棒滤波方法具体步骤如下：步骤1)建立临近空间飞行器传递对准系统的数学平台失准角误差方程、速度误差方程、位置误差方程和观测方程；步骤2)根据数学平台失准角误差方程、速度误差方程、位置误差方程和观测方程建立模型不确定的状态方程和观测方程；xk＝f(xk‑1)+Φ(xk‑1)ηk+Gk|k‑1wk‑1     (1)zk＝h(xk)+Ψ(xk)υk+vk      (2)式中：xk是n维状态向量,zk是m维观测向量，f(·)和h(·)分别对应非线性状态方程和观测方程；Gk|k‑1是n×r维系统过程噪声输入矩阵，wk‑1是r维系统过程噪声序列,vk是m维系统观测噪声序列；Φ(·)∈Rn×n是系统状态方程中模型不确定性部分的有界输入矩阵，Ψ(·)∈Rm×m是系统观测方程中模型不确定性部分的有界输入矩阵；ηk∈Rn是系统状态方程中模型不确定性未知有界变量，υk∈Rm是系统观测方程中模型不确定性未知有界变量；具体如下：2.1)x_k是可简写为包括导航系为发射点惯性坐标系下失准角φⁱ＝[φ_x φ_y φ_z]^T、速度误差δVⁱ＝[δV_x δV_y δV_z]^T、位置误差δSⁱ＝[δS_x δS_y δS_z]^T、陀螺仪随机常值误差ε_gⁱ＝[ε_gx ε_gy ε_gz]^T、加速度计随机常值误差安装误差μⁱ＝[μ_x μ_y μ_z]^T；系统噪声向量为：2.2)系统状态方程中模型不确定性部分的有界输入矩阵Φ(·)具体为ηk满足如下关系：式中：η_k＝[η_φ 0_1×12]^T,η_φ∈R⁶,ε为鲁棒滤波参数；2.3)模型不确定的状态方程具体为：式中，为子惯导解算的姿态矩阵；是子惯导IMU的加速度计测量值；δgⁱ是引力场模型的引力加速度误差；2.4)系统观测方程中模型不确定性部分的有界输入矩阵Ψ(·)具体为：Ψφ是姿态匹配模型不确定部分，主要由初始安装误差确定，具体为：2.5)模型不确定的观测方程具体为:υφ∈R3是与姿态相关的观测模型不确定性未知有界变量，具体为观测向量为:zk＝[Za Zv Zs]T；其中姿态观测量Za＝[Zax Zay Zaz]T，速度观测量Zv＝[Zvx Zvy Zvz]T，位置观测量Zs＝[Zsx Zsy Zsz]T；ε为鲁棒滤波参数；Zam是姿态匹配的观测量；步骤3)给出状态变量初始值(x0)和预测误差方差矩阵初始值(Σ0|0)，给出Np个稀疏网格求积分点集(ξj，εj)，其中j＝1,2，…，Np；状态变量初始值x0＝[0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0]T；预测误差方差矩阵初始值：系统过程噪声初始值系统观测噪声初始值式中：φx0、φy0和φz0是初始数学平台失准角；δVx0、δVy0和δVz0是初始速度误差；δSx0、δSy0和δSz0是初始位置误差；ε_gx0、ε_gy0和ε_gz0是陀螺仪常值漂移初值；和是加速度计常值偏移初值；μ_x0、μ_y0和μ_z0是主子惯导间安装误差初值；wgx、wgy和wgz是陀螺仪随机噪声；wax、way和waz是加速度计随机噪声；σax、σay和σaz是姿态观测噪声标准差；σvx、σvy和σvz是速度观测噪声标准差；σsx、σsy和σsz是位置观测噪声标准差；根据稀疏网格求积分准则给定一组积分点集(ξj，εj)其中j＝1,2,…Np，Np表示积分点集的个数；其中Np＝2n2+2n+1,n为状态变量维数；给定满足γ>1和ε>0的鲁棒滤波参数；具体为：第一组γ1＝500，ε1＝0.05：第二组γ1＝100，ε1＝0.01：步骤4)利用鲁棒稀疏网格求积分滤波经过初始采样、时间更新、重采样、量测更新和鲁棒更新过程对临近空间飞行器传递对准系统状态进行估计，并对子惯导系统进行误差修正，判断k+1是否大于等于步长L，如果是，状态估计结束，完成传递对准过程，否则返回初始采样过程进行下一次估计。