CN111323020A - 一种基于火星边缘及中心多矢量观测的自主定轨方法 - Google Patents
一种基于火星边缘及中心多矢量观测的自主定轨方法 Download PDFInfo
- Publication number
- CN111323020A CN111323020A CN202010116786.9A CN202010116786A CN111323020A CN 111323020 A CN111323020 A CN 111323020A CN 202010116786 A CN202010116786 A CN 202010116786A CN 111323020 A CN111323020 A CN 111323020A
- Authority
- CN
- China
- Prior art keywords
- mars
- vector
- sensor
- orbit determination
- detector
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 239000013598 vector Substances 0.000 title claims abstract description 70
- 238000000034 method Methods 0.000 title claims abstract description 37
- 239000011159 matrix material Substances 0.000 claims description 33
- 238000004364 calculation method Methods 0.000 claims description 14
- 238000001514 detection method Methods 0.000 claims description 10
- 230000007704 transition Effects 0.000 claims description 8
- 230000003287 optical effect Effects 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 230000001131 transforming effect Effects 0.000 claims description 3
- 230000009286 beneficial effect Effects 0.000 abstract description 3
- 238000005259 measurement Methods 0.000 abstract description 3
- 238000001914 filtration Methods 0.000 abstract description 2
- 238000006243 chemical reaction Methods 0.000 description 3
- 239000000523 sample Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/02—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Image Analysis (AREA)
Abstract
本发明公开了一种基于火星边缘及中心多矢量观测的自主定轨方法,使火星探测器在环绕火星飞行过程中,不依靠地面深空测控网的支持,而仅依靠星敏感器以及火星敏感器对火星边缘矢量及中心矢量的观测完成自主定轨。探测器自主定轨是根据火星的边缘矢量及中心矢量计算出火星敏感器坐标系下探测器相对于火星中心的三轴位置,然后根据星敏感器输出的姿态四元数计算火星惯性系下探测器相对于火星中心的三轴位置,利用泰勒展开公式构造滤波算法,实时估计探测器的位置,速度。与现有技术相比,其有益效果是:本发明提出的自主定轨方法,使探测器能够利用火星敏感器观测的同一幅图像中的火星边缘矢量及中心矢量进行自主定轨,简化了系统配置。
Description
技术领域
本发明设计一种基于火星边缘及中心多矢量观测的自主定轨方法,用于火星探测器在环绕火星过程中,利用星敏感器和火星敏感器输出的火星边缘矢量以及中心矢量自主进行位置和速度计算的定轨方法。
背景技术
火星探测器在环绕火星飞行过程中,需要实时计算探测器的位置速度,以保证整器姿态基准计算及任务成功。
国内无火星探测经验,地球卫星轨道计算一般根据地面测定轨提供轨道初值,在线进行轨道递推或利用器载GNSS设备解算高精度轨道数据。然而对于火星探测器而言,具有器地距离远,无GNSS可用的特点,单纯借鉴地球卫星的轨道计算方法存在可测窗口狭窄,无GNSS可用,信息延迟大,自主性差的问题,且目前针对火星探测任务的自主导航研究需要利用多个敏感器观测多个目标进行自主定轨,实现复杂,因此可以研究一种基于火星边缘及中心多矢量观测的自主定轨方法,仅利用一台火星导航敏感器输出的同一幅火星图像的火星边缘矢量以及中心矢量进行自主定轨。
发明内容
本发明的目的在于:克服现有技术的不足,提出了一种一种基于火星边缘及中心多矢量观测的自主定轨方法,用于火星探测器在环绕火星过程中位置和速度计算的定轨。
为了解决上述技术问题,本发明通过以下的技术方案实现:
一种基于火星边缘及中心多矢量观测的自主定轨方法,步骤如下:
(1)利用上一拍火星探测器的位置、速度的估计值结合火星探测器轨道动力学方程预测当拍的位置、速度;
(2)计算火星敏感器坐标系下探测器相对于火星中心的三轴位置;
(3)将火星探测器相对于火星的三轴位置转换到火星惯性系下,计算火星惯性系下探测器相对于火星中心的三轴位置;
(4)计算当拍状态转移矩阵;
(5)计算当拍估计方差的预测值;
(6)计算当拍的修正增益;
(7)更新估计方差和当拍估计值。
进一步的,所述步骤(1)中,火星探测器的轨道动力学方程采用4阶非球形引力、太阳引力以及太阳光压摄动模型。
进一步的,火星敏感器坐标系的定义为:原点O为火星敏感器探测像面的中心,OZ轴与火星敏感器光轴平行,OX轴在火星敏感器探测像面内与探测像面的行平行,OY由右手法则确定。
进一步的,火星敏感器测量坐标系下火星探测器相对于火星中心的三轴位置ρ:
T=f(q)
其中,T为火星敏感器到火星惯性系的姿态转换矩阵,f()表示将姿态四元数转换为姿态矩阵运算函数,qsm为火星敏感器到星敏感器的姿态转换四元数,qsi为星敏感器输出的星敏感器相对于火星惯性系的姿态四元数。
进一步的,步骤(4)计算当拍状态转移矩阵,具体为:
其中,Φ41、Φ42、Φ43、Φ51、Φ52、Φ53、Φ61、Φ62、Φ63为矩阵元素,T计为计算周期;
Φ51=Φ42;
进一步的,步骤(5)计算当拍估计方差的预测值,具体为:
其中,估计方差的初始值取对角线为100的6阶方阵,
进一步的,步骤(6)计算当拍的修正增益KRK,具体为:
进一步的,步骤(7)更新估计方差和当拍估计值,具体为:
(7.2)状态量更新:
本发明采用的方法与现有技术相比,其优点和有益效果是:
(1)本发明通过一种基于火星边缘及中心多矢量观测的自主定轨方法,仅使用火星导航敏感器输出的同一幅火星图像的边缘矢量以及中心矢量进行自主定轨,简化了系统配置;
(2)在计算环绕器相对火星的位置时,使用5个不同的火星边缘矢量及火星标准椭球模型,提高了计算精度;
(3)在计算火星敏感器到火星惯性系的转换矩阵过程中,使用星敏感器的直接输出,提高了矩阵的计算精度。
附图说明
图1为本发明的方法流程图。
具体实施方式
探测器自主定轨是根据火星的边缘矢量及中心矢量计算出火星敏感器坐标系下探测器相对于火星中心的三轴位置,然后根据星敏感器输出的姿态四元数计算火星惯性系下探测器相对于火星中心的三轴位置,利用泰勒展开公式构造滤波算法,实时估计探测器的位置,速度。与现有技术相比,其有益效果是:种基于火星边缘矢量及中心矢量观测的环火段自主定轨方法,使探测器能够利用火星敏感器观测的同一幅图像中的火星边缘矢量及中心矢量进行自主定轨,简化了系统配置。
如图1所示,本发明提出一种基于火星边缘及中心多矢量观测的自主定轨方法,步骤如下:
(1)利用上一拍火星探测器的位置、速度的估计值结合火星探测器轨道动力学方程预测当拍的位置、速度;
火星探测器的轨道动力学方程采用4阶非球形引力、太阳引力以及太阳光压摄动模型。
(2)计算火星敏感器坐标系下探测器相对于火星中心的三轴位置;
火星敏感器坐标系的定义为:原点O为火星敏感器探测像面的中心,OZ轴与火星敏感器光轴平行,OX轴在火星敏感器探测像面内与探测像面的行平行,OY由右手法则确定。
(3)将火星探测器相对于火星的三轴位置转换到火星惯性系下,计算火星惯性系下探测器相对于火星中心的三轴位置;
(4)计算当拍状态转移矩阵;
(5)计算当拍估计方差的预测值;
(6)计算当拍的修正增益;
(7)更新估计方差和当拍估计值。
具体的,
处理过程:
状态量初值由当前轨道数据赋值。
处理过程:
1)调用环火段轨道递推程序对环绕器位置、速度进行一步预测Xf,包括rf,vf。
2)计算火星敏感器测量坐标系下火星探测器相对于火星中心的三轴位置ρ:
T=f(q)
其中,T为火星敏感器到火星惯性系的姿态转换矩阵,f()表示将姿态四元数转换为姿态矩阵运算函数(为公知计算),qsm为火星敏感器到星敏感器的姿态转换四元数,qsi为星敏感器输出的星敏感器相对于火星惯性系的姿态四元数。
5)导航增益计算
①求状态转移矩阵Φ,步骤如下:
Φ51=Φ42
其中,Φ41、Φ42、Φ43、Φ51、Φ52、Φ53、Φ61、Φ62、Φ63为矩阵元素,T计为计算周期;火星惯性系下环绕器的状态量其中为位置矢量,为速度矢量;μm为火星的引力常数,值为42828.4,常数Jm2=1.958744×10-3,常数Rm=3397。
估计方差的初始值取对角线为100的6阶方阵,
6)修正量计算
7)状态量更新
注:常数值
Jm2=1.958744×10-3
Rm=3397
μm为火星的引力常数,值为42828.4
本发明自主定轨方法仅使用火星导航敏感器输出的同一幅火星图像的边缘矢量以及中心矢量进行自主定轨,在计算环绕器相对火星的位置时,使用5个不同的火星边缘矢量及火星标准椭球模型,提高了计算精度;在计算火星敏感器到火星惯性系的转换矩阵过程中,使用星敏感器的直接输出,提高了矩阵的计算精度。
Claims (10)
1.一种基于火星边缘及中心多矢量观测的自主定轨方法,其特征在于步骤如下:
(1)利用上一拍火星探测器的位置、速度的估计值结合火星探测器轨道动力学方程预测当拍的位置、速度;
(2)计算火星敏感器坐标系下探测器相对于火星中心的三轴位置;
(3)将火星探测器相对于火星的三轴位置转换到火星惯性系下,计算火星惯性系下探测器相对于火星中心的三轴位置;
(4)计算当拍状态转移矩阵;
(5)计算当拍估计方差的预测值;
(6)计算当拍的修正增益;
(7)更新估计方差和当拍估计值。
2.根据权利要求1所示的一种基于火星边缘及中心多矢量观测的自主定轨方法,其特征在于:所述步骤(1)中,火星探测器的轨道动力学方程采用4阶非球形引力、太阳引力以及太阳光压摄动模型。
3.根据权利要求1所述的一种基于火星边缘及中心多矢量观测的自主定轨方法,其特征在于:火星敏感器坐标系的定义为:原点O为火星敏感器探测像面的中心,OZ轴与火星敏感器光轴平行,OX轴在火星敏感器探测像面内与探测像面的行平行,OY由右手法则确定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010116786.9A CN111323020B (zh) | 2020-02-25 | 2020-02-25 | 一种基于火星边缘及中心多矢量观测的自主定轨方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010116786.9A CN111323020B (zh) | 2020-02-25 | 2020-02-25 | 一种基于火星边缘及中心多矢量观测的自主定轨方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111323020A true CN111323020A (zh) | 2020-06-23 |
CN111323020B CN111323020B (zh) | 2021-11-16 |
Family
ID=71167188
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010116786.9A Active CN111323020B (zh) | 2020-02-25 | 2020-02-25 | 一种基于火星边缘及中心多矢量观测的自主定轨方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111323020B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112082560A (zh) * | 2020-08-07 | 2020-12-15 | 上海航天控制技术研究所 | 一种基于自主导航的火星制动策略在线制定方法 |
CN114022589A (zh) * | 2021-11-11 | 2022-02-08 | 江苏集萃智能光电系统研究所有限公司 | 一种星敏感器抗杂散光星点提取方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1997011882A2 (en) * | 1995-09-28 | 1997-04-03 | Lockheed Martin Corporation | Techniques for optimizing an autonomous star tracker |
US6456371B1 (en) * | 2000-09-25 | 2002-09-24 | The Boeing Company | Attitude determination with earth horizon-crossing indicators and relative-attitude propagation |
CN102116628A (zh) * | 2009-12-31 | 2011-07-06 | 北京控制工程研究所 | 一种着陆或附着深空天体探测器的高精度导航方法 |
CN103017760A (zh) * | 2011-09-27 | 2013-04-03 | 上海航天控制工程研究所 | 一种大椭圆轨道火星探测器自主对火定向方法 |
CN103063217A (zh) * | 2013-01-08 | 2013-04-24 | 北京航空航天大学 | 一种基于星历修正的深空探测器天文/无线电组合导航方法 |
CN104423273A (zh) * | 2013-08-27 | 2015-03-18 | 上海新跃仪表厂 | 火星捕获段光学自主导航半物理仿真方法及系统 |
CN104567879A (zh) * | 2015-01-27 | 2015-04-29 | 北京控制工程研究所 | 一种组合视场导航敏感器地心方向提取方法 |
CN105928527A (zh) * | 2016-04-25 | 2016-09-07 | 航天东方红卫星有限公司 | 基于可见光地球敏感器和太阳敏感器的卫星姿态确定方法 |
-
2020
- 2020-02-25 CN CN202010116786.9A patent/CN111323020B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1997011882A2 (en) * | 1995-09-28 | 1997-04-03 | Lockheed Martin Corporation | Techniques for optimizing an autonomous star tracker |
US6456371B1 (en) * | 2000-09-25 | 2002-09-24 | The Boeing Company | Attitude determination with earth horizon-crossing indicators and relative-attitude propagation |
CN102116628A (zh) * | 2009-12-31 | 2011-07-06 | 北京控制工程研究所 | 一种着陆或附着深空天体探测器的高精度导航方法 |
CN103017760A (zh) * | 2011-09-27 | 2013-04-03 | 上海航天控制工程研究所 | 一种大椭圆轨道火星探测器自主对火定向方法 |
CN103063217A (zh) * | 2013-01-08 | 2013-04-24 | 北京航空航天大学 | 一种基于星历修正的深空探测器天文/无线电组合导航方法 |
CN104423273A (zh) * | 2013-08-27 | 2015-03-18 | 上海新跃仪表厂 | 火星捕获段光学自主导航半物理仿真方法及系统 |
CN104567879A (zh) * | 2015-01-27 | 2015-04-29 | 北京控制工程研究所 | 一种组合视场导航敏感器地心方向提取方法 |
CN105928527A (zh) * | 2016-04-25 | 2016-09-07 | 航天东方红卫星有限公司 | 基于可见光地球敏感器和太阳敏感器的卫星姿态确定方法 |
Non-Patent Citations (2)
Title |
---|
MARTIN OELSCH; DOMINIK VAN OPDENBOSCH; ECKEHARD STEINBACH: "Survey of Visual Feature Extraction Algorithms in a Mars-like Environment", 《2017 IEEE INTERNATIONAL SYMPOSIUM ON MULTIMEDIA》 * |
杨成伟,等: "基于脉冲星和紫外敏感器的自主定轨定姿授时研究", 《空间科学学报》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112082560A (zh) * | 2020-08-07 | 2020-12-15 | 上海航天控制技术研究所 | 一种基于自主导航的火星制动策略在线制定方法 |
CN112082560B (zh) * | 2020-08-07 | 2022-09-27 | 上海航天控制技术研究所 | 一种基于自主导航的火星制动策略在线制定方法 |
CN114022589A (zh) * | 2021-11-11 | 2022-02-08 | 江苏集萃智能光电系统研究所有限公司 | 一种星敏感器抗杂散光星点提取方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111323020B (zh) | 2021-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101788296B (zh) | 一种sins/cns深组合导航系统及其实现方法 | |
CN111947652B (zh) | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 | |
Luo et al. | A new Kalman filter-based in-motion initial alignment method for DVL-aided low-cost SINS | |
CN103917850B (zh) | 一种惯性导航系统的运动对准方法 | |
CN103033189B (zh) | 一种深空探测巡视器惯性/视觉组合导航方法 | |
CN106289246B (zh) | 一种基于位置和姿态测量系统的柔性杆臂测量方法 | |
CN106767797B (zh) | 一种基于对偶四元数的惯性/gps组合导航方法 | |
CN108226980A (zh) | 基于惯性测量单元的差分gnss与ins自适应紧耦合导航方法 | |
CN109931955B (zh) | 基于状态相关李群滤波的捷联惯性导航系统初始对准方法 | |
CN108279010A (zh) | 一种基于多传感器的微小卫星姿态确定方法 | |
CN112504275B (zh) | 一种基于级联卡尔曼滤波算法的水面舰船水平姿态测量方法 | |
Khalaf et al. | Novel adaptive UKF for tightly-coupled INS/GPS integration with experimental validation on an UAV | |
CN112325886B (zh) | 一种基于重力梯度仪和陀螺仪组合的航天器自主定姿系统 | |
CN103542853B (zh) | 一种估计加速度计漂移的绝对导航滤波方法 | |
CN111323020B (zh) | 一种基于火星边缘及中心多矢量观测的自主定轨方法 | |
CN110702143A (zh) | 基于李群描述的sins捷联惯性导航系统动基座快速初始对准方法 | |
CN110849360B (zh) | 面向多机协同编队飞行的分布式相对导航方法 | |
CN111680462B (zh) | 基于空间目标在光学相平面位置变化的制导方法和系统 | |
CN102116634A (zh) | 一种着陆深空天体探测器的降维自主导航方法 | |
CN112857398B (zh) | 一种系泊状态下舰船的快速初始对准方法和装置 | |
CN112146655A (zh) | 一种BeiDou/SINS紧组合导航系统弹性模型设计方法 | |
CN105606093B (zh) | 基于重力实时补偿的惯性导航方法及装置 | |
CN116105730A (zh) | 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法 | |
CN111220151B (zh) | 载体系下考虑温度模型的惯性和里程计组合导航方法 | |
CN110926499A (zh) | 基于李群最优估计的sins捷联惯性导航系统晃动基座自对准方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |