CKF及鲁棒滤波在飞行器姿态估计中的应用研究

来源 :哈尔滨工程大学 | 被引量 : 8次 | 上传用户:lcg315
下载到本地 , 更方便阅读
声明 : 本文档内容版权归属内容提供方 , 如果您对本文有版权争议 , 可与客服联系进行内容授权或下架
论文部分内容阅读
飞行器姿态估计技术是航天领域的关键技术之一,由陀螺与星敏感器组成的飞行器姿态估计系统由于测姿精度高、可靠性好以及自主性强等优点得到了广泛的应用。针对该姿态估计系统,四元数由于计算简单,无三角函数的运算,同时又能避免欧拉角的奇异性问题,因此作为系统的姿态描述参数。为提高姿态估计的精度以及姿态估计系统的适应能力和鲁棒性,非线性滤波算法提供了强有力的基础保障。容积卡尔曼滤波(Cubature Kalman Filter,CKF)是一种性能优越的非线性滤波算法,具有实现简单,数值稳定性好以及在高维情况下滤波精度高、收敛性好等优点。同时,考虑不同环境下姿态估计系统模型可能存在模型不确定、量测丢失、量测延迟等复杂情况,鲁棒滤波是一种有效的设计手段。因此,本文对CKF及鲁棒滤波在飞行器姿态估计中的应用进行了深入研究:介绍了飞行器姿态估计以及非线性滤波的一些基础理论。在介绍飞行器姿态估计系统姿态描述参数以及姿态传感器的测量模型基础上,建立基于四元数的陀螺与星敏感器姿态估计模型。接着,在贝叶斯最优滤波的理论框架下,对扩展卡尔曼滤波、无迹卡尔曼滤波以及CKF这三种次优非线性滤波进行理论上的比较,分析了它们在高维情况下的估计性能以及数值稳定性,为进一步的CKF在飞行器姿态估计中的应用提供理论依据。针对姿态估计模型中四元数存在规范化约束的情况,提出一种基于加性四元数约束的CKF姿态估计算法。根据最优滤波理论,在最小均方误差估计准则的条件下,将四元数约束转化为滤波增益约束,构造最小约束代价函数实现对滤波增益的校正,从而解决四元数规范化问题。然后利用三阶球面-相径容积规则来近似计算系统状态的后验均值和协方差,从而得到四元数约束下的CKF滤波公式。同时,考虑四元数本质上是旋转矢量而非一般向量,存在着乘性特性,利用四元数进行乘性滤波时,存在着四元数加权均值计算问题,提出一种基于四元数平方根CKF姿态估计算法。该算法采用一种相对简单的拉格朗日代价函数法来求解四元数加权均值,并采用容积卡尔曼滤波理论来提高估计精度与收敛速度,同时引入平方根的形式,提高滤波算法的稳定性。指出现有的迭代CKF在每一步迭代中都是假设量测噪声与状态及状态估计不相关存在局限性,在一定程度上影响了状态估计的精度,提出了一种改进的迭代CKF算法,并将其应用于姿态估计系统中,给出了一种基于四元数约束的容积点迭代CKF姿态估计算法。该算法采用三阶球面-相径容积规则近似非线性函数的均值与方差,利用状态扩维理论来解决量测迭代中量测噪声与状态相关的问题,同时提出一种新的容积点迭代策略,即在量测迭代过程中直接采用容积点迭代,避免每步迭代都进行均方根计算来产生容积点,克服传统迭代策略是基于高斯近似产生采样点的局限,有效的降低扩维带来的计算量。并针对姿态估计存在四元数约束的问题,在每步迭代中利用增益校正的方法,保证四元数的规范化。针对姿态估计滤波算法在模型失配、未知干扰或状态突变等情况下存在精度低、鲁棒性差的缺点,提出了一种基于四元数约束的多重次渐消因子的强跟踪CKF姿态估计算法。该滤波算法,克服单渐消因子对多变量跟踪能力差、估计精度差的局限性,通过引入两个多重次渐消因子对预测误差协方差阵进行调整,使得不同的滤波通道具有不同的调节能力,保证预测误差协方差阵的对称性,从而实现滤波算法强跟踪性。同时考虑四元数归一化的限制,对滤波增益进行调整使得状态估计值满足四元数约束条件。针对复杂环境下的姿态估计问题,考虑了三种不同情况下的鲁棒滤波设计。一是考虑陀螺与星敏感器存在未对准误差以及星敏感器存在量测延迟的情况,将陀螺与星敏感器的未对准误差看成是范数有界的模型不确定,建立了带量测延迟的不确定姿态估计模型,并提出一种新的有界时域鲁棒滤波来处理模型不确定以及星敏感器延迟。二是考虑非线性姿态估计系统同时存在乘性噪声以及量测模型存在未知干扰的情况,提出了一种鲁棒扩展卡尔曼滤波姿态估计算法。该算法基于扩展卡尔曼滤波的结构,设计预测方差以及估计方差的最优上界,并证明估计误差在一定条件下是均方稳定的。三是考虑非线性姿态估计系统同时存在乘性噪声、量测丢失以及加性噪声相关的情况,提出了一种鲁棒递推滤波算法。该算法基于噪声相关下的状态预测以及状态校正两个滤波结构,设计预测方差以及估计方差的最优上界。仿真验证说明了这三种鲁棒滤波算法的有效性。
其他文献
目的:探讨在校男护生心理弹性状况并分析其影响因素,为提高男护生心理弹性及其心理健康水平提供理论依据。方法:通过方便取样,采用自制一般情况问卷、心理弹性量表(CD-RISC)
本文从专利申请自身特征的视角出发,分析影响专利实质审查周期的微观因素。随机选取2001—2010年在中、美、日三国申请并获得授权的专利族为样本,构建两水平模型分析技术领域
针对高中文科生数学学习上普遍存在兴趣不高,信心不强,方法不当,基础薄弱,数学思维能力偏低等问题.笔者结合多年来文科数学教学实践,谈些心得体会与大家分享和讨论.
来华留学招生工作是来华留学生教育的开端,是开启来华留学生教育管理工作的金钥匙。随着"一带一路"教育行动的建设与发展,"一带一路"沿线国家来华留学生的招生工作对其规模、
乾隆时期官印在明清官印中具有极强的代表性,其文字研究意义非凡。当前学术界对于乾隆官印文字改镌的意义还不够重视,多数文章仅从文献记载角度就其官印制度进行研究,未能挖
目的:探讨父母教养方式对高师生心理韧性的影响。方法:采用问卷调查对165名高师生父母教养方式及高师生心理韧性进行调查。结果:高心理韧性与低心理韧性的高师生在父亲、母亲
构建了两个含高赖氨酸蛋白质基因cDNA的表达载体,用基因枪法将其导入玉米不同杂交组合的胚性愈伤组织,经潮霉素抗性筛选,得到了可育的再生植株,经PCR扩增分析、点杂交、及Souther
目的:探讨社会生活技能训练在慢性精神分裂症患者康复中的作用。方法:对40例慢性精神分裂症患者在药物治疗的基础上辅以社会生活技能训练,疗程3个月;采用阳性与阴性症状量表(
当前关于凯恩斯主义刺激政策效果的争论再现了凯恩斯当初推行其理论时所遇到的阻力2008年金融危机之后,宏观经济学家在解释经济现象和提供政策建议方面大多表现不佳。今天,在
为了解江西省未成年犯在服刑期间的心理健康水平,选取江西省未成年犯管教所的16-18岁未成年犯200例和17-18周岁大一新生组99人进行SCL90量表问卷调查,通过T检验描述与测定了