UKF算法在星载GPS低轨卫星定轨中的应用
强跟踪UKF滤波在SINS_GPS组合导航中的应用研究
1 引言
由于惯 性 导航 和 卫 星 导 航 信 息 的互 补 性 ,捷
联 惯 性 导航 (1 ) P 组 合导 航 成 为较 为 理想 的 SNS/ S G
的,如果 失准 角很大 ,则会给滤 波带来 很大的误差
甚 至导致 滤波 发散 。而加 性 四元 数法 最能准确地 描 述 大 失准 角 下的误 差传 播特性 ,为此 ,本文采 用四 元数法 建立 SNS系统 的误 差方程 。 由于姿态误 差 I
( CC lg f uo t n n i eigNaj g n e i f eo at d t nui N nig 10 6C i ) NR ol e A t i g er , ni i rt o A rnui a r at , aj 0 1, h a e o ma o E n n n U v sy c n As o c n2 n
K l n ftr ama l )是一 种cne
hg l mo l ar r f,c mb n d ih y bi e i a t o i e wi UKF l o i m,a to g ra k n UKF lo i m i p o o e .By h c t h ag rt h s n t c i g r a g rt h s rp sd te
强跟 踪 U F滤波 S N— P K IS G S组 合 导 航 中 的 心用 研 究 陆 海 勇等
20 0 8年 l 第 3 2月 9卷 第 4期 ( 第 13期 ) 总 3
强跟踪 U KF滤 波在 S N S组 合 导 航 中 的应 用研 究 I S GP
陆海勇 ,赵 伟 ,熊 剑 ,赖际舟 ,刘建业
( 京 航 空航 天 大 学 自动 化学 院 导航 研 究 中心 ,南 京 2 0 1 ) 南 10 6
自适应抗差UKF在卫星组合导航中的理论与应用研究
自适应抗差UKF在卫星组合导航中的理论与应用研究一、本文概述随着科技的不断进步,卫星组合导航系统已成为现代导航技术的重要组成部分。
在各种复杂环境和动态条件下,如何提高导航系统的精度和鲁棒性,一直是导航领域研究的热点和难点问题。
本文旨在探讨自适应抗差无迹卡尔曼滤波(UKF)在卫星组合导航中的理论与应用研究,以期为提升导航系统的性能提供新的思路和方法。
本文将对卫星组合导航的基本原理和关键技术进行介绍,包括卫星导航系统的工作原理、误差来源以及传统的滤波算法等。
在此基础上,重点分析无迹卡尔曼滤波(UKF)的基本原理和优点,并阐述其在处理非线性、非高斯问题时的独特优势。
接着,本文将深入探讨自适应抗差UKF算法的设计和实现。
分析传统UKF算法在面临模型误差和噪声统计特性未知等挑战时的局限性,然后提出自适应抗差UKF算法的设计思路,包括自适应调整滤波参数、引入抗差机制等。
同时,对算法的稳定性和收敛性进行分析,为实际应用提供理论支持。
本文将通过仿真实验和实际数据验证自适应抗差UKF算法在卫星组合导航中的应用效果。
通过与传统滤波算法进行对比,展示自适应抗差UKF算法在提高导航精度、鲁棒性以及适应性等方面的优势。
对实验结果进行分析和讨论,为未来进一步研究提供参考和借鉴。
本文旨在深入研究自适应抗差UKF算法在卫星组合导航中的理论与应用,为解决导航系统在复杂环境下的性能优化问题提供新的方法和思路。
通过理论分析和实验验证,为卫星组合导航技术的发展和应用推广提供有力支持。
二、卫星组合导航系统基础卫星组合导航系统,融合了多种导航手段,旨在提高导航精度和可靠性。
其中,全球定位系统(GPS)、俄罗斯全球导航卫星系统(GLONASS)、欧洲的伽利略系统(Galileo)以及中国的北斗卫星导航系统(BDS)等是最为主要和成熟的卫星导航系统。
这些系统通过各自独特的卫星布局和信号体制,为全球范围内的用户提供位置、速度和时间信息。
在卫星组合导航系统中,关键的技术在于如何有效地融合不同导航系统的信息,以实现导航精度的提升和故障情况下的容错能力。
自适应抗差UKF在卫星组合导航中的理论与应用研究
华 中 科 技 大 学 博 士 学 位 论 文 摘 要
鉴于各种单一的导航系统都有缺点,上世纪70年代,随着电子计算机技术特别 是微机技术的迅猛发展和现代控制系统理论的进步,组合导航技术开始迅猛发展起 来,成为目前导航技术发展的重要方向之一,并在航海、航空与航天等领域有着广 泛的应用前景。对于各种不同形式的组合导航系统通常均具有以下功能:(1)超越功 能。组合导航系统能够充分利用各个子系统的导航信息,具有单个子系统不具备的 功能。(2)互补功能。由于组合导航系统综合利用了各子系统的信息,所以各子系统 能够取长补短,扩大使用范围。(3)余度功能。各子系统感测同一信息源,使测量值 冗余,提高系统的可靠性。 组合导航系统信息处理的核心是 Kalman 滤波器, 它是在两个或多个导航系统输 出的基础上,利用 Kalman 滤波去估计系统的各种误差,再用误差状态的估计值去校 正系统,达到综合的目的。Kalman 滤波在卫星导航定位以及卫星组合导航定位中的 应用是目前国内外研究的热点,抗差 Kalman 滤波、自适应 Kalman 滤波、以及它们 的改进算法包括自适应 Kalman 滤波、抗差自适应 Kalman 滤波、自适应抗差联邦滤 波都有学者进行研究和建模, 但是对于抗差无迹 Kalman 滤波(Unscented Kalman Filter, UKF)和自适应 UKF 算法的研究尚且存在空缺。 本文重点分析 UKF 滤波算法在 GPS/SINS 卫星组合导航系统中的应用现状,研 究其定位精度以及滤波算法的性能指标,针对标准 UKF 滤波算法的主要缺点提出一 种改进的抗差 UKF 滤波算法,即结合自适应估计理论的自适应抗差 UKF 滤波算法。 论文的主要内容及贡献包括: 研究卫星组合导航系统的基本原理,在组合方式的研究方面,提出了以软硬件全 组合为基础的紧组合方法,并且将此组合方式应用于 GPS/SINS 卫星组合导航系 统中,作为研究 UKF 滤波算法的系统平台。此方法能够简化组合系统的硬件设 计要求,同时提高软件的应用范围。与此同时,详细分析 GPS/INS、GPS/DR、 GPS/INS/TAN 等几种常用的卫星组合导航系统及其组合原理、组合结构图。 根据卫星组合导航系统的实际应用环境,分析总结以下几种滤波算法的优缺点, 包括Kalman滤波及其各种改进算法、粒子滤波、联邦滤波、Sage滤波、自适应滤 波、鲁棒滤波( H ∞ 滤波)以及智能滤波等。 深入研究Kalman滤波的基础理论,分析几种改进型Kalman滤波方法,包括扩展 Kalman滤波(EKF),无迹Kalman滤波(UKF),联邦Kalman滤波、抗差Kalman滤波 以及自适应Kalman滤波。重点分析UKF算法的性能优缺点,其主要优点是直接
UKF的改进算法及其在伪卫星定位中的应用
扩展 K la 滤波 ( K ) a n m E F 算法由于具有实时 进 的 U F K 算法应 用到伪卫星导航 系统 的数据处 数 据处理 能力 , 为 在 非 线 性 强度 较 弱 的 非线 性 理 中。 成
系统 动态数 据处 理时最 受欢 迎 的非线 性数 据 处理
算法 。然而 , 于强非线性 系统 , 对 线性 化的 E F 1 伪 卫星 导航 系统观测 方程 和动 力学模 型方 程 K 方法 往往会 带来 很 大 的截 断 误 差 , 至导 致 滤 波 甚 陆基伪卫星导航系统 , 由于地球 曲率 和地物
Ab t a t F rt .t e n n i e ro s r ain mo e n h y a c mo e fP e d l e n v g t n s se e e it . sr c : isl h o l a b ev t d l d t ed n mi d l s u o i a i ai y t m w r n r y n o a o t o o ded u e .Ai n t h h r o n so mi g a es o t mi g f t c UKF ag r h lo t m,an w i r v d UKF ag r h i e mp o e lo t m,b s d o h rn i l f t r i a e n te p i cp e o e - i ae l rn n q i ae t o a a c t x o b e a in e t r wa u r r . I wa h w ,b e v t n t d f ti g a d e uv n v r n e ma r f s r t a v co , s p t o wad t s s o n i e l c i i o v ol f y d r ai s i o a d c c lt n ,t a t e i rv d U lo t m o l o n y i r v h l r ge t t n a c r c ,b taS n a u ai s h t h mp o e KF ag r h c u d n to l mp o et ef t i si i c u a y u O l o i i en ma o l c nr lt e ifu n e f a u e n u l r . o to l n ] e c so me r me to t e 1 s is Ke r s u s e td ta s t n y wo d : n c n e r n l i ;UKF o u te t t n s u o i ao ;rb s si i ;p e d l e ma o t
UKF在深组合GPS_INS导航系统中的应用
∑ I = ANR (δτ − δ ) sin c ( πδfT ) cos(δφ + δf ∑ Q = ANR(δτ − δ ) sin c(πδ fT ) sin(δφ + δf
T ) 2 T ) 2
(1) (2) 图 2 理想码相关函数 Fig.2 Idealized code correlation function
式中, σ N 是相关信号 I、Q 处理后的噪声强度。
(7)
2
基于UKF的预滤波器
UKF是另外一大类用采样策略逼近非线性分布的方法。UKF以UT变换为基础,采用卡尔曼线性滤波框架采用确定性
采样策略逼近非线性分布的方法。UKF采样的粒子点(一般称为Sigma点)的个数很少,具体个数根据所选择的采样策略 而定最常用的是2n+1个Sigma点对称采样,n为状态变量维数。UKF的计算量基本与EKF算法相当,但性能优于EKF[8]。 针对预滤波器的线性系统模型和非线性测量模型的加性噪声特点,下面给出适用于加性噪声的UKF滤波方法。将式 (4) (5)离散化得到非线性系统模型:
UKF的原理
UKF
• 1、思想 • 不同于EKF对系统进行线性近似,UKF是对系统 的概率分布进行近似。 • 2、核心(UT变换)
UKF
• k是个标量,控制每个点到状态均值的距离,w为权值,且
• 这样用了更多采样点的信息,揭露出非线性系统的本质。
UKF
UKF
• 3、UKF算法
系统:
状态扩充: 初始化:
x a [ xT
X k 1 ( x k 1 , k 1)Wk 1
z k - h( x k 1 , k 1)
• • • • •
h
xk
|
x k ,k 1
xk v
对此线性系统进行常规kalman滤波。 直接线性化的缺点: 1、忽略系统高阶成分造成误差。 2、计算雅可比矩阵困难。 3、要想精确,取 x 就要小,总计算量就很大。
5 2 Rk 0
0 0.012
观测次数N=50
采样时间为t=0.5
实例分析
t=0.5
实例分析
t=0.5时,滤波值到实际值的距离差的对比,显然UKF精度优于EKF。
谢谢观赏
Make Presentation much
more fun
UKF 在INS/GPS组合导航中 的应用
目录
INS/GPS组合导航简介 KF、EKF的不足
UKF出场 实例分析
INS/GPS组合导航简介
优点:完全自主、运动参数完备、抗干扰性强
缺点:误差积累、成本较高
惯性导航系统
优点:全天候、高精度、误差不积累
缺点:缺少姿态信息、易被干扰
卫星导航系统
用GPS的高精度定位信息通过组合滤波器来标定和补偿惯 导系统的积累误差,提高导航精度。同时,利用惯导系统的速 度和加速度信息对GPS进行速度辅助,以提高GPS的抗干扰能 力以及动态性能。
强跟踪UKF滤波在SINS_GPS组合导航中的应用研究
强跟踪UKF滤波在SINS_GPS组合导航中的应用研究
陆海勇;赵伟;熊剑;赖际舟;刘建业
【期刊名称】《航空电子技术》
【年(卷),期】2008(039)004
【摘要】针对飞行器大机动条件下SINS/GPS组合导航中出现的滤波发散问题,结合UKF滤波算法,提出了一种强跟踪UKF滤波算法.它通过引入渐消因子用线调整滤波增益阵K来减小老数据的权值,相对地增加新数据的权值,提高了UKF滤波跟踪性能.仿真和实际数据解算结果表明,强跟踪UKF提高了组合导航系统对于突变状态的实时跟踪能力和滤波过程的数值稳定性,验证了该算法的有效性.
【总页数】6页(P5-10)
【作者】陆海勇;赵伟;熊剑;赖际舟;刘建业
【作者单位】南京航空航天大学自动化学院导航研究中心,南京,210016;南京航空航天大学自动化学院导航研究中心,南京,210016;南京航空航天大学自动化学院导航研究中心,南京,210016;南京航空航天大学自动化学院导航研究中心,南
京,210016;南京航空航天大学自动化学院导航研究中心,南京,210016
【正文语种】中文
【中图分类】V249.32
【相关文献】
1.一种强跟踪UKF及其在GPS/SINS深组合导航中的应用 [J], 叶晨;崔双喜
2.改进的强跟踪卡尔曼滤波器在MSINS/GPS组合导航中的应用研究 [J], 马云峰
3.容错联邦强跟踪卡尔曼滤波算法在组合导航中的应用研究 [J], 马云峰
4.改进的强跟踪UKF在组合导航中的应用研究 [J], 符强;赵鸿悦;孙希延;纪元法
F强跟踪滤波在组合导航故障诊断中的应用 [J], 程洪炳;倪世宏;黄国荣;刘华伟;姜正勇
因版权原因,仅展示原文概要,查看原文内容请购买。
基于UKF的星载GNSS地球静止卫星定轨算法
龙源期刊网
基于UKF的星载GNSS地球静止卫星定轨算法
作者:詹鹏宇范胜林熊智刘建业
来源:《现代电子技术》2012年第08期
摘要:针对星载GNSS接收机的采样间隔较长以及EKF处理非线性问题会引入线性化误差的问题,提出了利用UKF进行GEO星定轨计算的方法。
依照GEO轨道动力学特性建立了状态模型,并对星载接收机进行了可见性分析,将UKF算法应用于接收机输出信息的处理。
仿真结果表明该算法比EKF更适用于定轨计算,尤其当因采样间隔较长而使得系统非线性较强时,仍可保证定轨结果拥有较高的精度。
关键词:GNSS;地球静止卫星;定轨;无味卡尔曼滤波。
基于改进UKF的GPS非线性动态滤波研究
第2Байду номын сангаас卷 第 1 5 期
文章编号 :0 6—94 ( 08 0 0 0 0 10 3 8 20 ) 1— 19- 3
计
算
机
仿
真
20年1 08 月
基 于 改进 U KF的 GP S非 线 性 动 态 滤 波 研 究
杨 婷婷 , 廉保 旺
KE YW O DS U setdK m l r U F ; lbl oioigss m( P ) N n na R : ncne a a ft ( K ) Goa p s n yt G S ; ol e l n ie t n i e ir
1 引言
卡尔曼最初提出的滤波基本理论 只适用 于线性系统 , 并 且要求量测也必须是线性的… 。在 之后 的 1 O多年 内, uy Bc , S nhr uaaa等人致力 于研 究 卡尔曼 滤波理 论在 非线性 系统 和 非线性测量情况 下的推广 , 出 了扩展 卡尔曼 滤波 ( K ) 提 EF。 E F K 在估计 中对非线性模型进行 了一 阶线 性化 , 这样就不 可 避免地引入了较大的线性化误差 , 从而 导致 滤波器 的次优性
( 西北工业 大学 电子与信息学院, 陕西 西安 70 7 ) 10 2 摘要: 了提高动态定位精度 , 一种改进的 U F( ncne a nFl r 为 将 K U setdK l ie)算法应用在 G S非 线性动态定位 解算 中。将 ma t P U F算法与 I K (trt m rvdK la ie) K E F I ae Ipoe a nFlr 算法相结合 , e d m t 因此保持了基本 U F算法易 于实现和收敛速度快的优点 , K 同 时由于滤波值是通过迭代扩展的卡尔曼滤波机制得到 , 进而更新值能更准确 的逼 近非 线性系统状态概率密度 函数 , 有更 具 高的精度 。应用 于 G S非线性动态滤波定位 中, P 仿真结 果表明: U F算法相 比, 与 K 算法能够 明显提高定位精度 。
基于UKF的GPS定位算法
Absr t: e e t n ed Kama le aswi o lne rp o e i gTa l ei se p n in,l a i ode rde tac Th xe d l n f t rde l t n n i a r blmsusn yors re x a so i h e dngt ga d p rom a c . The UKF sad pe o e r ne f i o td f rGPS p sto i g i hi pe . Afe o m ua ig t o i n n n t s pa r i t r fr ltn he UKF ag rt , a r lto s i lo ihm e ain hp
第 3 2卷 第 4期 21 0 1年 4月
字 航 学 报
J u n 1o to a tc o r a fAsr n u is
Vo . 2 1 3 N0 4
.
Ap i rl
2 1 01
基 于 U F的 G S定 位 算 法 K P
王 康 ,刘 莉 ,杜 小菁 ,李 怀建
( 京 理 工 大 学 宇 航 学 院 ,北 京 1 0 8 ) 北 0 0 1
摘 要 :针 对 E F通 过 局 部 线 性 化 方 法 处 理 非 线 性 问 题 可 能 产 生 的精 度 下 降 问 题 , 出 了 用 U F进 行 G S K 提 K P 定 位 解 算 的方 法 。介 绍 了 U F方 法 的原 理 , 析 了 G S伪 距 方 程 的线 性 化 近 似 误 差 和 定 位 精 度 的 关 系 , 讨 论 了 K 分 P 并
利 用 U F进 行 定 位 解 算 的 有 效 性 。 采 用 “ 前 ” 型 , 用 伪 距 和 多 普 勒 观 测 量 进 行 定 位 解 算 。 利 用 S i n G S K 当 模 利 pr t P e
比例最小偏度单形采样的UKF及其在卫星定轨中的应用
。
a ) 根据 x � , Pxx , 选择 Sigma 点 采样策 略 , 得到 m Sigma 点集 {χ i } ( i = 1 , …, L ) 及对应 的权 值 Wi ,
Wi 。此处 :L 为 Si gma 点数 ; W i , Wi 分别为均值加
上 海 航 天
12 A EROSP ACE S HAN GHA I 2008 年第 5 期
文章编号 : 100621630 (2008) 0520012204
比 例 最 小 偏 度 单 形 采 样 的 U KF 及其在卫星定轨中的应用
姜伟南 , 周海银 , 段晓君 ,潘晓刚
(国防科学技术 大学 理 学院 ,湖南 长沙 410073)
摘 要 : 基于 Unscented 变换 (U T) ,在最小偏度单形采样策略中使用比例修正算法 ,提出了一种比例最小偏度 单形采样的 Unscent ed 卡尔曼滤波 ( U KF) 算法 ,用于基 于地基 观测的 低轨卫 星实时 定轨 。仿真 结果表 明 : 比例最 小偏度单形采样 U KF 的精度与比例对称采样 U KF 相当 ,但计算效率 至少 可提 高三分之一 。 关键词 :Unscented 卡尔曼滤波 ; 单形采样 ; 最 小偏 度 ; 低轨卫星 ; 实时定轨 中图分类号 :V448 . 224 文献标识码 :A
0 引言
随着航天需求和技术的发展 , 卫星轨道确定受 到了广泛关注 。实时定轨的研究多基于全球卫星定 位系统 ( GP S) 观测 , 但因我国尚无自主全球定位系 统 , 故研究基于地基观测的实时定轨技术仍具重要 意义。 近年来 , 作为一种新的非 线性估计方 法 U KF 已逐步应用于卫星定轨 。U KF 以 U T 为基础 , 卡尔 曼滤波为框架 ,通过确定性采样策略直接逼近状态 的后验分布 [1 ] 。U T 中 ,采样策略不同 , 算法的精度
UKF在GPS/INS组合导航系统中的应用
V0 . 4 NO 3 12 .
Jn 0 7 u .2 0
文 章 编 号 :6 36 3 ( 07 0 - 0 -3 17 -3 8 2 0 ) 30 0 2 0
U F在 G S IS组 合 导 航 系 统 中 的应 用 K P /N
毛 克诚 ,孙付 平 ,李 海 丰
( 信息工程大学 测绘 学院 , 南 郑州 河 40 5 ) 50 2
Ke r s u se td K l nftrUKF : xe d d K l nf tr E 1 n niersse GP / N ; T y wo d : n c ne ama l f i e 1 e ln e ama l f KF ; o l a ytm; S I S U i e n
fntu reiga dMapn ,I om t nE gnei nvrt hnzo 5 0 2 hn ) stt o S vyn n p i I i ef u g n r ai nier g U i sy f o n e i ,Z egh u4 05 ,C i a
Ab t a t E tn e a ma l rn a e n u e i ey i P n n ailitg ae a iai n u t 1 e re- sr c : x e d d K l n f ti g h s b e s d w d l G S a d i e a n e r td n vg t .b t s i a r i e n o i n
I n e r td H v g t n s se a e b i p NS i tg ae a i ai y tm r u l u .w ih d n t ey o eh p t e i o t ee rrat u eal t ro t t d n ls r h il i h
EKF/UKF在编队飞行卫星GPS相对导航中的应用
( KF) 法 同 时 应 用 于 编 队 飞 行 卫 星 的 载 波 相 位 U 算
差 分 G S相 对 导 航 。 E F与 U F算 法 原 理 不 同 , P K K U F算 法 的精 度 比 E F的 精 度 高 。在 实 际 应 用 中 , K K 可 以将 两 种 算 法 组 成 互 为 备 份 的 相 对 导 航 滤 波 器 ,
( Sm 即 i a采 样 点 ) 小 集 合 来 近 似 系 统 的 估 计 状 g 最
文 章 编 号 :64 17 ( 0 8 0 —0 70 17 —5 9 2 0 )50 5 —4
Ap i a i n o pl to fEKF/ c UK F i h PS n t e G Re a i e Na i a i n f r Fo m a i n l tv v g to o r to
测测量 , 测量 与滤 波 状 态所 具 有 的非 线性 加 剧 r 观 r
滤波 的非线性 性 , 目前 对 于非 线性 模 型 的状 态 估计 广 泛采用 E F和 U F K K 。E F采 用 非线 性 系 统 的线 K 性 化模 型 , 只能达 到一 阶 精度 。U F采 用粒 子 滤 波 K 的采样 思 路 , 过 仔 细 选 择 高 斯 随 机 变 量 采 样 点 通
第 3 4卷
第 5期
空 间 控 制 技 术 与 应 用
Ae o p c nto n Ap lc t n r s a e Co r la d p ia i o ・57 ・
20 0 8年 1 0月
Ke wo d y r s: e t n e l n fl r u s e t d Ka n n x e d d Ka ma t ; n c n e h a i e
基于双联邦UKF算法的组合导航数据融合方法
基于双联邦UKF算法的组合导航数据融合方法
基于双联邦UKF算法的组合导航数据融合方法
为了提高组合导航系统数据融合的精度和容错性,提出一种双联邦UKF组合导航数据融合方法.采用双联邦UKF滤波器的算法将JTIDS相对导航技术与成熟的GPS/INS/DVS组合导航技术相结合组成新的双联邦UKF组合导航数据融合算法.联邦UKF算法将UKF算法和分散式滤波技术相结合,精度高容错性好,JTIDS相对导航技术精度高抗干扰能力强.主滤波器1对GPS/INS/DVS组合导航信息进行融合后与JTIDS相对导航信息在主滤波器2中融合,提高了组合导航系统的可靠性和容错性.数值仿真实验表明,该算法性能优于单纯采用联邦GPS/INS组合导航算法是一种理想的组合导航滤波方法.
作者:吴志峰吴军王蕊作者单位:吴志峰,吴军(空军工程大学工程学院,西安,710038)
王蕊(东北大学材料与冶金学院,沈阳,110004)
刊名:弹箭与制导学报PKU英文刊名:JOURNAL OF PROJECTILES, ROCKETS, MISSILES AND GUIDANCE 年,卷(期):2009 29(5) 分类号:V241.62 关键词:GPS/INS/DVS/JTIDS组合导航非线性滤波联邦滤波 UKF 数据融合。
改进的强跟踪平方根UKF在卫星导航中应用
( j .C o l l e g e o f As t r o n a u t i c s , Ha r b i n I n s t i t u t e o f Te c h n o l o g y,Ha r b i n j 5 0 0 0 1,C h i n a; 2.Ae r o s p a c e Do n g f a n g h o n g De v e l o p me n t Lt d,S h e n z h e n 5 1 8 0 5 7,Ch i n a )
调 节 协 方 差矩 阵 , 使 得 滤 波 器具 有 强 跟 踪 能 力 和 克 服 系 统模 型 不 确 定 的 鲁 棒 性 , 改 善 了 滤 波 器 的 估 计 精 度 。 将 该
方 法 应 用 于卫 星 自主 导 航 系统 中 , 实验 仿 真 结 果 表 明 , 相 对 于 平 方根 UKF和 S TF, 该 方 法 不 仅 保 证 了 系统 的 可 靠 性, 还 提 高 系统 的 导航 精 度 和 改 善 系统 的 鲁棒 性 及 跟 踪 能 力 。 关键词 : 卫 星 导航 系统 ;不 确 定 性 干 扰 ;改 进 的 强跟 踪 平 方 根 无 迹 卡 尔 曼 滤 波 ; 鲁 棒 性
中 图分 类 号 : V 1 9 文 献 标 志 码 :A D O I : 1 0 . 3 9 6 9 / j . i s s n . 1 0 0 1 — 5 0 6 X. 2 0 1 5 . 0 8 . 2 2
S a t e l l i t e a u t o no mo u s na v i g a t i o n f i l t e r i ng a l g o r i t h m ba s e d o n
网址 : W WW. s y s e l e . c o i n
UKF容错滤波在脉冲星组合导航中的应用
UKF容错滤波在脉冲星组合导航中的应用杨成伟;郑建华;高东【摘要】针对X射线脉冲星组合导航系统中测量野值导致的导航精度下降问题,利用基于残差正交性的Unscented Kalman Filter (UKF)容错滤波方法进行野值修正.在深空巡航段,采用基于X射线脉冲星和太阳观测的组合导航方式,用X射线探测器测量脉冲星光子到达时间,利用太阳敏感器测量太阳视线方向矢量,并利用联邦滤波结构进行信息融合.仿真结果表明,基于UKF的容错滤波算法在脉冲星组合导航系统的应用中,能够对野值进行实时修正,避免了导航精度下降,提高了系统的鲁棒性和工程实用价值.【期刊名称】《中国惯性技术学报》【年(卷),期】2014(022)006【总页数】4页(P759-762)【关键词】脉冲星;太阳敏感器;UKF滤波;野值检测;容错滤波【作者】杨成伟;郑建华;高东【作者单位】北京理工大学机电学院,北京100081;中国科学院空间科学与应用研究中心,北京100190;中国科学院空间科学与应用研究中心,北京100190【正文语种】中文【中图分类】V448.224在深空探测活动中,往往存在时间延迟和精度不高的问题,而且地面测控资源有限,因此深空探测需要自主导航技术的支撑。
X射线脉冲星自主导航技术具有高精度、高自主性的特点,是一种很有应用前景的航天器自主导航技术。
该技术也将在美国宇航局NICER任务[1]中得到验证,我国也在积极开展相关的研制工作[2]。
然而,在长时间的深空飞行中,由于空间中太阳活动、宇宙射线、星际尘埃、元件故障等多种未知因素的影响,导航敏感器得到的探测信息中很容易存在野值,导致滤波结果变差,甚至发散,严重影响航天器在深空中的自主飞行安全。
因此,需要研究基于野值检测和信息修正的容错滤波方法在X射线脉冲星自主导航中的应用。
目前对X射线脉冲星自主导航容错滤波方法的研究仍相对较少。
文献[3]利用鲁棒滤波修正星表误差,但没有考虑野值因素的影响。
无迹滤波(UKF)实现GPS、INS紧组合 、INS辅助GPS跟踪、超紧组合
一利用无迹滤波(UKF )实现GPS/INS 紧组合1> 要求:程序调通后可以输出状态量中的任一维。
状态向量X=[X I X G ]T z y x rz ry rx bz by bx U N E U N E I h L V V V X ],,,,,,,,,,,,,,,,,[,∇∇∇=εεεεεεδδλδδδδφφφ,分别代表姿态角,速度,位置,()[]T G u ru X t t t δδ=2>原理(1) 状态方程:()()()()0()00()0()()()()I I I I I G G G G G X t X t W t F t G t F t G t X t W t X t ∙∙⎡⎤⎡⎤⎡⎤⎡⎤⎡⎤⎢⎥=+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦⎣⎦⎢⎥⎣⎦ )()()()()(t W t G t X t F t X II I I I += 18180⨯⎥⎦⎤⎢⎣⎡=M s NI F F F F L h R V L W F N Eie N tan sin )2,1(++= )cos ()3,1(hR V L W F N Eie N ++-= hR F M N +-=1)5,1( )tan sin ()1,2(L hR V L W F N Eie N ++-= hR V F M NN +-=)3,2( hR F N N +=1)4,2( L W F ie N sin )7,2(-=hR V L W F N Eie N ++=cos )1,3( hR V F M NN +=)2,3(L hR F N N tan 1)4,3(+=L hR V L W F N Eie N 2sec cos )7,3(++= U N f F -=)2,4(U N f F =)3,4(hR VL h R V F M U M N N +-+=tan )4,4( L h R V L W F N Eie N tan sin 2)5,4(++= )cos 2()6,4(hR V L W F N Eie N ++-= U ie N NE N ie N LV W L hR V V LV W F sin 2sec cos 2)7,4(2++-= U N f F =)1,5( E N f F -=)3,5()tan sin 2()4,5(L hR V L W F N Eie N ++-= h R V F M UN +-=)5,5( hR V F M NN +-=)6,5( N N f F -=)1,6(E N fF -=)2,6()cos (2)4,6(hR V L W F N Eie N +-= hR V F M NN +=2)5,6(L W V F ie E N sin 2)7,6(-=h R F M N +=1)5,7( hR LF N N +=sec )4,8( L L hR V F N EN tan sec )7,8(+=1)6,9(=N F ⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡=⨯⨯⨯⨯⨯⨯333333333333000000n b n b n bs C C C F ⎭⎬⎫⎩⎨⎧------=aU aNaErUrNrE M T T T T T T g di F 111111000a n b C 为姿态矩阵量测方程:采用伪距、伪距率组合()()()()()()()Z t H t v t X t Z t H t v t ρρρρρρ⎡⎤⎡⎤⎡⎤=+⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦(2)滤波模型: 时间更新:1|,201|1|201|1|,1|1|,1|1|ˆ),()ˆ)(ˆ(ˆˆ-=--=------∑∑==+--==k k i ni i k k k k k k ni T k k k k i k k k k i i k k k k k y W yk x h y Q x x xx W P x F x量测更新:Tky y k k k k k k k k y y y x k ni T k k k i k k k i i y x ni kT k k k i k k k i i y y K P K P P y y K x xP P K y y xx W P R y y y y W P k k kk k k k k k k ~~1~~201|,1|,201|,1|,~~)ˆ(ˆˆ]ˆ][ˆ[]ˆ][ˆ[-=-+==--=+--=-=--=--∑∑二INS 辅助GPS 跟踪1>要求:INS 辅助后的GPS 接收机的跟踪环路里的同相、正交支路、鉴相器的输出作对比,能够输出类似曲线:2>原理:加入INS 辅助后(只画了I P 路和Q P 路)多普勒频移估计计算公式:d s rec dopp eV V f ⋅-⋅=)(1λλ=载波的波长;rec V =载体的速度;s V =卫星的速度;d e=卫星到用户连线方向的单位矢量。
UKF联合滤波器在车辆定位系统中的应用
UKF联合滤波器在车辆定位系统中的应用曹洁;杨荣荣;张玲【期刊名称】《计算机仿真》【年(卷),期】2008(025)003【摘要】传统的应用于GPS/DR组合定位系统中的联合卡尔曼滤波器都是由扩展卡尔曼滤波器(EKF)构成,而EKF具有滤波收敛速度慢、对系统模型误差和噪声统计特性的鲁棒性差和实际中难以实施等缺点,这些对联合卡尔曼滤波器的整体滤波性能和实用性都会产生不利影响.针对这一问题,通过用无迹卡尔曼滤波器(UKF)来替代EKF构成一种新型的基于UKF的联合卡尔曼滤波器,并将这种联合滤波器应用于GPS/DR车辆组合定位系统中.通过详细的计算机仿真和分析后,结果表明与传统的基于EKF的联合卡尔曼滤波器相比 ,该联合卡尔曼滤波器的滤波精度、收敛速度、鲁棒性、实用性和可靠性都得到了很大的改善,满足了定位系统低成本和高精度的要求,具有一定的应用价值.【总页数】5页(P262-266)【作者】曹洁;杨荣荣;张玲【作者单位】兰州理工大学电气工程与信息工程学院,甘肃,兰州,730050;兰州理工大学电气工程与信息工程学院,甘肃,兰州,730050;兰州理工大学机械工程与电子工程学院.甘肃,兰州,730050;兰州理工大学机械工程与电子工程学院,甘肃,兰州,730050【正文语种】中文【中图分类】U666.12【相关文献】1.改进UKF算法在移动机器人定位系统中的应用 [J], 任福君;张秀华;姜永成;孙忠伟F滤波器在非线性组合信号系统中的应用研究 [J], 刘罗仁;罗金玲3.一种自适应联合卡尔曼滤波器及其在车载GPS/DR组合导航系统中的应用研究[J], 房建成;申功勋;万德钧4.简化SSUKF在车载SINS行进间对准中的应用 [J], 贾继超;李岁劳;夏家和;冷月香;肖春雨F滤波方法及其在车辆导航状态估计中的应用(英文) [J], 张传斌;田蔚风;金志华因版权原因,仅展示原文概要,查看原文内容请购买。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
o p c- o n SC mp trE g er g a d Ap l ain ,0 84 (3 :1 - 1 . n sa e b r eGP .o ue n i ei n pi t s2 0 。4 3 )2 5 2 7 n n c o
Ab t a t L n a iain e r r i i t d c d i h i e rz t n p o e s o x e d d Kama i c n l a i e g n e o h KF T sr c : i e r t ro S nr u e n t e l a ia i rc s f e t n e l n,t a e d d v r e c f t e 北京航 空航天大学 宇航学院 , 北京 1 0 8 003 2中北大学 电子 与计算机科学技术学院 , . 太原 0 0 5 3 0 1
1 colo eoa t sB in nvrt o eoa t sad A t nui , e i 0 0 3 C ia . ho fA rnui , e igU i sy fA rnui n s oat sB in 1 0 8 ,hn S c j e i c r c jg
摘
要 : 于扩展卡 尔曼滤波在 非线性 系统中由于线性化过程 引入 了线性化误差 , 而导致 滤波器性 能下降甚 至造成滤波发散的 对 从
情况, 利用 U setd卡 尔曼滤波器对 非线性 系统进 行直接滤波 , ncne 该方法无需对 非线性 系统进行线性化 , 避免 了线性化误差。并将
该算 法用 于星载 G S低轨卫星定轨 中, P 建立 了仿 真模 型 , 在初 始条件相 同的情 况下 , E F算法仿真结果相 比较 , 与 K 结果表 明在 一
o e c me t i l tt n, v r o h s i a i UKF a g r h i u e i cl o n n i e r s se i h s p p r i e r ain i o e d d t o ln a mi o l o t m s s d d r t t o l a y tm n t i a e . n a i t s n t n e e o n n i e r i e y n L z o s se a S i e rz t n ro S od dT i l o i m i u e i o bt d t r n t n b s d o s a e b r e y tf 。O l a iai er r i n o v i e .h s g r h a t S s d n r i e e mi ai a e n p c — o n GP e lt n mo e o S, mu a i d l o
C m u rE gn ei n p l ai s o p t n ier g ad A pi t n 计算机工程与应用 e n c o
U F算法在星载 G S低轨卫星定轨中的应用 K P
吴 志华 t, . 申功 勋 , - 丁杨斌
W U h  ̄ u , HEN Go g x n , N Ya g b n Z ih a S n - u DI G n - i
2I si t f E e to i n mp tr S in e a d T c n lg Not i est f C i a T iu n 0 0 5 C i a . t u e o lcr n c a d Co u e c e c n e h oo y, r Un v ri o h n , ay a 3 0 h n n t h y 1, E ma l z i u w @1 3 c m — i: h h a u 6 . o
i sa l h dUn e h a n t l c n i o t e p r r n e o KF a d UKF a e o a e y s lt n. s s o n t e p r S e tb i e . d r t e s me i i a o d t n. e o ma c f E n s i i h f r c mp r d b i ai i i h w h e — mu o t fr n e o o ma c fUKF a g rt m S mo e p e ie a d h s h g e c u a y i r i d t r i ain u d rt e c r i b e v t n n i e e. lo h i i r r cs n a ih ra c r c n o b t e e n t n e h e t n o s r a i o s lv 1 m o a o e Ke r s n n i e r s s m ; s e t d Kama i e ;p c _ OT S ob t d tr i a in y wo d : o l a y t n e Un c n e l n F l r s a e b 1 e GP ; r i ee n t t l m o
_
W U Zh - u , HEN n x n, NG Ya g b n Un c n e Ka ma f t r 、ih a p ia i n o o b t d t r n t n b s d ih a S Go g- u DI n - i. s e td l n i e v t p l t t r i e e mi a i a e l c o o