卫星、惯导组合导航

1、 1、清晰理解组合导航的七方面基本内容 （组合方式及系统结构方案） 1 组合导航的优点及目的与实际应用 2 卡尔曼滤波的应用系统特点 3 直接法和间接法 4 输出校正与反馈矫正 5 组合卡尔曼滤波器的设计 6 组合深度:松散组合与紧密组合 7 开环校正与闭环校正方式下的滤波的最优性证明（数学模型出发）内容清单内容清单 2、信息融合理论、联邦滤波与多子滤波器全局容错算法的研究 1 信息融合技术的产生与发展； 2 信息融合的原理与方法； 3 信息融合研究的关键问题与研究方向； 4 分散化滤波方法； 5 各子滤波器估计不相关条件下的联邦滤波算法； 6 各子滤波器估计相关条件下的联邦滤波算法； 7 面

2、向应用系统的全局容错最优滤波器设计； 3、针对实际系统应用的滤波理论探讨 1 滤波稳定性与误差分析； 2 针对系统分析的实用KF技术（次优抗差容错滤波）； 3 分解滤波方法讨论（保持数值稳定）； 4 鲁棒滤波方法探索（保持模型稳定）； 5 非线性滤波器的发展研究实用卡尔曼滤波技术的原因研究实用卡尔曼滤波技术的原因 基本的KF方程对 系统建模的准确性； 噪声的统计特性及相关性,的假设，在实际系统中并不能得到满足。实用KF技术包括： 噪声相关及有色噪声的处理方法； 当噪声及模型参数不确切已知时的自适应或鲁棒滤波算法； 为减少计算量的次优滤波算法； 滤波发散的原因及对策分析； 扩展KF（EKF）滤波

3、,U滤波，P滤波等非线性滤波性能不断发展，谋求改进（精度、容错）； 总结及研究规划总结及研究规划一、组合方式及系统结构方案二、容错滤波算法 全局融合模型和算法三、不断寻找适用的滤波理论和方法对系统设计进行深入研究四、基本内容：惯导、卫星、天文等导航体制原理、误差特性分 析及建模五、深入研究： 1、进一步夯实基础及完善理论素养，使研究进一步深化 2、分解滤波，抗差容错滤波数值发散抑制； 自适应 OR 鲁棒 模型稳定性 3、不断研究新型导航系统，完成建模和分析； 4、对各子系统、整个系统做变参数仿真及对比、分析。Kalman/联邦滤波理论的深化和改进理顺思路，从组合导航的设计理念入手理顺思路，从组

4、合导航的设计理念入手 1 对于实际所要设计的系统，保证系统的高效 低成本且精度和可靠性符合应用要求。算法的实时性、快速性，实现的可能性、经济 性，都是首先要保证的。针对实际应用系统的滤波稳定性（误差）分析 及滤波发散的抑制是理论分析的着重点。1清晰组合导航的七方面基本内容清晰组合导航的七方面基本内容 1. 组合导航的优点及目的与实际应用; 2. 卡尔曼滤波的应用系统特点 3. 直接法和间接法 4. 输出校正与反馈矫正 5. 组合卡尔曼滤波器的设计 6. 组合深度:松散组合与紧密组合 7. 开环校正与闭环校正方式下的滤波2Why KF?KF对系统（应用对象）的要求对系统（应用对象）的要求递推线性

5、最小方差估计；以“状态”（state)表征系统的各个物理量；以“状态方程”和“观测方程”描述系统的动力学特性要求对象是线性系统；已知系统的某些先验知识，如系统噪声及测量噪声的统计特性；组合导航系统基本满足这些要求，因而适合采用KF。32 KF最优组合导航系统最优组合导航系统KF在组合导航中的应用方式 直接法和间接法输出矫正与反馈矫正开环矫正和闭环矫正组合导航KF的设计系统分析与仿真应注意：坐标系（转换至统一坐标系）可观测性（保持稳定性）滤波初值（清楚大致分布）自适应能力（集中反映在Q,R)松散组合与紧密组合41）系统分析2）数学仿真3）试验验证直接法直接法Vs.间接法间接法直接法：估计导航参数

6、本身间接法：估计导航参数的误差1）状态方程和量测方程非线性；2）导航参数一般非小量，方程线性化误差大；3）占用计算资源较多，参数刷新周期不能太快，难以满足动 态、实时性要求。1）系统状态均为小量（各种导航参数误差的组合）；2）方程线性化带来的误差较小；3）滤波计算不参与原系统的计算流程（如惯导力学编排，解算） 原系统除接受校正外，保持独立性。56-+-惯导系统其他系统卡尔曼滤波器IXIXNXXX输出校正的滤波示意图NININIXX)XX()XX(XXX 以惯导系统和其他某一导航系统的组合为例，间接法的组合导航滤波器将惯导系统和其以惯导系统和其他某一导航系统的组合为例，间接法的组合导航滤波器将惯

7、导系统和其他导航系统各自的导航参数进行比较，其差值就包含了惯导某些导航参数的误差和其他导航他导航系统各自的导航参数进行比较，其差值就包含了惯导某些导航参数的误差和其他导航系统的导航参数误差。系统的导航参数误差。 滤波器将这一差值作为量测值，经过滤波计算，得到状态估计值滤波器将这一差值作为量测值，经过滤波计算，得到状态估计值 ，去校正系，去校正系统输出的导航参数统输出的导航参数 ，得到组合导航系统的导航参数估计值，得到组合导航系统的导航参数估计值 IXIXXIIXXX估计误差估计误差IIIIIIIIXX)XXX(X)XX(X)XX(XXXX 组合导航系统导航参数的估计误差，就是惯导系统导航参数误

8、差估计值组合导航系统导航参数的估计误差，就是惯导系统导航参数误差估计值 的估计误差。的估计误差。IX7-+惯导系统其他系统卡尔曼滤波器IXIXNXXNX反馈校正的滤波示意图89 采用反馈校正的间接估计法是将导航参数误差的估计值反馈到各导航系统内部，对误差状采用反馈校正的间接估计法是将导航参数误差的估计值反馈到各导航系统内部，对误差状态进行校正。态进行校正。 由于系统的误差状态性质不同，反馈校正的方式也不同：由于系统的误差状态性质不同，反馈校正的方式也不同： 对于速度、位置等误差，可直接扣除，称为对于速度、位置等误差，可直接扣除，称为“脉冲反馈校正脉冲反馈校正”； 对于惯性仪表误差必须持续补偿，

9、称为对于惯性仪表误差必须持续补偿，称为“补偿反馈校正补偿反馈校正”。 校正量就是误差估计值的负值，即校正量就是误差估计值的负值，即0XXUXXkkpkkck滤波下一时刻的滤波一步预测也为零滤波下一时刻的滤波一步预测也为零0XXckk/1kck/1k则反馈校正前的滤波估计方程简化为如下形式则反馈校正前的滤波估计方程简化为如下形式111kkkZKXINSGPS组合组合输出加 权 平 均INSGPS滤波器组合输出速度、位置组合滤波10伪距、伪距率组合导航11INSGPS11,计算11,组合滤波器组合输出星历位置、速度校正参数GG,惯导惯导/双星组合的原理图示双星组合的原理图示惯导系统卫星接收机系统组

10、合导航参数卫星接收机输出系统输出惯性/双星简单组合原理图 惯导系统卫星接收机组合导航卡尔曼滤波器卫星接收机输出导航参数系统输出信息融合卡尔曼滤波组合原理图 +-惯导系统卫星接收机接收机输出组合导航卡尔曼滤波器系统输出惯导输出间接估计输出校正信息融合组合导航原理图 12参考系统子系统1子系统2子系统N时间更新最优融合局部滤波器2局部滤波器N局部滤波器122,PX11,PXNNPX ,ggPX11,ggPX12,gNgPX1,1Z2ZNZggPX ,mmPX ,gmP1gXggPX ,联邦滤波器的一般结构参考系统子系统1子系统2子系统N局部滤波器2局部滤波器N局部滤波器122,PX11,PXNNP

11、X ,1Z2ZNZggPX ,时间更新最优融合主滤波器无反馈模式联邦滤波器结构图参考系统子系统1子系统2子系统N局部滤波器2局部滤波器N局部滤波器122,PX11,PXNNPX ,1Z2ZNZggPX ,时间更新最优融合主滤波器11,ggXP12,ggXP1,ggNXP融合-反馈模式联邦滤波器结构图参考系统子系统1子系统2子系统N时间更新最优融合局部滤波器2局部滤波器N局部滤波器122,PX11,PXNNPX ,1Z2ZNZggPX ,mmPX ,ggPX ,零化重置零化重置零化重置零复位模式联邦滤波器结构图主滤波器参考系统子系统1子系统2子系统N局部滤波器2局部滤波器N局部滤波器122,PX

12、11,PXNNPX ,1Z2ZNZggPX ,主滤波器时间更新最优融合1,ggmXP变比例模式联邦滤波器结构图11,ggXP12,ggXP1,ggNXP测量值测量值测量值INSGPSDB测量值DOPPLERLF1LF2LF3GF全局最优融合估计INS/GPS/DB/DOPPLER组合系统的二级分散估计融合结构GPSINSDBDOPPLERLF1LF2LF3GF考虑GPS定位数据相关噪声时的二级分散化融合结构INSGPSDBDOPPLERGFYNYNYNFAULT ?FAULT ?FAULT ?LF3LF2LF3故障处理故障处理故障处理INS/GPS/DB/DOPPLER子系统容错结构方框图研究实用卡尔曼滤波技术的原因研究实用卡尔曼滤波技术的原因 基本的KF方程对 系统建模的准确性； 噪声的统计特性及相关性,的假设，在实际系统中并不能得到满足。实用KF技术包括： 噪声相关及有色噪声的处理方法； 当噪声及模型参数不确切已知时的自适应或鲁棒滤波算法； 为减少计算量的次优滤波算法； 滤波发散的原因及对策分析； 扩展KF（EKF）滤波,U滤波，P滤波等非线性滤波性能不断发展，谋求改进（精度、容错）； 总结及研究规划总结及研究规划一、组合方式及系统结构方案二、容错滤波算法 全局融合