系统工程与电子技术 ›› 2026, Vol. 48 ›› Issue (6): 2089-2095.doi: 10.12305/j.issn.1001-506X.2026.06.29

• 制导、导航与控制 • 上一篇    下一篇

采用解析多项式姿态轨迹模型评估高阶姿态算法性能

唐琮淏1, 李京书2,*, 常国宾1,3, 韩先楠4,5, 卞和方1, 任苑菲1   

  1. 1. 中国矿业大学环境与测绘学院,江苏 徐州 221116
    2. 海军工程大学作战运筹与规划系,湖北 武汉 430033
    3. 西安测绘研究所地理信息工程国家重点实验室,陕西 西安 710054
    4. 中国铁路设计集团有限公司,天津 300308
    5. 天津市轨道交通导航定位及时空大数据技术重点实验室,天津 300251
  • 收稿日期:2025-04-27 修回日期:2025-08-21 出版日期:2026-06-25 发布日期:2025-12-08
  • 通讯作者: 李京书
  • 作者简介:唐琮淏(2001—),男,博士研究生,主要研究方向为惯性技术及应用
    常国宾(1984—),男,教授,博士,主要研究方向为惯性技术及应用
    韩先楠(1996—),男,工程师,硕士,主要研究方向为工程测量、涉铁监测、测绘数据处理
    卞和方(1982—),男,讲师,博士,主要研究方向为组合导航、矿山测量
    任苑菲(2003—),女,本科,主要研究方向为大地测量学
  • 基金资助:
    国家自然科学基金(52471386);中国铁路设计集团有限公司重点课题(2023A0240103)资助课题

Evaluating performances of high-order attitude algorithms using analytical polynomial attitude trajectory model

Conghao TANG1, Jingshu LI2,*, Guobin CHANG1,3, Xiannan HAN4,5, Hefang BIAN1, Yuanfei REN1   

  1. 1. School of Environmental Sciences and Spatial Informatics,China University of Mining and Technology,Xuzhou 221116,China
    2. Department of Operational Research and Programming,Naval University of Engineering,Wuhan 430033,China
    3. State Key Laboratory of Geo-Information Engineering,Xi’an Research Institute of Surveying and Mapping,Xi’an 710054,China
    4. China Railway Design Corporation,Tianjin 300308,China
    5. Tianjin Key Laboratory of Rail Transit Navigation Positioning and Spatio-temporal Big Data Technology,Tianjin 300251,China
  • Received:2025-04-27 Revised:2025-08-21 Online:2026-06-25 Published:2025-12-08
  • Contact: Jingshu LI

摘要:

针对多项式大机动模型中姿态缺乏解析表达式的问题,提出一种基于Gibbs矢量多项式的大机动姿态轨迹模型。首先,基于所提轨迹模型推导姿态与角速度的解析表达式,以获取参考姿态真值;其次,根据有限次多项式拟合的角速度模型,构造姿态解算所需的角增量子样;最后,采用毕卡迭代与泰勒级数展开两种高精度姿态算法,对模型的正确性进行验证。仿真实验结果表明:毕卡迭代算法在迭代至4次时性能优于传统二阶算法,迭代至6次时达到收敛;泰勒级数展开算法在展开至6阶时性能优于传统二阶算法,展开至7阶时达到收敛;且两种高阶姿态算法收敛后的稳态性能保持一致。上述结果一方面验证了现有文献中关于高阶姿态算法性能的相关论述,另一方面也证实了所提轨迹模型在高阶姿态算法性能评估中的有效性。

关键词: 轨迹, 姿态算法, 四元数, Gibbs矢量

Abstract:

To address the problem that the attitude in the polynomial large-maneuver model lacks an analytical expression, a large-maneuver attitude trajectory model based on the Gibbs vector polynomial is proposed. Firstly, based on the proposed trajectory model, the analytical expressions of attitude and angular velocity are derived to obtain the true value of the reference attitude. Secondly, according to the angular velocity model fitted by a finite-order polynomial, the angular increment sub-samples required for attitude calculation are constructed. Finally, two high-precision attitude algorithms, namely Picard iteration and Taylor series expansion, are adopted to verify the correctness of the model. The simulation results show that the Picard iteration algorithm outperforms the traditional second-order algorithm when the number of iterations reaches four and converges when the number of iterations reaches six; the Taylor series expansion algorithm outperforms the traditional second-order algorithm when the expansion order reaches six and converges when the expansion order reaches seven; and the steady-state performances of the two high-order attitude algorithms are consistent after convergence. The above results not only verify the relevant discussions on the performance of high-order attitude algorithms in existing literatures, but also confirm the effectiveness of the proposed trajectory model in the performance evaluation of high-order attitude algorithms.

Key words: trajctory, attitude algorithm, quaternion, Gibbs vector

中图分类号: