基于VB-AUKF的GNS...INS组合导航信息融合算法_孙玉梅.pdf
《基于VB-AUKF的GNS...INS组合导航信息融合算法_孙玉梅.pdf》由会员分享,可在线阅读,更多相关《基于VB-AUKF的GNS...INS组合导航信息融合算法_孙玉梅.pdf(8页珍藏版)》请在咨信网上搜索。
1、书书书第 43 卷第 3 期2023 年 6 月弹箭与制导学报Journal of Projectiles,ockets,Missiles and GuidanceVol.43 No.3Jun.2023DOI:10 15892/j cnki djzdxb 2023 03 001收稿日期:2023 02 08基金项目:山东省重点研发计划(2020CXGC010701);山东省自然基金(Z2020MF154,Z2016FM28);高层次人才科研启动项目(KJC2022009)资助作者简介:孙玉梅(1974),女,教授,硕士,研究方向:导航新技术、智能检测和信息处理。通信作者:潘新龙(1983),男
2、,副教授,博士,研究方向:信息融合及导航新技术。引用本文:孙玉梅,潘新龙,王美春 基于 VB-AUKF 的 GNSS/SINS 组合导航信息融合算法 J 弹箭与制导学报,2023,43(3):1-8SUN Yumei,PAN Xinlong,WANG Meichun Information fusion algorithm of GNSS/SINS integrated navigation system based on VB-AUKFJ Journal ofProjectiles,ockets,Missiles and Guidance,2023,43(3):1-8基于 VB-AUKF 的
3、 GNSS/SINS 组合导航信息融合算法孙玉梅1,潘新龙2,王美春1(1潍坊科技学院计算机学院,山东 潍坊262700;2海军航空大学,山东 烟台264001)摘要:针对 GNSS/SINS 组合导航系统的标准无迹卡尔曼滤波 UKF 算法不能自适应调节量测噪声均方差的缺陷,首先提出了该组合导航系统的变分贝叶斯自适应 UKF 算法(variational bayesian adaptive UKF,VB-AUKF),然后建立了 VB-AUKF 算法的量测噪声均方差迭代估计模型;最后针对影响变分贝叶斯估计精度的 3 个参数及基于 VB-AUKF 算法的组合导航系统进行理论仿真计算。结果表明:VB
4、-AUKF 算法的调节因子是决定量测噪声均方差估计精度的关键因素,其他2 个参数的选择仅仅影响量测噪声均方差估计初值;当量测噪声均方差发生变化时,VB-AUKF 算法可以自适应估计量测噪声均方差;相对于标准 UKF 算法,VB-AUKF 算法可以提高位置及速度精度约为12%及51%,同时大幅提高姿态估计精度。关键词:变分贝叶斯;调节因子;组合导航;无迹卡尔曼滤波中图分类号:V249 3文献标志码:A文章编码:1673-9728(2023)03-0001-08Information Fusion Algorithm of GNSS/SINS IntegratedNavigation System
5、 Based on VB-AUKFSUN Yumei1,PAN Xinlong2,WANG Meichun1(1School of Computer Science,Weifang University of Science and Technology,Weifang 262700,Shandong,China;2Naval Aviation University,Yantai 264001,Shandong,China)Abstract:This paper firstly proposes a variational Bayesian adaptive UKF algorithm(VB-
6、AUKF)for this integrated navigationsystem,aiming at the defect that the standard UKF algorithm of GNSS/SINS integrated navigation system cannot adaptively ad-just the root mean square(MS)of measurement noise Then,an iterative estimation method for MS of measurement noise isproposed in VB-UKF algorit
7、hm Finally,a lot of theoretical simulation experiments are carried out for the three parameters thataffect the accuracy of the variable Bayesian estimation and the integrated navigation system based on VB-AUKF algorithm Theexperimental results show that the moderating factor of VB-AUKF algorithm is
8、the key factor to determine the estimation accura-cy of the MS of the measurement noise,while the other two parameters only affect the initial value of the MS estimation ofthe measurement noise;the VB-AUKF algorithm can adaptively estimate this MS when the MS of measurement noise chan-ges;and compar
9、ed with the standard UKF algorithm,the VB-AUKF algorithm can improve the accuracy of position and velocityby about 12%and 51%,and greatly improve the accuracy of attitude estimationKeywords:variational Bayesian;adjustment factor;integrated navigation system;unscented Kalman filter0引言经典线性卡尔曼滤波采用线性高斯状
10、态空间模型,是 GNSS/SINS 组合导航系统经常采用的信息融合方式1。当系统的非线性比较严重时,扩展卡尔曼滤波(EKF)的估计不准确,而无迹卡尔曼滤波(UKF)可以降低 EKF 线性化带来的误差,可以将组合导航系统扩展到非线性滤波模型2。然而,UKF 方法的一个严重缺陷是假设准确的系统模型及已知的先验噪声统计特性,而这个假设在实际环境下不成立3。自适应滤波是解决上述问题的有效方法,在估计系统状态参数的同时也可以估计噪声统计特性。而贝叶斯方法是目前最普遍应用的方法,包括协方差匹配法、极大似然法均为贝叶斯方法的近似方法4。而变分贝叶斯方法具有较低的计算成本,可以近似求解贝叶斯方法中高度耦合的高
11、维隐变量的后验推理,近弹 箭 与 制 导 学 报第 43 卷年来在诸多领域得到应用,如情报监测5、目标跟踪6、雷达系统7 等。近年来,将变分贝叶斯方法与线性卡尔曼滤波技术相结合而形成的 VB-KF 算法在组合导航系统也得到较深入的研究8。如:文献 8-9 将 VB-KF 技术应用于 GNSS/SINS 组合导航系统;文献 10、文献 11分别将 VB-KF 技术应用于同步与异步多传感器组合导航系统;针对 VB-KF 技术对噪声跟踪性能差的问题,文献 12-13 提出了基于 T 分布的变分高斯滤波算法,但是该方法将量测噪声建模为 T 分布、导致不能单独调节噪声方差内独立变化的噪声。同时,上述文献
12、的共同特点是采用线性卡尔曼滤波方法,无法有效解决模型误差导致的滤波精度下降问题。为此,文中将变分贝叶斯方法与 UKF 算法相结合,在对 GNSS/SINS 组合导航系统进行变分贝叶斯自适应 UKF 非线性滤波建模的基础上,提出了量测噪声方差自适应估计的迭代模型。1变分贝叶斯估计模型对于状态方程非线性而量测方程线性的离散时间非线性系统10:Xk=f(Xk 1,uk,Wk)Zk=HkXk+vk(1)式中:uk为系统确定性输入项;量测噪声向量 vkN(0,k)代表服从均值为 0、方差矩阵为 k的高斯分布;系统噪声向量 Wk N(0,Qk)也是高斯过程噪声;Zk是一个 d 维量测向量;Xk是一个 n
13、维状态向量,其初始状态服从均值为 X0、方差矩阵为 P0的高斯先验分布;k 代表时间序列。对于式(1)模型,如果 k是时变的或未知的,则贝叶斯最优滤波的目标是计算系统状态和量测噪声方差矩阵的联合后验分布 p(Xk,k|Z1 k),此时该滤波过程包含以下步骤14-15:1)初始化:计算系统状态和量测噪声方差矩阵的先验分布 p(X0,0)。2)预测:系统状态向量 Xk与测量噪声方差矩阵k的 联 合 预 测 分 布 由 Chapman-Kolmogorov 方 程给出16:p(Xk,k|Z1 k1)=p(Xk|Xk1)p(k|k1)p(Xk1,k1|Z1 k1)dXk1dk1(2)3)更新:给定下一
14、个测量值 Zk,通过贝叶斯规则将上述预测分布更新为后验分布:p(Xk,k|Z1 k)p(Zk|Xk,k)p(Xk,k|Z1 k1)(3)式(2)、式(3)所涉及的积分通常是无法解析处理的,可利用后验变分近似表示为17:p(Xk,k|Z1 k)=QX(Xk)Q(k)(4)其中:QX(Xk)explog p(Zk,Xk,k|Z1 k1)Q(k)d()kQ(k)explog p(Zk,Xk,k|Z1 k1)QX(Xk)dX()k(5)式(5)中两个方程相互耦合,为此,对两个方程的期望进行评估及参数匹配,得到密度:QX(Xk)=N(Xk|mk,Pk)Q(k)=di=1IG(2k,i|k,i,k,i)(
15、6)则式(2)、式(3)变为16:p(Xk,k|Z1 k1)=N(Xk|Xk|k1|,Pk|k1)di=1IG(2k,i|k|k1,i,k|k1,i)(7)p(Xk,k|Z1 k)=N(Xk|Xk|kPk|k)di=1IG(2k,i|k|k,i,k|k,i)(8)其中:N()和 IG()分别代表高斯分布和逆伽马分布;Xk|k,Xk|k 1,Pk|k,Pk|k 1分别代表状态向量 Xk的滤波估计值、一步预测值阵、估计均方误差矩阵、一步预测均方误差矩;k,i,k,i可以由式(9)计算得到:k,i=12+k 1,ik,i=k 1,i+12(Zk HkXk|k 1)2i+(HkPkHTk)ii)(9)
16、则 k的估计值 k可表示为:k=diagk,1k,1,k,2k,2,k,dk,()d(10)为了使观测噪声的变化规律具有自适应调整特性,引入因 子 i(0,1。对 于 i=1,2,d,则有16:k,i=ik 1,ik,i=ik 1,i(11)2基于变分贝叶斯的组合导航 UKF算法2 1变分贝叶斯 UKF 算法根据系统模型,将标准 UKF 算法与变分贝叶斯估计模型相结合,得到组合导航系统的基于变分贝叶斯的自适应 UKF 算法(VB-AUKF):2第 3 期孙玉梅等:基于 VB-AUKF 的 GNSS/SINS 组合导航信息融合算法对于式(1)所示的非线性系统,将系统状态和系统噪声进行合并,得到增
17、广状态向量:Xa=XWTa=(X)T(W)TT(12)式中:a,X和 W分为 Xa,Xk和 Wk的采样点向量,假设其维数分别为 N,Lx,Lw,则 N=Lx+Lw。步骤 1:初始化X0=E(X0)P0=E(X0 X0)(X0 X0)T)Xa0=E(Xa)=XT00TPa0=E(Xa)=E(Xa0 Xa0)(Xa0 Xa0)T)=P00Q(13)步骤 2:样点计算a0,k 1=Xak 1ai,k 1=Xak 1+(N+)Pak1)i,i=1,2,Nai,k 1=Xak 1(N+)Pak1)i,i=N+1,N+2,2N(14)其中:(N+)Pak1)是矩阵(N+)Pak 1的平方根(Cholesk
18、y 分解)矩阵的第 i 列。Wm0=N+Wc0=N+(1 2+)Wmi=Wci=12(N+),i=1,2,2N(15)其中:=2(N+)N;,和 为比例因子。步骤 3:时间更新k|k 1=k 1|k 1k|k 1=k 1|k1(16)Xi,k|k1=f(Xi,k1,Wi,k1)Xk|k1=2Ni=0WmiXi,k|k1(17)Pk|k1=2Ni=0Wci Xi,k|k1 Xk|k1 Xi,k|k1 Xk|k1T(18)其中:=12dT;=12dT;=12dT。步骤 4:量测更新Zk|k 1=HXk|k 1(19)k|k=12+k|k 1(20)首先,设定(0)k|k=k|k 1,然后迭代以下几
19、个步骤,比如 j 步:(0)k=diag(0)k|kk|k)(21)X(j)k=Xk|k 1+Pk|k 1HTk(HkPk|k 1HTk+(j 1)k)1(Zk Zk|k 1)(22)P(j)k=Pk|k 1 Pk|k 1HTk(HkPk|k 1HTk+(j 1)k)1HkPk|k 1(23)(j)k|k=k|k 1+(Zk HkX(j)k)(Zk HkX(j)k)/2+diag(HkP(j)kHTk)/2(24)式(21)式(24)中,1jJ。最后,定义 k|k=(N)k|k,Xk=X(N)k,Pk=P(N)k。从以上模型可知,在估计量测噪声的方差矩阵 k时,参数,的选择决定了 k的估计精度
20、。2 2GNSS/SINS 组合导航系统模型GNSS/SINS 组合导航系统非线性滤波的状态方程采用 SINS 的力学方程,组合导航系统的导航参数直接选取为被估计的状态。选取“东北天”地理坐标系为导航坐标系,则连续时间系统的状态方程为:X(t)=f(X(t),bib,fb,t)X(t)=TvTpTT(25)式中:fb,bib分别表示加速度计输出、陀螺仪输出;代表三维姿态向量;v 代表三维速度向量;p 代表三维位置向量;t 代表时间。选取 GNSS 接收机输出的三维速度和三维位置直接作为观测向量,则量测方程可以表示为:Z(t)=H(t)X(t)+V(t)Z(t)=vEvNvULHTH(t)=06
21、 3I6 6(26)对式(25)、式(26)进行离散化处理可以得到离散化的状态方程及量测方程。3仿真结果与分析在 Matlab 环境下进行仿真,首先评估参数,的取值对量测噪声未知均方差估计的影响,然后评估GNSS/SINS 组合导航系统 VB-AUKF 算法的滤波性能。3 1仿真条件以飞行器作为仿真对象,其飞行过程包含各种机动运动。初始位置为(118E,29E,50 m),仿真时间为 3 600 s;滤波周期为 1 s。初始参数设置如表 1所示。3弹 箭 与 制 导 学 报第 43 卷表 1导航传感器误差参数设置Table 1Navigation sensor error parameter
22、settingParameter itemParameter valueWork cycle/sAccelerometer drift100 g0 02Accelerometer random work10 g/Hz0 02Gyro drift3/h0 02Gyro random work0 3/h0 02GNSS velocity error0 2 m/s(1)1GNSS position error8 m(1)1根据表 1 所示的 GNSS 误差设置,则正常情况下GNSS 量测噪声的均方差为:rroot=sqrtm()=diag(0 20 20 2888)(27)其中函数 sqrtm()的
23、功能是对矩阵中每个元素取开平方。为了验证系统算法性能,在飞行器飞行期间设定GNSS 量测噪声均方差变化为:rreal=6rroot600 t1200rroot 1+9sin 2t 2200()()20002000 t3000rroot其他(28)3 2仿真校验以下的仿真实验均是以相同的导航仿真原始数据为基础,对式(21)式(24)的迭代步数取 j=2。3 2 1参数 对未知方差估计的影响为了评估 对量测噪声未知方差估计精度的影响,首先使得,的取值不变并设定为:=111111=0 30 30 3666(29)对参数 的取值,定义方案 A:方案 A1:=085085085085085085方案 A
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 VB AUKF GNS INS 组合 导航 信息 融合 算法 孙玉梅
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。