中国宇航学会深空探测技术专业委员会会刊

高级检索

留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

一种基于李群描述的深空探测器姿态估计方法

徐浩 裴福俊 蒋宁

徐浩, 裴福俊, 蒋宁. 一种基于李群描述的深空探测器姿态估计方法[J]. 深空探测学报(中英文), 2020, 7(1): 102-108. doi: 10.15982/j.issn.2095-7777.2020.20171117002
引用本文: 徐浩, 裴福俊, 蒋宁. 一种基于李群描述的深空探测器姿态估计方法[J]. 深空探测学报(中英文), 2020, 7(1): 102-108. doi: 10.15982/j.issn.2095-7777.2020.20171117002
XU Hao, PEI Fujun, JIANG Ning. An Attitude Estimation Method Based on LIE Group Representation for Deep Space Probe[J]. Journal of Deep Space Exploration, 2020, 7(1): 102-108. doi: 10.15982/j.issn.2095-7777.2020.20171117002
Citation: XU Hao, PEI Fujun, JIANG Ning. An Attitude Estimation Method Based on LIE Group Representation for Deep Space Probe[J]. Journal of Deep Space Exploration, 2020, 7(1): 102-108. doi: 10.15982/j.issn.2095-7777.2020.20171117002

一种基于李群描述的深空探测器姿态估计方法

doi: 10.15982/j.issn.2095-7777.2020.20171117002
详细信息
    作者简介:

    徐浩(1993– ),男,硕士生,主要研究方向:深空探测机器人自主导航。 通讯地址:北京市朝阳区平乐园100号(100124) 电话:(010)67396190

    裴福俊(1976– ),男,副教授,硕士生导师,主要研究方向:深空探测机器人的导航与控制、惯性导航及组合导航。通讯地址:北京市朝阳区平乐园100号(100124) 电话:(010)67396190 E-mail:pfj@bjut.edu.cn

    蒋宁(1994– ),男,硕士生,主要研究方向:深空探测机器人自主导航。 通讯地址:北京市朝阳区平乐园100号(100124) 电话:(010)67396190

  • ● The innovative introduction of Lie group structure describes the rigid body attitude, which overcomes the problems of singularity and non-uniqueness in traditional methods. ● Using the measurement information of the star sensor and the dynamic equations of the spacecraft, the system equations described by Lie Group are constructed to estimate the position of the spacecraft in space. ● Based on the mapping relationship between Lie group and Lie algebra, the steps of Lie group filtering are deduced and the spacecraft attitude matrix is directly estimated. ● Through the simulation and analysis of traditional quaternion filtering algorithm and Lie group filtering algorithm, the feasibility and superiority of the attitude estimation filtering algorithm based on Lie group description is proved.

An Attitude Estimation Method Based on LIE Group Representation for Deep Space Probe

  • 摘要: 针对深空探测器姿态估计问题,提出了一种基于星敏感器的深空飞行器姿态估计新型算法,用李群替代了传统的四元数来描述姿态,避免了四元数转换为姿态矩阵产生的非唯一性和复杂计算等问题。该算法给出了基于星敏感器的姿态观测方程和空间中刚体的运动学模型在李群下的描述并提出了一种基于李群的滤波算法,完成了深空飞行器动态姿态的确定。该线性化模型解决了传统非线性模型在滤波过程中产生的误差,同时省去了四元数转化为姿态矩阵的步骤,减少了计算量。最后,仿真实验中对比了传统的基于四元数的姿态确定算法,可以看出该算法具有更好的稳定性和准确性。
    Highlights
    ● The innovative introduction of Lie group structure describes the rigid body attitude, which overcomes the problems of singularity and non-uniqueness in traditional methods. ● Using the measurement information of the star sensor and the dynamic equations of the spacecraft, the system equations described by Lie Group are constructed to estimate the position of the spacecraft in space. ● Based on the mapping relationship between Lie group and Lie algebra, the steps of Lie group filtering are deduced and the spacecraft attitude matrix is directly estimated. ● Through the simulation and analysis of traditional quaternion filtering algorithm and Lie group filtering algorithm, the feasibility and superiority of the attitude estimation filtering algorithm based on Lie group description is proved.
  • 图  1  星敏感器的基本工作原理

    Fig.  1  The working principle of star sensor

    图  2  星敏感器测量原理

    Fig.  2  The measurement principle of star sensor

    图  3  李群滤波三轴误差角

    Fig.  3  The angle errors in three axis using Lie group filter

    图  4  四元数滤波三轴误差角

    Fig.  4  The angle errors in three axis using quaternion filter

  • [1] BRAUN R D, MANNING R M. Mars exploration entry, descent and landing challeges[C]// Aerospace Conference. [S. l.]: IEEE, 2006: 18 .
    [2] GARCÍA-LLAMA E, IVANOV M C, WINSKI R G, et al. Mars science laboratory entry guidance improvements study for the Mars 2018 mission[C]// Aerospace Conference. [S. l.]: IEEE, 2012: 1-11.
    [3] 崔平远,于正湜,朱圣英. 火星进入段自主导航技术研究现状与展望[J]. 宇航学报,2013,34(4):447-456.

    CUI P Y,YU Z S,ZHU S Y. Research progress and prospect of autonomous navigation techniques for Mars entry phase[J]. Journal of Astronautics,2013,34(4):447-456.
    [4] 于正湜,崔平远. 行星着陆自主导航与制导控制研究现状与趋势[J]. 深空探测学报,2016,3(4):345-355.

    YU Z S,CUI P Y. Research status and developing trend of the autonomous navigation,guidance,and control for planetary landing[J]. Journal of Deep Space Exploration,2016,3(4):345-355.
    [5] 刘垒,张路,郑辛,等. 星敏感器技术研究现状及发展趋势[J]. 红外与激光工程,2007,36(s2):529-533.

    LIU L,ZHANG L,ZHENG X,et al. Current situation and development trends of star sensor technology[J]. Infrared and Laser Engineering,2007,36(s2):529-533.
    [6] 龚德铸,王艳宝,卢欣. 基于星敏感器的CCD47-20航天应用[J]. 空间控制技术与应用,2006(6):42-50.
    [7] YU-FENG L I,HAO Z H. Research of hyper accuracy subpixel subdivision location algorithm for star image[J]. Optical Technique,2005(5):1-9.
    [8] SHUSTER M D,S. D. O H Three-axis attitude determination from vector observations[J]. Journal of Guidance Control & Dynamics,2012,4(1):1-9.
    [9] MARKLEY F L. Attitude determination using vector observations and the singular value decomposition[J]. Journal of the Astronautical Sciences,1988,36(3):245-258.
    [10] BARITZHACK I Y,HARMAN R R. Optimized TRIAD algorithm for attitude determination[J]. Journal of Guidance Control & Dynamics,2012,20(1):208-211.
    [11] MARKLEY F L. Attitude determination from vector observations:a fast optimal matrix algorithm[J]. Journal of the Astronautical Sciences,1993,41(2):261-280.
    [12] LEFFERTS E J,MARKLEY F L,SHUSTER M D. Kalman filtering for spacecraft attitude estimation[J]. Journal of Guidance Control & Dynamics,1982,5(4):536-542.
    [13] CHOUKROUN D,WEISS H,BAR-ITZHACK I Y,et al. Kalman filtering for matrix estimation[J].  IEEE Transactions on Aerospace and Electronic Systems,2006,42(1):147-159.
    [14] SHUSTER M D. Kalman filtering of spacecraft attitude and the QUEST model[J]. Journal of the Astronautical Sciences,1990,38(3):377-393.
    [15] JULIER S J, UHLMANN J K, DURRANT-WHYTE H F. A new approach for filtering nonlinear systems[C]// American Control Conference. [S. l.]: IEEE, 2002.
    [16] 理查得·摩雷, 李泽湘, 夏恩卡·萨思特里. 机器人操作的数学导论[M]. 北京: 机械工业出版社, 1998.

    RICHARD M M, LI Z X, SHANKAR S. A mathematical introduction to robotic manipulation[M]. Beijing: China Machine Press, 1998.
    [17] BARRAU A, BONNABEL S. Intrinsic filtering on SO(3) with discrete-time observations[C]// Decision and Control. [S. l.]: IEEE, 2013:3255-3260.
  • [1] 姜啸, 徐瑞, 陈俐均.  深空探测器动态约束规划中的外延约束过滤方法研究 . 深空探测学报(中英文), 2019, 6(6): 586-594. doi: 10.15982/j.issn.2095-7777.2019.06.010
    [2] 徐赫屿, 王大轶, 刘成瑞, 李文博, 符方舟, 张科备.  深空探测器可重构性评价与自主重构策略 . 深空探测学报(中英文), 2019, 6(4): 376-383. doi: 10.15982/j.issn.2095-7777.2019.04.010
    [3] 金颢, 徐瑞, 崔平远, 朱圣英.  基于状态转移图的启发式深空探测器任务规划方法 . 深空探测学报(中英文), 2019, 6(4): 364-368. doi: 10.15982/j.issn.2095-7777.2019.04.008
    [4] 逯运通, 张正峰, 傅子敬, 张旭辉.  一种深空粒子采样返回探测器构型设想 . 深空探测学报(中英文), 2019, 6(1): 96-102. doi: 10.15982/j.issn.2095-7777.2019.01.014
    [5] 李春来, 刘建军, 严韦, 封剑青, 任鑫, 刘斌.  小行星探测科学目标进展与展望 . 深空探测学报(中英文), 2019, 6(5): 424-436. doi: 10.15982/j.issn.2095-7777.2019.05.003
    [6] 陈略, 谢剑锋, 韩松涛, 曹建峰, 平劲松.  “嫦娥4号”中继星开环测速方案设计与试验验证 . 深空探测学报(中英文), 2019, 6(3): 236-240. doi: 10.15982/j.issn.2095-7777.2019.03.006
    [7] 胡启阳, 王大轶.  基于双目视觉的非合作目标自主姿态估计方法 . 深空探测学报(中英文), 2019, 6(4): 341-347. doi: 10.15982/j.issn.2095-7777.2019.04.005
    [8] 王大轶, 符方舟, 孟林智, 李文博, 李茂登, 徐超, 葛东明.  深空探测器自主控制技术综述 . 深空探测学报(中英文), 2019, 6(4): 317-327. doi: 10.15982/j.issn.2095-7777.2019.04.002
    [9] 熊亮, 王锦清, 孙骥, 关轶峰, 陆波.  深空探测器大口径天线指向在轨标定方案 . 深空探测学报(中英文), 2018, 5(6): 554-560. doi: 10.15982/j.issn.2095-7777.2018.06.008
    [10] 金颢, 徐瑞, 崔平远, 朱圣英.  基于扩展状态深空探测器任务规划方法 . 深空探测学报(中英文), 2018, 5(6): 569-574. doi: 10.15982/j.issn.2095-7777.2018.06.010
    [11] 陈略, 平劲松, 李文潇, 韩松涛, 刘庆, 陈永强, 张建辉, 简念川.  基于中国深空站的木星探测器开环测量试验 . 深空探测学报(中英文), 2018, 5(4): 382-386. doi: 10.15982/j.issn.2095-7777.2018.04.009
    [12] 叶志龙, 孙朔冬, 陈纾, 吴迪, 武斌.  一种基于恒星分布的星敏感器导航星库制作方法 . 深空探测学报(中英文), 2018, 5(1): 90-96. doi: 10.15982/j.issn.2095-7777.2018.01.013
    [13] 胡宇鹏, 鲁亮, 向延华, 李思忠, 胡文军, 胡绍全.  深空探测器同位素热源环境试验技术 . 深空探测学报(中英文), 2017, 4(2): 138-142. doi: 10.15982/j.issn.2095-7777.2017.02.006
    [14] 陈略, 平劲松, 张建辉, 刘庆, 岳世磊, 陈永强, 王际舟, 李文潇.  中国深空网成功实施“卡西尼号”探测器坠入土星测量试验 . 深空探测学报(中英文), 2017, 4(5): 491-492. doi: 10.15982/j.issn.2095-7777.2017.05.012
    [15] 朱安文, 刘飞标, 杜辉, 马世俊.  核动力深空探测器现状及发展研究 . 深空探测学报(中英文), 2017, 4(5): 405-416. doi: 10.15982/j.issn.2095-7777.2017.05.002
    [16] 程宇峰, 润一, 王密.  深空探测光学导航敏感器在轨几何定标方法 . 深空探测学报(中英文), 2016, 3(3): 228-236. doi: 10.15982/j.issn.2095-7777.2016.03.006
    [17] 宁晓琳, 李卓, 黄盼盼, 杨雨青, 刘刚, 房建成.  火星探测器捕获段自适应卡尔曼滤波方法 . 深空探测学报(中英文), 2016, 3(3): 237-245. doi: 10.15982/j.issn.2095-7777.2016.03.007
    [18] 于登云, 张玉花, 褚英志, 李昊, 王建炜, 杜冬.  深空探测器模块化结构动力学研究 . 深空探测学报(中英文), 2016, 3(3): 268-274. doi: 10.15982/j.issn.2095-7777.2016.03.011
    [19] 傅惠民, 娄泰山, 肖强.  火星进入段探测器自校准状态估计 . 深空探测学报(中英文), 2015, 2(3): 224-228. doi: 10.15982/j.issn.2095-7777.2015.03.006
    [20] 武长青, 徐瑞, 朱圣英.  基于对数势函数的深空探测器姿态规划与控制方法 . 深空探测学报(中英文), 2015, 2(4): 365-370. doi: 10.15982/j.issn.2095-7777.2015.04.011
  • 加载中
图(4)
计量
  • 文章访问数:  343
  • HTML全文浏览量:  89
  • PDF下载量:  78
  • 被引次数: 0
出版历程
  • 收稿日期:  2017-11-17
  • 修回日期:  2018-02-09
  • 网络出版日期:  2020-06-04
  • 刊出日期:  2020-05-12

一种基于李群描述的深空探测器姿态估计方法

doi: 10.15982/j.issn.2095-7777.2020.20171117002
    作者简介:

    徐浩(1993– ),男,硕士生,主要研究方向:深空探测机器人自主导航。 通讯地址:北京市朝阳区平乐园100号(100124) 电话:(010)67396190

    裴福俊(1976– ),男,副教授,硕士生导师,主要研究方向:深空探测机器人的导航与控制、惯性导航及组合导航。通讯地址:北京市朝阳区平乐园100号(100124) 电话:(010)67396190 E-mail:pfj@bjut.edu.cn

    蒋宁(1994– ),男,硕士生,主要研究方向:深空探测机器人自主导航。 通讯地址:北京市朝阳区平乐园100号(100124) 电话:(010)67396190

  • ● The innovative introduction of Lie group structure describes the rigid body attitude, which overcomes the problems of singularity and non-uniqueness in traditional methods. ● Using the measurement information of the star sensor and the dynamic equations of the spacecraft, the system equations described by Lie Group are constructed to estimate the position of the spacecraft in space. ● Based on the mapping relationship between Lie group and Lie algebra, the steps of Lie group filtering are deduced and the spacecraft attitude matrix is directly estimated. ● Through the simulation and analysis of traditional quaternion filtering algorithm and Lie group filtering algorithm, the feasibility and superiority of the attitude estimation filtering algorithm based on Lie group description is proved.

摘要: 针对深空探测器姿态估计问题,提出了一种基于星敏感器的深空飞行器姿态估计新型算法,用李群替代了传统的四元数来描述姿态,避免了四元数转换为姿态矩阵产生的非唯一性和复杂计算等问题。该算法给出了基于星敏感器的姿态观测方程和空间中刚体的运动学模型在李群下的描述并提出了一种基于李群的滤波算法,完成了深空飞行器动态姿态的确定。该线性化模型解决了传统非线性模型在滤波过程中产生的误差,同时省去了四元数转化为姿态矩阵的步骤,减少了计算量。最后,仿真实验中对比了传统的基于四元数的姿态确定算法,可以看出该算法具有更好的稳定性和准确性。

注释:
1)  ● The innovative introduction of Lie group structure describes the rigid body attitude, which overcomes the problems of singularity and non-uniqueness in traditional methods. ● Using the measurement information of the star sensor and the dynamic equations of the spacecraft, the system equations described by Lie Group are constructed to estimate the position of the spacecraft in space. ● Based on the mapping relationship between Lie group and Lie algebra, the steps of Lie group filtering are deduced and the spacecraft attitude matrix is directly estimated. ● Through the simulation and analysis of traditional quaternion filtering algorithm and Lie group filtering algorithm, the feasibility and superiority of the attitude estimation filtering algorithm based on Lie group description is proved.

English Abstract

徐浩, 裴福俊, 蒋宁. 一种基于李群描述的深空探测器姿态估计方法[J]. 深空探测学报(中英文), 2020, 7(1): 102-108. doi: 10.15982/j.issn.2095-7777.2020.20171117002
引用本文: 徐浩, 裴福俊, 蒋宁. 一种基于李群描述的深空探测器姿态估计方法[J]. 深空探测学报(中英文), 2020, 7(1): 102-108. doi: 10.15982/j.issn.2095-7777.2020.20171117002
XU Hao, PEI Fujun, JIANG Ning. An Attitude Estimation Method Based on LIE Group Representation for Deep Space Probe[J]. Journal of Deep Space Exploration, 2020, 7(1): 102-108. doi: 10.15982/j.issn.2095-7777.2020.20171117002
Citation: XU Hao, PEI Fujun, JIANG Ning. An Attitude Estimation Method Based on LIE Group Representation for Deep Space Probe[J]. Journal of Deep Space Exploration, 2020, 7(1): 102-108. doi: 10.15982/j.issn.2095-7777.2020.20171117002
    • 随着我国航天事业的飞速发展,深空飞行器的自主导航问题成为了研究的热点。深空飞行器距地距离远,工作时间长,深空环境未知,传统的依赖地面与航天器通讯来实现导航和控制的方法存在实时性、成本高、干扰较大等种种限制,很难实现高精度的深空导航需求。因此,在深空探测领域自主导航技术成为了保证深空探测任务完成的关键技术[1-4]。目前在自主导航的姿态确定方面,星敏感器是深空探测航天器上常用的姿态确定仪器,其基本原理是基于星点质心定位,实现星图识别和姿态解算[5-7],从而实现探测器姿态估计。相比较于太阳敏感器、地平仪、磁力计等姿态测量设备,星敏感器测量精度高,抗干扰能力及自主导航能力强。本文主要就姿态解算部分做出了研究。

      基于星敏感器的航天器姿态确定是通过星敏感器测量同一坐标矢量在惯性坐标系下和星敏感器坐标系下的不同数值来确定航天器姿态参数的过程。常用的姿态描述方法有欧拉角、四元数、罗格里格斯参数法、修正的罗格里格斯参数法、旋转矩阵等。现阶段的姿态解算算法主要分为静态确定性算法和动态姿态估计两大类。静态确定性算法是根据一组观测矢量求解出航天器坐标系和惯性坐标系之间的姿态矩阵进而求出航天器姿态角。Davenport提出了q方法,通过四元数的性质构造K矩阵,用求取特征值的方法确定姿态四元数[8]。基于最小二乘原理的SVD方法将矩阵进行奇异值分解得到姿态矩阵[9]。此外较常用的方法还有:基于牛顿迭代的数值算法、TRIAD方法[10]、FOAM方法[11]等。动态姿态估计方法主要是基于四元数的卡尔曼滤波的改进算法,现阶段已有的方法有扩展卡尔曼滤波(EKF)[12]、乘性卡尔曼滤波(MEKF)[13]、预测卡尔曼滤波[14]、自适应卡尔曼滤波[15]等。动态滤波姿态估计方法能够克服观测矢量中的不确定误差,利用更多的观测信息,实现最优化估计下的最优解,相比较于静态确定性算法能够更好的对姿态进行估计。但是在采用四元数建模时EKF产生的线性化误差极易引起滤波发散,有些滤波方法无法实现使用单一的姿态敏感仪器完成估计等问题还未得到较好的解决。

      本文针对基于四元数描述的姿态估计方法存在的问题,提出了基于李群描述的深空探测器姿态估计的新方法。该方法基于李群对于旋转矩阵的特定唯一描述特点,采用李群对深空探测器进行姿态描述来解决四元数姿态描述方法中存在的非唯一性等问题。在此基础上,针对四元数描述的姿态估计方法中的模型非线性问题,基于李群微分方程构造了线性的姿态矩阵微分方程作为系统模型,并设计了李群滤波器来实现直接对姿态矩阵进行估计。该方法能够保证系统模型线性化结构,克服传统四元数方法中非线性模型在线性化时导致的模型误差。在估计精度上比静态姿态确定方法、四元数卡尔曼滤波方法具有更好的性能。

    • 星敏感器一般有两种工作模式:全天球识别工作模式和星跟踪工作模式。全天球识别工作模式的工作原理为通过星敏感器的光学镜头在视场角内拍摄星图,经过星图识别、星点质心定位和姿态解算几个过程后输出航天器姿态角;星跟踪模式下星敏感器首先利用先验姿态信息,进入星跟踪模块通过局部的星点质心定位和识别最终解算出当前姿态信息。星敏感器的基本工作原理框图如图 1所示。本文主要针对姿态解算提出了一种新的算法。

      图  1  星敏感器的基本工作原理

      Figure 1.  The working principle of star sensor

    • 星敏感器由光学系统和CCD感光装置构成,来自定位恒星的光线穿过光学透镜聚焦到CCD成像平面。XY轴在CCD成像平面内呈正交化,Z轴与透镜的光轴重合。${p_x}$${p_y}$两坐标点为目标恒星在CCD成像平面成像的质心坐标,f是光学系统的焦距。星敏感器的测量原理如图 2所示。

      假设星敏感器坐标点${{p}} = {[{p_x}{\text{,}}{p_y}]^{\rm{T}}}$表示在星敏感器坐标系下目标恒星的坐标,完整的目标恒星惯性坐标系下矢量${{{r}}_i}$在星敏感器坐标系下的投影可表示为

      $${{l}} = {[{p_x}, {p_y}, f]^{\rm{T}}}$$ (1)

      假设星敏感器坐标系与航天器载体坐标系重合,${t_k}$时刻在航天器载体坐标系下的目标恒星的观测方程可以写成

      $${{{l}}_i}(k) = {{X}}(k){{{r}}_i} + {{{v}}_i}$$ (2)

      其中:${{{l}}_i}(k)$$i$颗目标恒星的观测矢量;${{X}}(k)$是惯性系到航天器载体坐标系的姿态转换矩阵;${{{r}}_{i}}$是第$i$颗目标恒星在惯性系下的单位矢量;${{{v}}_i}$是星敏感器的观测噪声,通常被视为均值为零的随机白噪声并满足以下性质

      $$\begin{array}{l} E\{ {{{v}}_i}\} = 0\\ E\{ {{{v}}_i}{{{v}}_i}^{\rm{T}}\} = {\sigma _i}^2{{{I}}_3} \end{array}$$ (3)

      其中,${\sigma _i}^2$是噪声的均方差。

      图  2  星敏感器测量原理

      Figure 2.  The measurement principle of star sensor

    • 李群理论是近代数学中的一个重要分支,19世纪由挪威数学家Marius Sophus Lie提出的[16]。李群是群,同时也是微分流形,满足群运算和可逆性。特殊正交群${{SO}}(n)$是一般线性群${{GL}}(n)$的子群,是李群中的一类群,定义为如下形式

      $${{SO}}(n) = \{ {{R}}|{{R}} \in {{{R}} ^{n \times n}},{{R}}{{{R}}^{\rm{T}}} = {{I}},\det ({{R}}) = 1\} $$ (4)

      本文主要考虑的航天器的姿态问题,所以主要讨论三维特殊正交群的相关内容。对等式${{R}}{{{R}}^{\rm{T}}} = {{I}}$两边求导并移项得$\dot {{R}}{{{R}}^{\rm{T}}} = - {(\dot {{R}}{{{R}}^{\rm{T}}})^{\rm{T}}}$$\dot {{R}}{{{R}}^{\rm{T}}}$为反对称阵,整理后有下式

      $$\dot {{R}} = {{RO}}$$ (5)

      其中:${{R}}$${{SO}}(3)$阵;${{Q}}$为3×3反对称矩阵,取向量${{k}} \in {{ R}^3}$

      $${{Q}}({{k}}){\rm{ = }}\left[ {{{k}} \times } \right] = \left[ {\begin{split} 0& \quad{ - {k_3}}&{{k_2}}\\ {{k_3}}&\quad\;\; 0&{ - {k_1}}\\ { - {k_2}}&\;\;\quad{{k_1}}&0\;\; \end{split}} \right]$$ (6)

      其中,$[ \cdot ] \times $是反对称矩阵的简化数学表示。

      在参考系下的航天器姿态角速度${{\omega }}$可以表示为

      $${{\omega }} = {[{\omega _x}{\text{,}}{\omega _y}\text{,}{\omega _z}]^{\rm{T}}}$$ (7)

      空间航天器的运动动力学微分方程可以被写作

      $$\dot {{R}} = {{R}}[{{\omega}} ] \times $$ (8)

      刚体飞行器的动态姿态可以被改写为如下的形式

      $${{\dot \omega }} = {{{J}}^{ - 1}}\{ {{N}} - {{\omega }} \times {{J\omega }}\} $$ (9)

      其中:${{J}}$为惯性矩阵;${{N}}$是总共的外部转矩。

    • 结合公式(2)和(8)构造李群滤波方程,实现对航天器姿态的李群滤波估计。李群滤波器直接作用于基于李群的系统方程,相比于四元数方法省去了转换为姿态矩阵的步骤,保证了滤波器的线性结构,减少非线性的计算误差,李群滤波能够实现快速有效的姿态估计。

    • 首先,根据航天器姿态的动力学模型和星敏感器观测模型构建时间连续的系统模型

      $${{{\dot X}}_t} = {{{X}}_t}[{{{\omega }}_t} + {{{w}}_t}] \times $$ (10)
      $${{{l}}_t} = {{{X}}_t}{{{r}}_t} + {{{v}}_t}$$ (11)

      其中:${{{X}}_t}$表示从航天器的姿态矩阵;${{{\omega }}_t}$表示航天器姿态旋转矢量;${{{w}}_t}$表示一个随机的连续白噪声;${{{l}}_t}$表示目标恒星在航天器载体坐标下的连续观测矢量;${{{r}}_t}$代表了目标恒星在惯性坐标系下的坐标矢量;${{{v}}_t}$为星敏感器的连续观测噪声,本文中视为一个连续的随机白噪声。

      为了解决传感器的实际测量值为离散量的问题,需要在固定采样时间频率下对模型进行离散化处理。公式(10)中${{{X}}_t}$${{{\omega}} _t}$为一对李群和李代数,根据李代数到李群的映射关系,可在离散情况下将${{{\omega}} _t}$投影到李群空间对姿态矩阵${{{X}}_t}$进行更新,该过程也是求解差分方程的过程,得系统离散化模型为

      $${{{X}}_{k + 1}} = {{{W}}_k}{{{X}}_k}{{{A}}_k}$$ (12)
      $${{{l}}_{k + 1}} = {{{X}}_{k + 1}}{{{r}}_{k + 1}} + {{{v}}_{k + 1}}$$ (13)

      其中:${{{X}}_{k + 1}}$表示在${t_{k + 1}}$时刻的航天器载体姿态矩阵;${{{W}}_k}$是在${t_{k + 1}}$时刻下均值白噪声在转动形式下的表示,传播矩阵为${\sigma _1}^2{{{I}}_3}$${{{A}}_k}$${t_{k + 1}}$时刻的转动增量,即对${{{\omega}} _t}$进行指数展开。式(13)中,${{{l}}_{k + 1}},{{{r}}_{k + 1}}$分别表示${t_{k + 1}}$时刻目标恒星在航天器载体坐标系和惯性坐标系下的坐标矢量;${{{v}}_{k + 1}}$${t_{k + 1}}$时刻的离散观测噪声,其协方差矩阵为${\sigma _2}^2{{{I}}_3}$

      李群到李代数的映射是指数映射,其为光滑满射,陀螺的测量值为旋转矩阵${{X}}$的李代数,所以使用式(12)的离散化模型能够保证姿态动力学系统的性质。

    • 为了更好的提出和推导本文所提出的李群滤波方法,本文先分析一种传统卡尔曼滤波通用离散系统模型,式(14)和(15)为传统卡尔曼滤波通用矢量模型

      $${{{L}}_{k + 1}} = {{{L}}_k} + {{{W}}_k}$$ (14)
      $${{{Y}}_k} = {{{H}}_k}{{{L}}_k} + {{{V}}_k}$$ (15)

      其中:${{{L}}_k}$${{{Y}}_k} \in {{\rm R}^3}$,分别表示所考虑模型的离散状态量和观测量;${{{W}}_k}$${{{V}}_k} \in {{\rm R}^3}$为高斯白噪声,${{{H}}_k} \in {{\rm R}^{3 \times 3}}$为量测矩阵。这种模型下的最常用的卡尔曼滤波的状态一步预测方程和状态估值计算方程为

      $${\hat {{L}}_{k + 1\left| k \right.}} = {\hat {{L}}_k}$$ (16)
      $${\hat {{L}}_{k + 1}} = {\hat {{L}}_{k + 1\left| k \right.}} + {{{K}}_{k + 1}}({{{Y}}_{k + 1}} - {{{H}}_{k + 1}}{\hat {{L}}_{k + 1\left| k \right.}})$$ (17)

      使用两个三维矢量${{{e}}_{k + 1\left| k \right.}} \!\!=\!\! {{{L}}_{k + 1}} \!\!-\!\! {\hat {{L}}_{k + 1\left| k \right.}}$${{{e}}_{k + 1}} \!\!=\!\! {{{L}}_{k + 1}} \!\!-\!\! {\hat {{L}}_{k + 1}}$预测状态误差和纠正状态误差,可以得到

      $${{{e}}_{k + 1\left| k \right.}} = {{{e}}_{k + 1}} + {{{W}}_n}$$ (18)
      $${{{e}}_{k + 1}} = {{{e}}_{k + 1\left| k \right.}} - {{{K}}_{k + 1}}({{{H}}_{k + 1}}{{{e}}_{k + 1\left| k \right.}} + {{{V}}_{k + 1}})$$ (19)

      误差方程可以具有自发性,然后滤波增益${{{K}}_{k + 1}}$可以根据误差协方差矩阵进行更新。滤波的收敛性可以根据可观可控性原理来确定,卡尔曼滤波实际上是一种基于方差最小的最优化估计方法。故根据式(12)和(13)的形式,将卡尔曼滤波方法与李群相结合,使用乘法原理替换该模型中的加法原理。下面对一个相似的方法进行具体的描述。

      根据线性情况下李群的对称性原理并结合航天器姿态模型式(12),可以将式(16)和(17)转换到李群形式下[17]

      $${\hat {{X}}_{k + 1\left| k \right.}} = {\hat {{X}}_k}{{{A}}_k}$$ (20)
      $${\hat {{X}}_{k + 1}} = {\hat {{X}}_{k + 1\left| k \right.}}{J_{k + 1}}({{{K}}_{k + 1}}({{{l}}_{k + 1}} - {{{X}}_{k + 1\left| k \right.}}{{{r}}_{k + 1}}))$$ (21)

      其中:$\hat {{X}} \in {{SO}}(3)$${J_{k + 1}}(\cdot)$是一个将矢量转化为特殊正交矩阵的函数,由于李代数到李群的指数映射为光滑满射,本文中${J_{k + 1}}(\cdot)$使用指数展开$\exp (\cdot)$,其能将李代数形式下的新息完整地补偿状态量从而保证李群状态量更新的有效性。这不仅是将式中的加法用李群的乘法代替,同时还需要决定乘法的顺序,这对后续的动态误差模型会有影响。基于李群的状态误差定义为如下形式

      $${{{\eta}} _{k + 1}} = {{{X}}_{k + 1}}{\hat {{X}}_{k + 1}^{\rm{T}}}$$ (22)
      $${{{\eta}} _{k + 1\left| k \right.}} = {{{X}}_{k + 1}}{\hat {{X}}_{k + 1\left| k \right.}^{\rm{T}}}$$ (23)

      根据误差均方差最小原理,李群滤波器设计如下:

      状态一步预测方程

      $${\hat {{X}}_{k + 1\left| k \right.}} = {\hat {{X}}_k}{{{A}}_k}$$ (24)

      一步预测均方差方程

      $${{{P}} _{k|k - 1}} = {{{A}}_k}{{{P}} _{k - 1}}{{{A}}^{\rm{T}}}_k + {{{Q}} _w}$$ (25)

      其中:${{{Q}} _w}$为系统噪声协方差矩阵,这里取${\sigma _1}^2{{{I}} _3}$

      定义新息为${{{\varepsilon}} _{k + 1}}$,新息为测量和估计量的一步误差,这里使用两个参考坐标

      $${{{\varepsilon}} _{k + 1}} = \left\{ {\begin{split} {{{{l}}_{k + 1}} - {{{X}}_{k + 1\left| k \right.}}{{{r}}_{k + 1}}} \\ {{{{l}}^{'}}_{k + 1} - {{{X}}_{k + 1\left| k \right.}}{{{r}}^{'}}_{k + 1}} \end{split}} \right\}$$ (26)

      新息的均方差矩阵表示为

      $${{{S}}_k} = {{{H}}_k}{{{P}}_{k|k - 1}}{{H}}_k^{\rm T} + {{{Q}}_v}$$ (27)

      其中:${{{Q}} _v}$表示量测噪声协方差矩阵,其值取为${\sigma _2}^2{{{I}} _6}$${{{H}}_k}$表示系统量测矩阵,${{{H}}_k} = \left\{ {\begin{array}{*{20}{c}} { - [{{{r}}_k} \times ]}\\ { - [{{{r}}^{'}}_k \times ]} \end{array}} \right\}$

      滤波增益

      $${{{K}}_k} = {{{P}} _{k|k - 1}}{{H}}_k^{\rm{T}}{{{S}} _k}_{}^{ - 1}$$ (28)

      估计均方误差方程

      $${{{P}} _k} = ({{I}} - {{{K}}_k}{{{H}}_k}){{{P}} _{k|k - 1}}{({{I}} - {{{K}}_k}{{{H}}_k})^{\rm{T}}} + {{{Q}} _v}$$ (29)

      状态估值计算方程采用公式(21)的方式,由于李代数到李群的指数映射为光滑满射,使用指数映射能够全面的修正状态量,所以状态估值计算方程为

      $${\hat {{X}}_{k + 1}} = {\hat {{X}}_{k + 1\left| k \right.}}\exp ({{{K}}_{k + 1}}{{{\varepsilon}} _{k + 1}})$$ (30)

      其中$\exp (\cdot)$表示指数展开,本文采用罗格里斯方程进行运算

      $$\exp (\theta ) = {{I}} + \frac{{\sin (\left\| \theta \right\|)}}{{\left\| \theta \right\|}}\theta \times + \frac{{1 - \cos (\left\| \theta \right\|)}}{{{{\left\| \theta \right\|}^2}}}{(\theta \times )^2}$$ (31)

      李群滤波的过程总结如下

      $$\left\{ \begin{split} & {{\hat {{X}}}_{k + 1\left| k \right.}} = {{\hat {{X}}}_k}{{{A}}_k} \\ & {{{P}} _{k|k - 1}} = {{{A}}_k}{{{P}} _{k - 1}}{{{A}}_k^{\rm{T}}} + {{{Q}} _w} \\ & {{{S}} _k} = {{{H}}_k}{{{P}} _{k|k - 1}}{{H}}_k^{\rm{T}} + {{{Q}} _v} \\ & {{{K}}_k} = {{{P}} _{k|k - 1}}{{H}}_k^{\rm{T}}{{{S}} _k}^{ - 1} \\ & {{{P}} _k} = ({{I}}- {{{K}}_k}{{{H}}_k}){{{P}} _{k|k - 1}} \\ & {{\hat {{X}}}_{k + 1}} = {{\hat {{X}}}_{k + 1\left| k \right.}}\exp ({{{K}}_{k + 1}}{{{\varepsilon}} _{k + 1}}) \end{split} \right.$$
    • 相比较与传统的确定性算法,本文所提出的基于李群滤波的动态姿态估计方法,能够加入航天器中的IMU信息,并且对系统噪声和状态噪声进行响应,从而提供估计中的优化解,同时在一定程度上降低了不确定性因素的影响。与四元数滤波的方法相比较,本文的算法直接对姿态矩阵进行估计,避免了对模型进行线性化带来的误差和四元数描述姿态的非唯一性等问题,提高了滤波的稳定性和精度。下面通过一组仿真实验对算法进行验证。

      仿真条件:星敏感器安装与在飞行器载体坐标系重合。设定两组目标恒星在惯性参考坐标系下的坐标为

      $$\begin{split} {{{v}}_1} = {[1,0,0]^{\rm T}}\\ {{{v}}_2} = {[0{\rm{,1,0}}]^{\rm T}} \end{split}$$

      X-Y-Z三轴姿态初值分别为0,–90°,90。

      理论上真实的初始姿态矩阵为

      $${{X}} = \left[ {\begin{split} \; 0 \quad\quad & 1 \quad &0 \;\\ \; 0 \quad\quad & 0 \quad &1 \;\\ \; 1 \quad\quad & 0 \quad &0 \; \end{split}} \right]$$

      星敏感器模拟两个观测矢量的初值为

      $$\begin{split} {{{w}}_1} = {[0,0,1]^{\rm T}}\\ {{{w}}_2} = {[1{\rm{,0,0}}]^{\rm T}} \end{split}$$

      理论的姿态角速度为

      $${{\omega }} = {10^{ - 4}} \times {[\cos (0.1t),\cos (0.08t),\cos (0.06t)]^{\rm{T}}}{\rm rad}/{\rm s}$$

      惯性矩阵参数为

      $${{J}} = \left[ {\begin{split} \;\; {200} \!\!\!\!\! \quad\quad & \quad\quad 0& \quad\quad 0\;\;\;\;\;\;\;\; \\ 0 \quad\quad & \quad\quad\!\!\!\!\! {300}& \quad\quad 0\;\;\;\;\;\;\;\; \\ 0 \quad\quad & \quad\quad 0&{100}\;\;\;\;\;\; \end{split}} \right]$$

      星敏感器采样周期为

      $$t = 1{\rm s}$$

      滤波器初始参数如下

      $${{{X}}_0} = \left[ {\begin{align} \; 1 &\quad \quad 0 \quad &0 \;\\ \; 0 &\quad \quad 1 \quad &0 \;\\ \; 0 &\quad \quad 0\quad &1 \; \end{align}} \right]$$
      $${{{P}} _0} = \left[ {\begin{split} \; 5 \quad \quad & 0 \quad &0 \;\\ \; 0 \quad \quad & 5 \quad &0 \;\\ \; 0 \quad \quad & 0 \quad &5 \; \end{split}} \right]$$
      $${{{Q}} _w} = 5 \times {10^{ - 5}}\left[ {\begin{split} \; 1\quad \quad &0 \quad &0\; \\ \; 0\quad \quad &1 \quad &0 \;\\ \; 0\quad \quad &0 \quad &1 \; \end{split}} \right]$$
      $${{{Q}} _v} = {0.125^2}{I _6}$$

      四元数滤波的参数为${{{q}}_0} = \left[ {\begin{array}{*{20}{c}} 1&0&0&0 \end{array}} \right]$${{{P}} _0} = {I _4}$${{Q}} = 1 \times {10^{ - 5}}{I _4}$${{R}} = 0.01{I _4}$

      图 34所示,李群滤波算法具有较好的收敛性和较高的姿态估计精度,在150次滤波后精度达到0.005°。由于四元数模型的不确定性误差使用EKF四元数滤波导致X轴上的误差随时间发散。仿真实验结果验证了以上的分析,证明本文所提出的算法的稳定性和可靠性。通过比较可以得出李群滤波在对准精度和稳定性方面都优于四元数的方法,李群滤波适用于基于星敏感器的航天器姿态估计问题。

      图  3  李群滤波三轴误差角

      Figure 3.  The angle errors in three axis using Lie group filter

      图  4  四元数滤波三轴误差角

      Figure 4.  The angle errors in three axis using quaternion filter

    • 在实际应用中刚体的姿态描述方法,多采用单位四元数,但是基于四元数的描述方法存在着非唯一性和归一化的问题,在滤波过程中四元数模型的非线性问题也影响着滤波的性能。本文通过李群的性质直接使用姿态矩阵描述姿态,避免了实际应用中求解四元数在转化为姿态矩阵的过程。在此基础上结合卡尔曼滤波最优递推估计的思想,提出了一种全新的基于星敏感器航天器姿态的解算算法,实现了航天器姿态矩阵的直接估计。本文只是对李群在滤波方法上的应用做出了初步的探索,证明了该应用有一定的可行性,由于算法未考虑李群形式下的传感器误差,所以滤波收敛速率较慢。下一步将就如何使用李群对传统的误差模型建模进行研究,以提高滤波的估计精度和速度。

参考文献 (17)

目录

    /

    返回文章
    返回