CN106643741B - 一种卫星相对小行星视觉自主导航方法 - Google Patents

一种卫星相对小行星视觉自主导航方法 Download PDF

Info

Publication number
CN106643741B
CN106643741B CN201611138342.5A CN201611138342A CN106643741B CN 106643741 B CN106643741 B CN 106643741B CN 201611138342 A CN201611138342 A CN 201611138342A CN 106643741 B CN106643741 B CN 106643741B
Authority
CN
China
Prior art keywords
satellite
asteroid
relative
star sensor
ast0
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.)
Expired - Fee Related
Application number
CN201611138342.5A
Other languages
English (en)
Other versions
CN106643741A (zh
Inventor
王鹏
祝燕华
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Southeast University
Original Assignee
Southeast University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Southeast University filed Critical Southeast University
Priority to CN201611138342.5A priority Critical patent/CN106643741B/zh
Publication of CN106643741A publication Critical patent/CN106643741A/zh
Application granted granted Critical
Publication of CN106643741B publication Critical patent/CN106643741B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Astronomy & Astrophysics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种卫星相对小行星视觉自主导航方法。首先以跟踪观测小行星为目的，设计卫星理论飞行轨道参数，然后根据地心惯性坐标系下卫星相对目标小行星轨道动力学模型，建立自主导航***状态模型；其次提出卫星星敏感器观测小行星所需满足的理论光照条件和成像条件。计算小行星相对卫星理论方位角与俯仰角，调整真实星敏感器光轴与理论方向一致，对小行星进行真实观测，建立以相对单位方向矢量和距离为观测量的观测方程；最后使用Unscented卡尔曼滤波估计卫星位置和速度。本发明能有效修正卫星的位置误差，提高导航精度，非常适用于跟踪目标小行星的卫星自主导航，不仅为跟踪目标小行星的卫星提供高精度导航信息，而且为其自主导航***设计提供参考。

Description

一种卫星相对小行星视觉自主导航方法
技术领域
本发明属于航天器深空探测的空间测量领域，尤其涉及一种卫星相对小行星视觉自主导航方法。
背景技术
随着深空探测技术的发展，小行星探测已成为21世纪深空探测的重要内容之一，开展小行星探测不仅有助于揭开太阳系和生命的起源、演化之谜，而且可促进地球防护、空间科学和空间技术应用的发展，能为更远的深空探测关键技术提供验证。
目前，各主要航天国家都十分重视深空探测战略的制定工作，从战略高度明确了各自的发展方向和重点，但目前对小行星的探测工作还处于初级阶段，相关技术尚未成熟，有待进一步验证和完善。小行星探测的主要手段包括：飞越探测、绕飞探测、着陆取样探测三种方式，其中为了在小行星附近进行飞越探测和伴飞探测，都需要通过星载监测设备对小行星进行远程观测，以获得小行星的地形、地貌等外部信息。此外，由于小行星周围引力场复杂、测控信息匮乏、探测器与地面控制站通信延迟大等特点，传统的无线电跟踪技术难以满足导航实时性的要求，使得小行星探测任务中的自主导航技术成为了小行星探测技术需要研究的重点之一。
综上所述，由于传统可见光相机无法始终连续跟踪观测小行星，因此这就使得研究针对小行星的新型光学测量方法显得迫切重要，不仅可以为我国深空探测任务提供技术储备，同时也可以促进其他相关研究课题和工程项目的进展，为我国航空航天技术进步做出贡献。
发明内容
发明目的：本发明针对面向小行星的深空探测，卫星无法始终连续跟踪观测小行星导致信息缺失的问题，提出一种卫星利用星敏感器自主连续观测小行星进行自主导航的新方法，为深空探测卫星提供高精度相对观测信息。
技术方案：一种卫星相对小行星视觉自主导航方法，步骤如下：
(1)以目标小行星为跟踪观测对象，根据小行星星历，设计卫星理论飞行轨道参数；
(2)根据地心惯性坐标系下卫星相对目标小行星轨道动力学模型，建立自主导航***状态模型；
(3)根据计算的卫星和小行星相对距离，判断是否满足星敏感器观测距离要求，满足则进入步骤(4)，否则进入步骤(12)；
(4)根据解算的太阳、地球和小行星三者位置关系，判断小行星是否处在太阳光照区，是则进入步骤(5)，否则进入步骤(12)；
(5)根据解算的太阳、卫星和小行星三者位置关系，判断地球是否进入星敏感器视场，是则进入步骤(6)，否则进入步骤(12)；
(6)根据计算的小行星可视星等，判断小行星可视星等是否小于星敏感器可观测阈值，是则进入步骤(7)，否则进入步骤(12)；
(7)根据计算的小行星相对卫星方向矢量与星敏感器光轴指向夹角，判断小行星是否在星敏感器视场范围内，是则进入步骤(8)，否则利用万向轴调整星敏感器光轴指向后，继续判断小行星是否在星敏感器视场范围内，是则进入步骤(8)，否则进入(12)；
(8)根据计算的小行星在星敏感器二维像面阵坐标，判断小行星是否在星敏感器二维像面阵内，是则进入步骤(9)，否则进入步骤(12)；
(9)在满足上述观测条件基础上，计算小行星相对卫星理论方向矢量和方位角与俯仰角；
(10)调整星敏感器真实光轴指向与理论方向一致，对小行星进行真实观测，建立以单位方向矢量和距离为观测量的观测方程，进入步骤(11)；
(11)对所建立的状态方程和观测方程离散化，利用Unscented卡尔曼滤波算法估计卫星位置和速度；
(12)计算结束。
进一步的，所述步骤(1)中的设计卫星飞行轨道参数具体包括轨道半长轴a、轨道偏心率e、轨道倾角i、升交点赤经Ω、近地点幅角ω和过近地点时刻tp。
进一步的，所述步骤(2)中建立自主导航***状态模型过程如下：
在地心惯性坐标系下，当卫星位置距离大于小行星与卫星相对距离的时候，建立卫星相对目标小行星轨道动力学模型
Figure BDA0001177299270000031
Figure BDA0001177299270000032
其中，δr(Ast0)和δv(Ast0)为小行星相对卫星方向矢量，r(0)和r(Ast)为卫星和小行星位置矢量，μe为地球引力常数，af为摄动力影响；
定义状态变量x＝[(δr(Ast0))T(δv(Ast0))T]T，建立自主导航***状态模型；
Figure BDA0001177299270000033
其中，f[x(t),t]为***非线性连续状态转移函数，w(t)为状态噪声。
进一步的，所述步骤(3)中判断小行星是否满足星敏感器观测特定距离要求过程如下：
计算卫星相对小行星距离δr(Ast0)，判断其是否满足条件
Lmin≤δr(Ast0)≤Lmax (3)
其中，δr(Ast0)＝|δr(Ast0)|＝|r(Ast)-r(0)|，r(0)和r(Ast)为卫星和小行星位置矢量；Lmin和Lmax为星间观测所需最小距离和最大距离。
进一步的，所述步骤(4)中判断小行星是否处在太阳光照区过程如下：
分析地球阴影范围以及小行星运行穿过该阴影范围的临界条件，设小行星位置矢量r(Ast)与太阳位置矢量r(sun)夹角为ψ，小行星进入和离开地球阴影范围的临界夹角为
Figure BDA0001177299270000034
和
Figure BDA0001177299270000035
则小行星处在太阳光照区需要满足条件：
Figure BDA0001177299270000036
进一步的，所述步骤(5)中判断地球是否进入星敏感器视场过程如下：
设卫星位置矢量r(0)和卫星相对小行星方向矢量δr(Ast0)的夹角为θ，被地球遮挡导致背景光线过弱的临界条件是小行星相对卫星方向矢量δr(Ast0)与地球边缘相切，定义此临界夹角为θcri，则地球未进入星敏感器视场条件为：
θ＞θcri (5)。
进一步的，所述步骤(6)中判断小行星可视星等是否小于星敏感器可观测阈值过程如下：
引入可视星分析小行星的可见性，星等值越小，表明天体越亮；反之，天体则越暗；设星敏感器可观测阈值为mthr，小行星可视星等为m，小行星被观测到其可视星等需要满足条件
m＜mthr (6)。
进一步的，所述步骤(7)中判断小行星是否在星敏感器视场范围内过程如下：
设小行星相对卫星方向矢量δr(Ast0)与星敏感器光轴指向矢量
Figure BDA0001177299270000041
夹角为
Figure BDA0001177299270000042
星敏感器视场角为FOV，则方向矢量δr(Ast0)在星敏感器视场范围内满足条件
Figure BDA0001177299270000043
如果相对矢量δr(Ast0)不在视场范围内，利用万向轴调整星敏感器光轴指向，使其进入视场范围，如果转动后仍不能进入视场，则无法观测。
进一步的，所述步骤(8)中判断判断小行星是否在星敏感器二维像面阵内的过程如下：
根据小行星相对卫星方向矢量δr(Ast0)投影在星敏感器二维像面阵的几何关系，解其坐标为
Figure BDA0001177299270000044
设二维像面阵长度和宽度分别为IPlongth和IPwidth，则小行星在像平面坐标需要满足条件
Figure BDA0001177299270000045
Figure BDA0001177299270000046
进一步的，进一步的，所述步骤(9)中计算小行星相对卫星理论方向矢量和方位角与俯仰角具体为：
小行星相对卫星单位方向矢量
Figure BDA0001177299270000047
由星敏感器获得，得小行星相对卫星方位角α与俯仰角δ，卫星和小行星相对距离|δr(Ast0)|由星间链路获得，得到小行星相对卫星理论方向矢量δr(Ast0)
Figure BDA0001177299270000051
其中，
Figure BDA0001177299270000052
小行星相对卫星方位由方位角和俯仰角描述，在卫星本体坐标系ob-xbybzb中，定义方位角α为δr(Ast0)在ob-ybzb平面的投影与yb轴夹角，俯仰角δ为δr(Ast0)与xb轴夹角，表示为
Figure BDA0001177299270000053
Figure BDA0001177299270000054
其中，
Figure BDA0001177299270000055
Figure BDA0001177299270000056
是地心惯性坐标系相对本体坐标系姿态转换矩阵。
进一步的，所述步骤(10)中计算小行星相对卫星真实方向矢量具体为：
根据步骤(9)所得小行星相对卫星的理论方向矢量和方位角与俯仰角，卫星采用万向轴调整星敏感器光轴指向与理论方向矢量相吻合，并利用星敏感器进行实际测量；
卫星星敏感器真实观测小行星，输出小行星相对卫星单位方向矢量真实测量值
Figure BDA0001177299270000057
由卫星激光测距仪测量卫星和小行星之间的实际测量值
Figure BDA0001177299270000058
建立小行星相对卫星观测方程为：
Figure BDA0001177299270000059
其中，
Figure BDA00011772992700000510
进一步的，所述步骤(11)中对对所建立的状态模型和观测模型离散化，并利用Unscented卡尔曼滤波算法估计卫星位置和速度具体为：
对步骤(2)中状态模型及步骤(10)中观测模型进行离散化
Figure BDA00011772992700000511
yk＝g(xk)+vk (12b)
式中，k＝1,2，…，f(xk,uk)为离散后的状态转移方程，g(xk)为离散后的观测方程，w(k)和v(k)分别为离散后的***噪声和观测噪声；
利用Unscented卡尔曼滤波算法，结合步骤所述的状态模型和观测模型进行滤波，根据状态向量可得相应的Unscented采样点，利用***状态模型，对采样点进行一步预测，并得出与上一时刻滤波得到的迭代状态值之间的协方差阵，以消除状态模型中模型误差的影响。
工作原理：本发明是一种卫星自主连续观测小行星新方法，利用卫星星敏感器自主连续观测小行星，得到小行星相对卫星方向矢量和方位角与俯仰角。首先以目标小行星为跟踪观测对象，根据小行星星历，设计卫星飞行轨道参数，然后提出卫星星敏感器观测小行星需要满足四种基本光照条件：①卫星和小行星相对距离满足观测距离要求；②小行星处在太阳光照区能被完全观测；③地球(或其他天体)未进入星敏感器视场；④小行星可视星等小于可视星等阈值，其次判断卫星星敏感器能否观测到小行星：①小行星是否在星敏感器视场范围；②小行星是否在星敏感器二维像面阵内，最后计算小行星相对卫星方向矢量和方位角及俯仰角，为卫星自主连续观测小行星提供数据支持。
有益效果：本发明可为卫星编队飞行提供高精度位置和速度信息，有效解决卫星编队飞行观测信息不足所导致的导航精度较低的问题。相对于现有技术，本发明具有以下优点：1、星敏感器是观测恒星的天体敏感器，而利用星敏感器观测小行星需要需要满足特定条件，本发明提出小行星被观测需要满足的光照条件和星敏感器观测条件，解决传统星敏感器只能被动观测问题，提高自主观测准确性；2、在实现星间观测基础上，本发明提出实时计算小行星相对卫星方位矢量和方位角和俯仰角方法，并且利用万向轴调整星敏感器光轴指向连续跟踪小行星，解决传统观测无法连续跟踪问题，提高星间连续观测效率。
附图说明
图1为本发明方法流程图；
图2卫星星敏感器观测小行星流程图
图3为本发明卫星相对小行星星间特定距离范围示意图；
图4为本发明中小行星光照条件示意图；
图5为本发明中星敏感器视场与地球位置关系示意图；
图6为本发明中小行星可视星等计算示意图；
图7本发明中小行星在星敏感器二维像面阵投影示意图；
图8为本发明中小行星相对卫星方向矢量与方位角示意图。
具体实施方式
下面将结合附图，对本发明的实施案例进行详细的描述；
如图1所示，本发明为一种卫星相对小行星视觉自主导航方法，其针对小行星深空探测阶段，卫星利用星敏感器自主连续观测小行星进行自主导航，是一种非常适合于深空探测卫星自主导航方法。其包括步骤如下：
(1)以目标小行星为跟踪观测对象，根据小行星星历，设计卫星飞行轨道参数(包括轨道半长轴a、轨道偏心率e、轨道倾角i、升交点赤经Ω、近地点幅角ω、过近地点时刻tp)，设计卫星星敏感器安装方位以观测小行星；
(2)在地心惯性坐标系下，当卫星位置距离远大于小行星与卫星相对距离的时候，建立卫星相对目标小行星轨道动力学模型
Figure BDA0001177299270000071
Figure BDA0001177299270000072
其中，δr(Ast0)和δv(Ast0)为小行星相对卫星方向矢量，r(0)和r(Ast)为卫星和小行星位置矢量，μe为地球引力常数，af为摄动力影响。
定义状态变量x＝[(δr(Ast0))T(δv(Ast0))T]T，建立自主导航***状态模型；
Figure BDA0001177299270000073
其中，f[x(t),t]为***非线性连续状态转移函数，w(t)为状态噪声。
(3)根据所设计卫星轨道参数和小行星星历，计算卫星和小行星相对距离δr(Ast0)，如图3所示，判断其是否满足星敏感器观测小行星需要满足特定距离要求
Lmin≤δr(Ast0)≤Lmax (15)
其中，δr(Ast0)＝|δr(Ast0)|＝|r(Ast)-r(0)|，r(0)和r(Ast)为卫星和小行星位置矢量；Lmin和Lmax为星间观测所需最小和最大距离。
(4)当卫星观测小行星时，小行星需要被太阳光充分照射。当小行星在地球光照区时，小行星能被太阳光充分照射；反之，当小行星进入地球阴影区时，由于地球遮挡，太阳光无法照射到小行星，因此需要对小行星光照条件进行判断。
根据太阳、地球和小行星三者几何位置关系，如图4所示，确定太阳阴影区和小行星运行轨迹穿过该阴影区的临界条件。设太阳光为平行光，定义太阳光方向矢量为0°，绕其顺时针角度为正，取值范围[0,π]，绕其逆时针角度为负，取值范围为[-π,0)，小行星位置矢量r(Ast)与太阳方向矢量r(sun)形成的夹角为
顺时针：
Figure BDA0001177299270000081
逆时针：
Figure BDA0001177299270000082
小行星进入和离开地球阴影范围的临界夹角为
Figure BDA0001177299270000083
Figure BDA0001177299270000084
其中，
Figure BDA0001177299270000085
Re是地球半径。
由此可得小行星处在太阳光照区和阴影区条件分别为：
太阳光照区：
Figure BDA0001177299270000086
太阳阴影区：
Figure BDA0001177299270000087
(5)在星敏感器观测小行星过程中，当视场背景光线过强或过弱时，其也无法观测小行星，因此需要分析视场背景受天体影响。
以地球导致星敏感器视场背景过弱为例进行分析，根据地球、卫星和小行星三者几何位置关系，如图5所示，小行星相对卫星方向矢量δr(Ast0)和卫星方向矢量r(0)的夹角为
Figure BDA0001177299270000091
由于地球导致背景光线过弱的临界条件是卫星和小行星的连线与地球边缘相切，则切线与卫星位置矢量的临界夹角为
Figure BDA0001177299270000092
由此可得星敏感器视场不受背景光线影响的条件为
θ＞θcri (21)
该方法同样适用判断小行星背景受其他天体遮挡导致光线过强情况。
(6)星等是天文学中的概念，它是衡量天体光度的物理量。星等通常分为绝对星等和可视星等，绝对星等是指在离该天体32.6光年处所看到的天体亮度；可视星等是指地球上观测者所见的天体亮度。星等值越小，表明天体越亮；反之，天体则越暗。引入恒星可视星等概念分析被观测小行星的可见性。
首先要计算小行星的绝对星等，小行星的绝对星等M可通过下式计算得出：
Figure BDA0001177299270000093
其中，msun是太阳的可视星等，它的值为-26.73；rd为被观测天体的半径；a是天体的反射率；d0是地球与太阳之间的平均距离，它的值为1.496×1011m。
小行星的视星等m可以通过绝对星等M依照如下公式计算得到：
Figure BDA0001177299270000094
其中，|r(sun0)|是太阳与小行星之间的距离；ξ是相对矢量δr(Ast0)与太阳相对小行星方向矢量r(sunAst)夹角，如图6所示，可通过下式求得：
Figure BDA0001177299270000095
p(ξ)是相位积分，可由下式求得：
Figure BDA0001177299270000101
被观测星体可视星等值越大，其相对星敏感器越暗；反之，其相对星敏感器越亮。设星敏感器可观测阈值为mthr，小行星可视星等为m，其可视星等需要满足条件
m＜mthr (26)
定义星敏感器光轴指向在本体坐标系方向矢量为
Figure BDA0001177299270000102
计算小行星相对卫星方向矢量δr(Ast0)与星敏感器方向矢量为
Figure BDA0001177299270000103
的夹角
Figure BDA0001177299270000104
其中，
Figure BDA0001177299270000105
是地心惯性坐标系相对本体坐标系姿态转换矩阵。
(7)定义星敏感器视场角为FOV，判断相对矢量δr(Ast0)是否在星敏感器视场范围内
视场范围内：
Figure BDA0001177299270000106
视场范围外：
Figure BDA0001177299270000107
如果相对矢量δr(Ast0)不在视场范围内，考虑利用万向轴调整星敏感器光轴指向矢量，可以在由δr(Ast0)和
Figure BDA0001177299270000108
组成的平面内直接偏转等于或大于
Figure BDA0001177299270000109
角度，使矢量δr(Ast0)进入视场范围，如果转动后仍不能进入视场，则无法观测。
(8)根据小行星相对卫星方向矢量δr(Ast0)投影在星敏感器二维像面阵的投影几何关系，如图7所示，解算小行星在二维像面阵坐标
Figure BDA00011772992700001010
Figure BDA00011772992700001011
其中，f是星敏感器焦距
设像平面长度和宽度分别为IPlongth和IPwidth，小行星能被观测需要满足条件
Figure BDA00011772992700001012
Figure BDA0001177299270000111
(9)在卫星观测到小行星后，由星间链路可得两颗卫星之间距离δr(Ast0)，由星敏感器可得小行星相对卫星单位方向矢量
Figure BDA0001177299270000112
如图8所示，因此可得小行星相对卫星理论方向矢量为
Figure BDA0001177299270000113
其中，
Figure BDA0001177299270000114
小行星相对卫星方位由方位角和俯仰角描述，在卫星本体坐标系ob-xbybzb中，定义方位角α为δr(Ast0)在ob-ybzb平面的投影与yb轴夹角，俯仰角δ为δr(Ast0)与xb轴夹角，表示为
Figure BDA0001177299270000115
Figure BDA0001177299270000116
其中，
Figure BDA0001177299270000117
Figure BDA0001177299270000118
是地心惯性坐标系相对本体坐标系姿态转换矩阵。
(10)调整卫星真实星敏感器光轴与理论方向矢量一致，对小行星进行真实观测，建立以单位方向矢量和距离为观测量的观测方程；
根据上述所得小行星相对卫星的理论方位角和俯仰角，卫星采用万向轴或其他机械装置调整星敏感器光轴指向与该理论方向相吻合，并利用星敏感器进行真实测量，输出小行星相对卫星单位方向矢量真实观测值
Figure BDA0001177299270000119
并利用卫星激光测距仪测量卫星和小行星之间的真实测量值
Figure BDA00011772992700001110
建立小行星相对卫星观测方程为：
Figure BDA00011772992700001111
其中，
Figure BDA00011772992700001112
(11)对状态模型和观测模型离散化，并利用Unscented卡尔曼滤波算法估计卫星位置和速度。
对步骤2中状态模型及步骤10中观测模型进行离散化
xk+1＝f(xk,uk)+wk (34a)
yk＝g(xk)+vk (34b)
其中，状态向量为xk∈RL，输入向量为uk∈Rn，输出向量为yk∈RM，过程噪声wk∈N(0,Qk)，测量噪声：vk∈N(0,Rk)，且wk和vk不相关。
利用Unscented卡尔曼滤波算法，结合步骤所述的状态模型和观测模型进行滤波，根据状态向量可得相应的Unscented采样点，利用***状态模型，对采样点进行一步预测，并得出与上一时刻滤波得到的迭代状态值之间的协方差阵，以消除状态模型中模型误差的影响。具体算法如下
步骤1：对于状态变量xk，均值
Figure BDA0001177299270000121
方差
Figure BDA0001177299270000122
进行Unscented变换
Figure BDA0001177299270000123
Figure BDA0001177299270000124
Figure BDA0001177299270000125
步骤2：预测过程
χi,k/k-1＝f(χi,k-1) (36a)
Figure BDA0001177299270000126
Figure BDA0001177299270000127
Figure BDA0001177299270000128
Figure BDA0001177299270000129
Figure BDA00011772992700001210
步骤3：更新过程
Figure BDA00011772992700001211
Figure BDA00011772992700001212
Figure BDA0001177299270000131
Figure BDA0001177299270000132
Figure BDA0001177299270000133
步骤4：返回步骤1进行下一个周期的滤波。
(12)计算结束。
本发明首先以跟踪观测小行星为目的，设计卫星理论飞行轨道参数，然后根据地心惯性坐标系下卫星相对目标小行星轨道动力学模型，建立自主导航***状态模型；其次提出卫星星敏感器观测小行星所需满足的理论光照条件和成像条件。计算小行星相对卫星理论方位角与俯仰角，调整真实星敏感器光轴与理论方向一致，对小行星进行真实观测，建立以相对单位方向矢量和距离为观测量的观测方程；最后使用Unscented卡尔曼滤波估计卫星位置和速度，本发明能够有效修正卫星的位置误差，提高导航精度，非常适用于跟踪目标小行星的卫星自主导航，本发明属于航天导航技术领域，不仅可以为跟踪目标小行星的卫星提供高精度导航信息，而且可以为其自主导航***设计提供参考。

Claims (11)

1.一种卫星相对小行星视觉自主导航方法，其特征在于，步骤如下：
(1)以目标小行星为跟踪观测对象，根据小行星星历，设计卫星理论飞行轨道参数；
(2)根据地心惯性坐标系下卫星相对目标小行星轨道动力学模型，建立自主导航***状态模型；过程如下：
在地心惯性坐标系下，当卫星位置距离大于小行星与卫星相对距离的时候，建立卫星相对目标小行星轨道动力学模型
Figure FDA0002413923190000011
Figure FDA0002413923190000012
其中，δr(Ast0)和δv(Ast0)为小行星相对卫星理论方向矢量，r(0)和r(Ast)为卫星和小行星位置矢量，μe为地球引力常数，af为摄动力影响；
定义状态变量x＝[(δr(Ast0))T(δv(Ast0))T]T，建立自主导航***状态模型；
Figure FDA0002413923190000013
其中，f()为***非线性连续状态转移函数，xt为t时刻的状态变量x，ut为t时刻的输入向量，wt为t时刻的状态噪声；
(3)根据计算的卫星和小行星相对距离，判断是否满足星敏感器观测距离要求，满足则进入步骤(4)，否则进入步骤(12)；
(4)根据解算的太阳、地球和小行星三者位置关系，判断小行星是否处在太阳光照区，是则进入步骤(5)，否则进入步骤(12)；
(5)根据解算的太阳、卫星和小行星三者位置关系，判断地球是否进入星敏感器视场，是则进入步骤(6)，否则进入步骤(12)；
(6)根据计算的小行星可视星等，判断小行星可视星等是否小于星敏感器可观测阈值，是则进入步骤(7)，否则进入步骤(12)；
(7)根据计算的小行星相对卫星理论方向矢量与星敏感器光轴指向夹角，判断小行星是否在星敏感器视场范围内，是则进入步骤(8)，否则利用万向轴调整星敏感器光轴指向后，继续判断小行星是否在星敏感器视场范围内，是则进入步骤(8)，否则进入(12)；
(8)根据计算的小行星在星敏感器二维像面阵坐标，判断小行星是否在星敏感器二维像面阵内，是则进入步骤(9)，否则进入步骤(12)；
(9)在满足上述观测条件基础上，计算小行星相对卫星理论方向矢量和方位角与俯仰角；
(10)调整星敏感器真实光轴指向与理论方向矢量一致，对小行星进行真实观测，建立以单位方向矢量和距离为观测量的观测方程，进入步骤(11)；
(11)对所建立的状态模型和观测方程离散化，利用Unscented卡尔曼滤波算法估计卫星位置和速度；
(12)计算结束。
2.根据权利要求1所述的卫星相对小行星视觉自主导航方法，其特征在于：所述步骤(1)中的设计卫星理论飞行轨道参数具体包括轨道半长轴a、轨道偏心率e、轨道倾角i、升交点赤经Ω、近地点幅角ω和过近地点时刻tp。
3.根据权利要求1所述的卫星相对小行星视觉自主导航方法，其特征在于：所述步骤(3)中判断小行星是否满足星敏感器观测特定距离要求过程如下：
计算卫星相对小行星距离δr(Ast0)，判断其是否满足条件
Lmin≤δr(Ast0)≤Lmax (3)
其中，δr(Ast0)＝|δr(Ast0)|＝|r(Ast)-r(0)|，r(0)和r(Ast)为卫星和小行星位置矢量；Lmin和Lmax为星间观测所需最小距离和最大距离。
4.根据权利要求1所述的一种卫星相对小行星视觉自主导航方法，其特征在于：所述步骤(4)中判断小行星是否处在太阳光照区过程如下：
分析地球阴影范围以及小行星运行穿过该阴影范围的临界条件，设小行星位置矢量r(Ast)与太阳位置矢量r(sun)夹角为ψ，小行星进入和离开地球阴影范围的临界夹角为
Figure FDA0002413923190000021
和
Figure FDA0002413923190000022
则小行星处在太阳光照区需要满足条件：
Figure FDA0002413923190000023
5.根据权利要求1所述的卫星相对小行星视觉自主导航方法，其特征在于：所述步骤(5)中判断地球是否进入星敏感器视场过程如下：
设卫星位置矢量r(0)和小行星相对卫星理论方向矢量δr(Ast0)的夹角为θ，被地球遮挡导致背景光线过弱的临界条件是小行星相对卫星理论方向矢量δr(Ast0)与地球边缘相切，定义此临界夹角为θcri，则地球未进入星敏感器视场条件为：
θ＞θcri (5)。
6.根据权利要求1所述的卫星相对小行星视觉自主导航方法，其特征在于：所述步骤(6)中判断小行星可视星等是否小于星敏感器可观测阈值过程如下：
引入可视星分析小行星的可见性，可视星等值越小，表明天体越亮；反之，天体则越暗；设星敏感器可观测阈值为mthr，小行星可视星等为m，小行星被观测到其可视星等需要满足条件
m＜mthr (6)。
7.根据权利要求1所述的卫星相对小行星视觉自主导航方法，其特征在于：所述步骤(7)中判断小行星是否在星敏感器视场范围内过程如下：
设小行星相对卫星理论方向矢量δr(Ast0)与星敏感器光轴指向矢量
Figure FDA0002413923190000031
夹角为
Figure FDA0002413923190000032
星敏感器视场角为FOV，则小行星相对卫星理论方向矢量δr(Ast0)在星敏感器视场范围内满足条件
Figure FDA0002413923190000033
如果小行星相对卫星理论方向矢量δr(Ast0)不在视场范围内，利用万向轴调整星敏感器光轴指向，使其进入视场范围，如果转动后仍不能进入视场，则无法观测。
8.根据权利要求1所述的卫星相对小行星视觉自主导航方法，其特征在于：所述步骤(8)中判断小行星是否在星敏感器二维像面阵内的过程如下：
根据小行星相对卫星理论方向矢量δr(Ast0)投影在星敏感器二维像面阵的几何关系，解其坐标为
Figure FDA0002413923190000034
设二维像面阵长度和宽度分别为IPlongth和IPwidth，则小行星在像平面坐标需要满足条件
Figure FDA0002413923190000035
Figure FDA0002413923190000036
9.根据权利要求1所述的卫星相对小行星视觉自主导航方法，其特征在于：所述步骤(9)中计算小行星相对卫星理论方向矢量和方位角与俯仰角具体为：
小行星相对卫星单位方向矢量
Figure FDA0002413923190000041
由星敏感器获得，得小行星相对卫星方位角α与俯仰角δ，卫星和小行星相对距离|δr(Ast0)|由星间链路获得，得到小行星相对卫星理论方向矢量δr(Ast0)
Figure FDA0002413923190000042
其中，
Figure FDA0002413923190000043
小行星相对卫星方位由方位角和俯仰角描述，在卫星本体坐标系ob-xbybzb中，定义方位角α为δr(Ast0)在ob-ybzb平面的投影与yb轴夹角，俯仰角δ为δr(Ast0)与xb轴夹角，表示为
Figure FDA0002413923190000044
Figure FDA0002413923190000045
其中，
Figure FDA0002413923190000046
Figure FDA0002413923190000047
是地心惯性坐标系相对本体坐标系姿态转换矩阵。
10.根据权利要求1所述的卫星相对小行星视觉自主导航方法，其特征在于：所述步骤(10)具体为：
根据步骤(9)所得小行星相对卫星的理论方向矢量和方位角与俯仰角，卫星采用万向轴调整星敏感器真实光轴指向与理论方向矢量相吻合，并利用星敏感器进行实际测量；
卫星星敏感器真实观测小行星，输出小行星相对卫星单位方向矢量真实测量值
Figure FDA0002413923190000048
由卫星激光测距仪测量卫星和小行星之间的实际测量值
Figure FDA0002413923190000049
建立小行星相对卫星观测方程为：
Figure FDA00024139231900000410
其中，
Figure FDA0002413923190000051
11.根据权利要求1所述的卫星相对小行星视觉自主导航方法，其特征在于：所述步骤(11)中对所建立的状态模型和观测方程离散化，并利用Unscented卡尔曼滤波算法估计卫星位置和速度具体为：
对步骤(2)中状态模型及步骤(10)中观测方程进行离散化
Figure FDA0002413923190000052
yk＝g(xk)+vk (12b)
式中，k＝1,2，…，f'(xk,uk)为离散后的状态转移方程，g(xk)为离散后的观测方程，wk和vk分别为离散后的***噪声和观测噪声；
利用Unscented卡尔曼滤波算法，结合步骤所述的状态模型和观测方程进行滤波，根据状态向量可得相应的Unscented采样点，利用***状态模型，对采样点进行一步预测，并得出与上一时刻滤波得到的迭代状态值之间的协方差阵，以消除状态模型中模型误差的影响。
CN201611138342.5A 2016-12-12 2016-12-12 一种卫星相对小行星视觉自主导航方法 Expired - Fee Related CN106643741B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201611138342.5A CN106643741B (zh) 2016-12-12 2016-12-12 一种卫星相对小行星视觉自主导航方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611138342.5A CN106643741B (zh) 2016-12-12 2016-12-12 一种卫星相对小行星视觉自主导航方法

Publications (2)

Publication Number Publication Date
CN106643741A CN106643741A (zh) 2017-05-10
CN106643741B true CN106643741B (zh) 2020-05-19

Family

ID=58824668

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611138342.5A Expired - Fee Related CN106643741B (zh) 2016-12-12 2016-12-12 一种卫星相对小行星视觉自主导航方法

Country Status (1)

Country Link
CN (1) CN106643741B (zh)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107870341B (zh) * 2017-11-08 2021-06-08 上海航天控制技术研究所 一种基于两个标志点矢量信息的卫星自主定位方法
CN108871348B (zh) * 2018-05-08 2020-07-31 中国人民解放军国防科技大学 一种利用天基可见光相机的低轨卫星自主定轨方法
CN109269508A (zh) * 2018-10-09 2019-01-25 东南大学 一种卫星相对小行星视觉自主导航方法
CN109521783A (zh) * 2018-12-04 2019-03-26 航天科工空间工程发展有限公司 一种考虑地球视场约束的绕飞轨迹设计与控制方法
CN109341725A (zh) * 2018-12-06 2019-02-15 北京理工大学 行星接近段导航性能快速评估方法
CN110632935B (zh) * 2019-08-22 2022-09-13 上海航天控制技术研究所 一种编队卫星绕飞自主控制方法
CN111552003B (zh) * 2020-05-11 2020-12-18 中国人民解放军军事科学院国防科技创新研究院 基于球卫星编队的小行星引力场全自主测量***及方法
CN112014869B (zh) * 2020-08-12 2023-11-28 中国科学院微小卫星创新研究院 基于天文导航的星间链路自主导航方法及***
CN113984069B (zh) * 2021-04-30 2023-06-06 北京临近空间飞行器***工程研究所 基于人造卫星的星光定位导航方法
CN114252151A (zh) * 2021-11-29 2022-03-29 中国科学院国家空间科学中心 一种星载光学仪器在轨工作模式自主调整方法及其装置

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10127399A1 (de) * 2001-05-31 2002-12-12 Univ Dresden Tech Verfahren und Vorrichtung zur autonomen Navigation von Satelliten
CN1851408A (zh) * 2006-05-31 2006-10-25 哈尔滨工业大学 基于多天体路标的星际巡航自主导航方法
WO2010011436A1 (en) * 2008-07-24 2010-01-28 Raytheon Company System and method of passive and autonomous navigation of space vehicles using an extended kalman filter
CN102175241A (zh) * 2011-01-13 2011-09-07 北京航空航天大学 一种火星探测器巡航段自主天文导航方法
CN103868514A (zh) * 2014-03-20 2014-06-18 北京航天自动控制研究所 一种在轨飞行器自主导航***
CN104764449A (zh) * 2015-04-23 2015-07-08 北京航空航天大学 一种基于星历修正的捕获段深空探测器自主天文导航方法
CN105203101A (zh) * 2015-09-02 2015-12-30 北京航空航天大学 一种基于目标天体星历修正的深空探测器捕获段天文导航方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10127399A1 (de) * 2001-05-31 2002-12-12 Univ Dresden Tech Verfahren und Vorrichtung zur autonomen Navigation von Satelliten
CN1851408A (zh) * 2006-05-31 2006-10-25 哈尔滨工业大学 基于多天体路标的星际巡航自主导航方法
WO2010011436A1 (en) * 2008-07-24 2010-01-28 Raytheon Company System and method of passive and autonomous navigation of space vehicles using an extended kalman filter
CN102175241A (zh) * 2011-01-13 2011-09-07 北京航空航天大学 一种火星探测器巡航段自主天文导航方法
CN103868514A (zh) * 2014-03-20 2014-06-18 北京航天自动控制研究所 一种在轨飞行器自主导航***
CN104764449A (zh) * 2015-04-23 2015-07-08 北京航空航天大学 一种基于星历修正的捕获段深空探测器自主天文导航方法
CN105203101A (zh) * 2015-09-02 2015-12-30 北京航空航天大学 一种基于目标天体星历修正的深空探测器捕获段天文导航方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
"基于星敏感器/星间链路的HEO卫星群自主导航方法研究";张鸿翼;《中国优秀硕士学位论文数据库 工程科技II辑》;20160815(第8期);第8-59页 *
基于天文/GPS的HEO卫星自主导航方法;王鹏 等;《控制与决策》;20150331;第30卷(第3期);第519-524页 *

Also Published As

Publication number Publication date
CN106643741A (zh) 2017-05-10

Similar Documents

Publication Publication Date Title
CN106643741B (zh) 一种卫星相对小行星视觉自主导航方法
CN106595674B (zh) 基于星敏感器和星间链路的heo卫星编队飞行自主导航方法
CN106595673B (zh) 面对地球静止轨道目标操作的空间多机器人自主导航方法
Woffinden et al. Relative angles-only navigation and pose estimation for autonomous orbital rendezvous
CN106767768A (zh) 一种双星编队的自主导航方法
CN102168981B (zh) 一种深空探测器火星捕获段自主天文导航方法
Trebi-Ollennu et al. Design and analysis of a sun sensor for planetary rover absolute heading detection
EP3346234A1 (en) Autonomous navigation method for mars probe
Li et al. Autonomous navigation and guidance for landing on asteroids
CN107655485B (zh) 一种巡航段自主导航位置偏差修正方法
Bhaskaran et al. Small body landings using autonomous onboard optical navigation
Ning et al. Autonomous satellite navigation using starlight refraction angle measurements
CN111102981B (zh) 一种基于ukf的高精度卫星相对导航方法
CN109269510A (zh) 基于星敏感器和星间链路的heo卫星编队飞行自主导航方法
CN106679653A (zh) 一种基于星敏感器和星间链路的heo卫星群相对测量方法
CN106643742B (zh) 一种卫星自主连续观测小行星的方法
Li et al. Autonomous orbit and attitude determination for Earth satellites using images of regular-shaped ground objects
Benninghoff et al. Autonomous navigation for on-orbit servicing
Xinlong et al. An autonomous navigation scheme based on geomagnetic and starlight for small satellites
Wang et al. A high-accuracy constrained SINS/CNS tight integrated navigation for high-orbit automated transfer vehicles
CN109269508A (zh) 一种卫星相对小行星视觉自主导航方法
CN106871890A (zh) 一种用于卫星编队的星间相对观测方法
Zhu et al. A high-accuracy SINS/CNS integrated navigation scheme based on overall optimal correction
CN106855408A (zh) 一种面向geo卫星在轨服务的空间多机器人相对观测方法
Riedel et al. Optical navigation plan and strategy for the lunar lander Altair; OpNav for lunar and other crewed and robotic exploration applications

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
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20200519