基于四元数非线性滤波的飞行器姿态确定算法研究

被引量 : 0次 | 上传用户:flscut
下载到本地 , 更方便阅读
声明 : 本文档内容版权归属内容提供方 , 如果您对本文有版权争议 , 可与客服联系进行内容授权或下架
论文部分内容阅读
飞行器姿态确定是飞行器姿态控制的关键技术之一,姿态确定的精度直接影响到飞行器姿态控制的精度。姿态确定的精度不仅取决于姿态测量系统硬件配置的性能与精度,还与所采用的姿态确定算法密切相关。姿态描述参数是姿态确定系统建模的前提和基础。常用的姿态描述参数主要有欧拉角,修正罗德里格斯参数,方向余弦,四元数等。四元数因其计算量小、具有全局非奇异性而得到广泛应用,然而四元数必须遵循规范化要求,如何克服规范化限制,使其能与先进的非线性滤波算法相结合成为目前姿态确定算法中亟待解决的问题。本文在回顾总结常用非线性滤波算法的基础上,研究基于四元数非线性滤波的飞行器姿态确定算法。论文主要研究内容如下:首先针对几种常用的姿态描述参数分别建立相应的姿态运动学方程,给出这几种参数之间的转换关系;针对陀螺和星敏感器这两种姿态量测传感器,建立相应的传感器量测模型,在此基础上建立飞行器姿态确定系统状态空间模型。从贝叶斯最优估计出发,深入研究基于高斯分布假设和非高斯分布假设的两类非线性滤波算法。主要包括扩展卡尔曼滤波(Extended Kalman Filter, EKF)算法,无迹卡尔曼滤波(Unscented Kalman Filter, UKF)算法,粒子滤波(Particle Filter, PF)算法及其改进算法。深入分析四元数非线性滤波所遇到的问题和困难。其中,针对四元数加权均值计算问题,在研究分析奇异值法和特征向量法的基础上,提出一种拉格朗日代价函数法求解均值四元数。该方法从均值四元数意义出发,利用MMSE准则构造四元数代价函数,利用拉格朗日乘函,保证代价函数中四元数的规范性,最终将四元数均值计算问题转化为代价函数最小时的向量求解问题。在分析和解决四元数非线性滤波问题基础上,提出无需姿态参数切换的四元数UKF(Quaternion UKF, Q-UKF)算法。其中,在选取姿态变量时,只取四元数的向量部分,而标量部分通过单位四元数约束条件给出。这样不仅解决了扰动四元数Sigma的选取问题,而且也降低了滤波状态的维数,减小了滤波的运算量。针对Q-UKF算法存在的数值稳定性问题,结合平方根UKF算法,提出一种四元数平方根UKF算法。基于陀螺/CCD的仿真实验证明了这些算法的有效性。针对噪声非线性传递时UKF算法滤波精度下降问题,研究了扩维UKF(Augmented UKF, AUKF)算法。AUKF算法虽然提高了滤波精度和稳定性,但同时也带来了状态维数倍增,计算负担过重的问题。针对此,提出一种量测和过程不相关的状态切换UKF(State Switching UKF, SSUKF)算法。该算法通过在时间更新和量测更新阶段,选取不同的状态变量,降低了实时滤波状态维数及Sigma点的选取个数,减小了计算量,提高了运算速度。在SSUKF算法的基础上,进一步提出了用于飞行器姿态确定的四元数状态切换UKF (Q-SSUKF)算法。基于陀螺/CCD的仿真实验结果表明,与四元数全维UKF (Q-AUKF)算法相比,四元数状态切换UKF算法一定程度上节约了滤波时间,提高了系统的实时性。针对非线性非高斯情况下的姿态确定问题,在姿态参数切换粒子滤波算法基础上,提出一种无需姿态参数切换的四元数粒子滤波(Quaternion Particle Filter, Q-PF)算法。其中,针对正则化过程中扰动四元数规范化问题,从四元数协方差阵的迹出发,给出了扰动四元数点求解方法。在四元数粒子滤波算法的基础上,本文给出两种改进四元数粒子滤波算法。其中,考虑飞行器姿态确定系统为典型的线性/非线性混合系统,结合边沿粒子滤波思想,提出了四元数边沿粒子滤波算法(Quaternion Rao-blackwellized Particle Filter, Q-RPF)。该算法将系统分为线性和非线性两部分分别采用不同的滤波算法,一定程度上节省了滤波时间。针对重要性概率密度函数为先验概率密度函数时忽略当前观测信息而导致滤波精度下降的问题,在无迹粒子滤波算法的基础上,提出四元数无迹粒子滤波(Quaternion Unscented Particle Filter, Q-UPF)算法。针对陀螺/CCD的姿态仿真实验证明了该算法的有效性。
其他文献
识字教学,应掌握"汉字学基础"知识,重视字形教学,科学理解字义,讲究具体方法,才能有效地提高识字教学质量。
股权分置改革后,定向增发因操作流程简洁、准入门槛较低以及发行费用少等优势,受到市场的广泛认可并成为了我国资本市场上股权再融资的最主要模式。然而,这一在资本市场广受
鸡枞菌(Termitomyces albuminosus (Berk.) Heim., TA)是四川省凉山州著名的一种食用菌,因其富含多种营养成分,味道鲜美,因而受到人们的关注。对于鸡枞菌多糖(TAP)的提取纯化
“阳光体育”自2007年在全国大中小学开展以来,各个学校积极响应,并结合学校实际情况开展各种形式的阳光体育活动,深入贯彻落实《中共中央、国务院关于加强青少年体育增强青
本文利用国内附加值指标(DVS)衡量国际生产分割中"国内成分"相对"国外成分"的比重,并将DVS指标引入到传统的汇率传递模型中考察了我国21类61章CH商品在1998~2007年间季度出口
国以民为本,民以食为天,食以安为先。食品安全关系到国计民生,社会稳定。近年来,我国的食品安全政府监管工作不断加强,但重大食品安全事件仍时有发生,这说明当前我国的食品安
当今世界正处于百年未有之大变局,世界秩序和国际格局发生深刻调整和变化。以中俄等为代表的新兴经济体崛起,世界多极化势头强劲。以美欧为代表的西方发达经济体影响力日渐式
本文结合《骑牛比赛》这篇课文来谈谈语用在课堂教学中的具体体现。在读中品味,读中思索,在阅读中挖掘语用。在问中思辨,问中质疑,在交流中体味语用。在写中感悟,写中创作,在
从当前建筑施工行业状况与安全事故案例深刻剖析建筑施工潜在的安全隐患问题,提出反"三违"仅仅是安全生产的基础,是对生命最基本的保障,而管理上的缺陷和漏洞才是影响安全、