一种弹载BDS/SINS深组合自适应CKF滤波方法技术

本发明专利技术公开了一种弹载BDS/SINS深组合自适应CKF滤波方法。方法为：首先通过轨迹发生器，设定弹道导弹飞行轨迹，生成IMU数据；然后卫星信号模拟器使用弹道导弹飞行轨迹产生即时中频数据，将即时中频数据提供给软件接收机进行卫星导航解算，同时对生成的IMU数据进行捷联惯导解算；接着建立发射惯性系下BDS/SINS深组合导航系统模型；最后将多重次优渐消因子引入到标准容积卡尔曼滤波器中，形成自适应容积卡尔曼滤波器，经过自适应容积卡尔曼滤波器的最优估计，输出系统的校正信息。本发明专利技术对快速变化的系统状态具有更强的跟踪效果，提高了BDS/SINS深组合导航系统在高动态和强干扰环境下的导航精度和鲁棒性。

A missile borne BDS/SINS deep combination adaptive CKF filtering method

The invention discloses a missile borne BDS/SINS deep combination adaptive CKF filtering method. The method is as follows: Firstly, trajectory generator is used to set the trajectory of ballistic missile and generate IMU data; secondly, the satellite signal simulator uses the trajectory of ballistic missile to generate instant intermediate frequency data, which is provided to software receiver for satellite navigation calculation, and the generated IMU data is also used for strapdown inertial navigation solution. Then, the model of BDS/SINS deep integrated navigation system in launch inertial system is established. Finally, multiple suboptimal fading factors are introduced into standard volume Kalman filter to form an adaptive volume Kalman filter. After the optimal estimation of the adaptive volume Kalman filter, the calibration information of the system is output. The invention has stronger tracking effect for fast changing system state, and improves navigation accuracy and robustness of BDS/SINS deep integrated navigation system in high dynamic and strong interference environment.

【技术实现步骤摘要】
一种弹载BDS/SINS深组合自适应CKF滤波方法
本专利技术涉及BDS/SINS组合导航领域，特别是一种弹载BDS/SINS深组合自适应CKF滤波方法。
技术介绍
BDS和SINS的深组合导航是更深层次的组合导航方式，除了可以完成松组合或紧组合的处理工作外，还利用INS的原始测量信息或者导航信息对接收机的信号跟踪环路进行辅助。采用同相或正交的BDS接收机通道中的采样来更新导航滤波器的状态，载波的控制器和码发生器接收来自于导航滤波器的输出校正，可以获得更高的载波相位跟踪带宽和抗干扰能力。深组合导航系统使用在高动态、强干扰的载体运动环境下，剧烈变化的载体角速率和线运动，使得其输出具有很强的非线性。针对深组合导航系统输出非线性问题，解决方法有两种。一种是在设定条件下，将非线性函数进行线性化处理，对高阶项采用忽略或逼近的措施，最常用的的是扩展卡尔曼滤波(ExtendedKalmanFilter,EKF)；另一种是使用采样的方法近似非线性分布，如粒子滤波(ParticleFilter,PF)、无迹卡尔曼滤波(UnscentedKalmanFilter,UKF)、容积卡尔曼滤波(CubatureKalmanFilter,CKF)，可以较好地避免EKF存在的Jacobian矩阵计算复杂和系统非线性严重时滤波误差增大甚至发散的问题。CKF与UKF相比，有严格的数学推导过程，而且不存在UKF在高维稳定性下降，导致滤波精度降低的问题；与PF相比计算量小，实现更容易。CKF滤波算法是建立在系统数学模型和噪声特性信息准确情况下的，在实际环境中，系统数学模型和噪声特性信息的准确性较低，而且弹道导弹高动态、强非线性的特性，使得必须解决CKF在模型和噪声特性不准确时的导航性能，研究自适应滤波算法并将其应用在CKF中显得十分必要。而目前，弹道导弹在高动态、强干扰环境下CKF滤波模型和噪声特性不准确将对产生系统影响，导致系统的定位精度低、鲁棒性差。
技术实现思路
本专利技术的目的在于提供一种弹载BDS/SINS深组合自适应CKF滤波方法，从而提高系统的定位精度，增强系统的鲁棒性。实现本专利技术目的的技术解决方案为：一种弹载BDS/SINS深组合自适应CKF滤波方法，包括以下步骤：步骤1、通过轨迹发生器，设定弹道导弹飞行轨迹，生成IMU数据；步骤2、卫星信号模拟器使用弹道导弹飞行轨迹产生即时中频数据，将中频数据提供给软件接收机进行卫星导航解算，同时对生成的IMU数据进行捷联惯导解算；步骤3、建立发射惯性系下BDS/SINS深组合导航系统模型；步骤4、将多重次优渐消因子引入到标准容积卡尔曼滤波器中，形成自适应容积卡尔曼滤波器，经过自适应容积卡尔曼滤波器的最优估计，输出系统的校正信息。本专利技术与现有技术相比，其显著优点在于：(1)针对BDS/SINS深组合导航非线性的特点，将基于三阶球面－径向容积规则的非线性容积卡尔曼滤波算法引入深组合导航中；(2)引入多重次优渐消因子到CKF滤波器中，在提高滤波精度的同时实现对快速变化的状态进行强有力的跟踪，可以更有效的提高系统的位置精度和鲁棒性。附图说明图1是本专利技术弹载BDS/SINS深组合自适应CKF滤波方法的流程图。具体实施方式下面结合附图对本专利技术作进一步详细说明。结合图1，本专利技术一种弹载BDS/SINS深组合自适应CKF滤波方法，步骤如下：步骤1、通过轨迹发生器，设定弹道导弹飞行轨迹，生成IMU数据；根据弹道导弹飞行时的物理模型，设置各阶段的飞行参数，生成弹道导弹飞行轨迹和相应的IMU数据。步骤2、卫星信号模拟器使用弹道导弹飞行轨迹产生即时中频数据，将即时中频数据提供给软件接收机进行卫星导航解算，同时对生成的IMU数据进行捷联惯导解算；将弹道导弹飞行轨迹提供给卫星信号模拟器，产生即时中频数据；然后将即时中频数据提供给软件接收机进行卫星导航解算，得到弹道导弹的位置、卫星的位置和弹道导弹的伪距信息；最后对生成的IMU数据进行捷联惯导解算，得到弹道导弹的位置、速度和姿态信息。步骤3、建立发射惯性系下BDS/SINS深组合导航系统模型，具体如下：(3.1)系统状态方程为：公式(1)中Xs表示SINS系统的状态变量；Xg表示北斗导航系统的状态变量，具体形式分别如下：Xg(t)＝[ΔluΔlru]T(3)其中，为发射惯性系下系统的姿态失准角；δVx、δVy、δVz为发射惯性系下三轴方向的速度误差；δX、δY、δZ为发射惯性系下三轴方向的位置误差；εx、εy、εz和▽x、▽y、▽z为弹体坐标系下陀螺仪常值漂移和加速度计常值偏置，Δlu为与时钟误差对应的距离误差，Δlru为与时钟频率误差对应的距离率误差；公式(1)中Fs(t)为SINS系统状态转移矩阵，Gs(t)为SINS系统噪声驱动矩阵，Ws(t)为SINS系统噪声矩阵，具体形式分别如下：Ws(t)＝[ωgxωgyωgzωaxωayωaz]T其中，ωgx、ωgy、ωgz为三个轴向的陀螺仪量测白噪声；ωax、ωay、ωaz为三个轴向的加速度计量测白噪声；为弹体坐标系到导航坐标系的转换矩阵；I是单位矩阵；矩阵G′和F1的具体形式分别如下：公式(1)中Fg(t)为北斗导航系统状态转移矩阵，Gg(t)为北斗导航系统噪声驱动矩阵，Wg(t)为北斗导航系统噪声矩阵，具体形式分别如下：Wg(t)＝[wuwru]T其中，Tru为BDS时钟频率漂移的相关时间；wu为BDS时钟误差白噪声；wru为BDS时钟频率误差白噪声；(3.2)系统观测方程为：伪距差观测方程为：其中为SINS输出的导弹位置与第i颗北斗卫星之间的伪距测量值；为BDS接收机输出的导弹与第i颗北斗卫星之间的伪距测量值，具体计算公式如下：式中：[XsYsZs]T为SINS系统解算得到的导弹在发射惯性系下的位置，为第i颗北斗卫星转换到发射惯性系下的位置；设定某一时刻，导弹在发射惯性系下的真实位置为[XYZ]T，ρi为该时刻导弹与卫星之间的理想距离为等效时钟误差引起的距离误差，为伪距观测噪声；伪距率差观测方程为：其中为SINS输出的导弹与第i颗北斗卫星之间的伪距率；为BDS接收机输出的导弹与第i颗北斗卫星之间的伪距率，具体计算公式如下：式中：是SINS系统解算得到的导弹在发射惯性系下的三维速度，为第i颗北斗卫星在发射惯性系下的运动速度；在设定时刻，导弹在发射惯性系下的真实速度为为该时刻的理想伪距率为等效时钟频率误差引起的距离率误差，为伪距率观测噪声。步骤4、将多重次优渐消因子引入到标准容积卡尔曼滤波器中，形成自适应容积卡尔曼滤波器，经过自适应容积卡尔曼滤波器的最优估计，输出系统的校正信息，具体步骤如下：将步骤3中的系统非线性模型离散化处理为：式中，xk为离散化后系统状态向量，zk+1为离散化后系统观测向量；f(·)为系统非线性状态函数，h(·)为系统非线性观测函数；wk为系统状态高斯白噪声，vk为系统观测高斯白噪声；wk和vk互不相关且满足如下统计特性：式中：Qk、Rk分别wk、vk为协方差阵，Qk对称非负定，Rk对称正定，δkj为δ函数；基于渐消因子的自适应容积卡尔曼滤波算法具体流程为：(4.1)选定滤波初值(4.2)计算采样点设为k时刻状态的统计特性，对Pk进行Cholesky分解有：计算采样点：式中：i＝1,2,…,本文档来自技高网...

【技术保护点】
1.一种弹载BDS/SINS深组合自适应CKF滤波方法，其特征在于，包括以下步骤：步骤1、通过轨迹发生器，设定弹道导弹飞行轨迹，生成IMU数据；步骤2、卫星信号模拟器使用弹道导弹飞行轨迹产生即时中频数据，将即时中频数据提供给软件接收机进行卫星导航解算，同时对生成的IMU数据进行捷联惯导解算；步骤3、建立发射惯性系下BDS/SINS深组合导航系统模型；步骤4、将多重次优渐消因子引入到标准容积卡尔曼滤波器中，形成自适应容积卡尔曼滤波器，经过自适应容积卡尔曼滤波器的最优估计，输出系统的校正信息。

【技术特征摘要】
1.一种弹载BDS/SINS深组合自适应CKF滤波方法，其特征在于，包括以下步骤：步骤1、通过轨迹发生器，设定弹道导弹飞行轨迹，生成IMU数据；步骤2、卫星信号模拟器使用弹道导弹飞行轨迹产生即时中频数据，将即时中频数据提供给软件接收机进行卫星导航解算，同时对生成的IMU数据进行捷联惯导解算；步骤3、建立发射惯性系下BDS/SINS深组合导航系统模型；步骤4、将多重次优渐消因子引入到标准容积卡尔曼滤波器中，形成自适应容积卡尔曼滤波器，经过自适应容积卡尔曼滤波器的最优估计，输出系统的校正信息。2.根据权利要求1中所述的弹载BDS/SINS深组合自适应CKF滤波方法，其特征在于，步骤1中所述的通过轨迹发生器，设定弹道导弹飞行轨迹，生成IMU数据，具体为：根据弹道导弹飞行时的物理模型，设置各阶段的飞行参数，生成弹道导弹飞行轨迹和相应的IMU数据。3.根据权利要求1中所述的弹载BDS/SINS深组合自适应CKF滤波方法，其特征在于，步骤2中所述的卫星信号模拟器使用弹道导弹飞行轨迹产生即时中频数据，将即时中频数据提供给软件接收机进行卫星导航解算，同时对生成的IMU数据进行捷联惯导解算，具体为：将弹道导弹飞行轨迹提供给卫星信号模拟器，产生即时中频数据；然后将即时中频数据提供给软件接收机进行卫星导航解算，得到弹道导弹的位置、卫星的位置和弹道导弹的伪距信息；最后对生成的IMU数据进行捷联惯导解算，得到弹道导弹的位置、速度和姿态信息。4.根据权利要求1中所述的弹载BDS/SINS深组合自适应CKF滤波方法，其特征在于，步骤3所述的建立发射惯性系下BDS/SINS深组合导航系统模型，具体为：(3.1)系统状态方程为：公式(1)中Xs表示SINS系统的状态变量；Xg表示北斗导航系统的状态变量，具体形式分别如下：Xg(t)＝[ΔluΔlru]T(3)其中，为发射惯性系下系统的姿态失准角；δVx、δVy、δVz为发射惯性系下三轴方向的速度误差；δX、δY、δZ为发射惯性系下三轴方向的位置误差；εx、εy、εz和为弹体坐标系下陀螺仪常值漂移和加速度计常值偏置，Δlu为与时钟误差对应的距离误差，Δlru为与时钟频率误差对应的距离率误差；公式(1)中Fs(t)为SINS系统状态转移矩阵，Gs(t)为SINS系统噪声驱动矩阵，Ws(t)为SINS系统噪声矩阵，具体形式分别如下：其中，ωgx、ωgy、ωgz为三个轴向的陀螺仪量测白噪声；ωax、ωay、ωaz为三个轴向的加速度计量测白噪声；为弹体坐标系到导航坐标系的转换矩阵；I是单位矩阵；矩阵G′和F1的具体形式分别如下：公式(1)中Fg(t)为北斗导航系统状态转移矩阵，Gg(t)为北斗导航系统噪声驱动矩阵，Wg(t)为北斗导航系统系统噪声矩阵，具体形式分别如下：Wg(t)＝[wuwru]T其中，Tru为BDS时钟频率漂移的相关时间；wu为BDS时钟误差白噪声；wru为BDS时钟频率误差白噪声；(3.2)系统观测方程为：伪距差观测方程为：其中为SINS输出的导弹位置与第i颗北斗卫星之间的伪距测量值；为BDS接收机输出的导弹与第i颗北斗卫星之间的伪距测量值，具体计算公式如下：式...

【专利技术属性】
技术研发人员：陈帅，韩林，陈德潘，樊龙江，张博雅，朱晓晗，王琛，顾得友，谭聚豪，刘善武，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：江苏,32