CN112129318B - 一种基于加速度计反馈的火星探测轨道精确控制方法 - Google Patents
一种基于加速度计反馈的火星探测轨道精确控制方法 Download PDFInfo
- Publication number
- CN112129318B CN112129318B CN202010121024.8A CN202010121024A CN112129318B CN 112129318 B CN112129318 B CN 112129318B CN 202010121024 A CN202010121024 A CN 202010121024A CN 112129318 B CN112129318 B CN 112129318B
- Authority
- CN
- China
- Prior art keywords
- mars
- coordinate system
- orbit control
- under
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
本发明提供了一种基于加速度计反馈的火星探测轨道精确控制方法。火星探测中由于器地距离远,采用地面测控进行轨道确定具有较大的时间延迟,火星探测的轨道控制中,地面无法及时确定变轨精度,而探测器在执行变轨过程中需要满足高精度高可靠的轨道控制要求。在探测器上安装加速度计,在执行变轨过程中,加速度计测量变轨过程中的加速度,加速度积分得到探测器变轨的速度增量,将变轨的实际速度增量与目标速度增量进行实时对比,修正探测器的目标姿态,从而修正实际的速度增量,以提高变轨的精度。本发明与现有技术相比,其效果是:将探测器在变轨过程中的速度增量引入轨道控制过程,提高变轨的控制精度。
Description
技术领域
本发明涉及一种基于加速度计反馈的火星探测轨道精确控制方法,用于满足深空探测高精度轨道控制需求,属于深空探测轨道控制技术领域。
背景技术
我国未来深空探测任务将重点开展月球永久阴影区探测、小行星采样返回探测、火星采样返回探测、木星系及行星际穿越探测、太阳系边际探测等一系列深空探测活动。而深空探测中轨道控制的精度影响着探测器的燃料消耗以及进入任务轨道的精度。
目前深空探测器中安装了加速度计对速度增量进行测量,但是加速度计的作用为关机时刻的参数,并未将速度增量引入闭环进行轨道控制,所以目前深空探测的轨道控制为开环控制,轨道控制精度完全由轨道控制前的测定轨精度决定,不能进行实施修正。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提供了一种基于加速度计反馈的火星探测轨道精确控制方法,加速度计对轨道控制期间的加速度测量值进行在轨积分得到速度矢量,利用速度增量的方向对目标姿态的方向进行在线修正,提高轨道控制精度。
本发明的技术解决方案是:一种基于加速度计反馈的火星探测轨道精确控制方法,该方法包括如下步骤:
(1)、根据加速度计测量得到的火星探测器在其本体坐标系下的加速度,计算从轨道控制开始时刻到当前轨道控制周期火星探测器在惯性坐标系下速度增量;
(2)、计算从轨道控制开始时刻到当前轨道控制周期火星探测器在惯性坐标系下速度增量与火星探测器目标姿态推力方向夹角,从而得到从轨道控制开始时刻到当前轨道控制周期速度增量方向与目标推力方向之间的偏差四元数;
(3)、利用从轨道控制开始时刻到当前轨道控制周期速度增量方向与目标推力方向之间的偏差四元数,对火星探测器目标四元数进行修正;
(4)、利用修正后火星探测器目标四元数,进行火星探测轨道精确控制。
所述步骤(1)的具体实现为:
(1.1)、获取加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度;
(1.2)、将加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度转化为当前轨道控制周期火星探测器在惯性坐标系下的加速度;
(1.3)、将火星探测器在惯性坐标系下的加速度进行累加,计算得到从轨道控制开始时刻到当前轨道控制周期火星探测器在惯性坐标系下的速度增量。
所述步骤(1.2)的计算公式为:
其中,aINSx为当前轨道控制周期火星探测器在惯性坐标系下的加速度x方向分量;aINSy为当前轨道控制周期火星探测器在惯性坐标系下速度增量y方向分量;aINSz为当前轨道控制周期火星探测器在惯性坐标系下速度增量z方向分量;
ax为加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度x方向分量;ay为加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度y方向分量;az为加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度z方向分量;
其中qbi=[q0 q1 q2 q3]为当前探测器的惯性四元数。
所述步骤(1.3)的计算公式为:
ΔVINSx(k)=ΔVINSx(k-1)+aINSx×T
ΔVINSy(k)=ΔVINSy(k-1)+aINSy×T
ΔVINSz(k)=ΔVINSz(k-1)+aINSz×T
其中:ΔVINSx(k)为从轨道控制开始时刻到第k个轨道控制周期火星探测器在惯性坐标系下x方向的速度增量;ΔVINSy(k)为从轨道控制开始时刻到第k个轨道控制周期火星探测器在惯性坐标系下y方向的速度增量;ΔVINSz(k)为从轨道控制开始时刻到第k个轨道控制周期火星探测器在惯性坐标系下z方向的速度增量;ΔVINSx(k-1)为从轨道控制开始时刻到第k-1个轨道控制周期火星探测器在惯性坐标系下x方向的速度增量;ΔVINSy(k-1)为从轨道控制开始时刻到第k-1个轨道控制周期火星探测器在惯性坐标系下y方向的速度增量;ΔVINSz(k-1)为从轨道控制开始时刻到第k-1个轨道控制周期火星探测器在惯性坐标系下z方向的速度增量;aINSx为当前轨道控制周期火星探测器在惯性坐标系下速度增量;aINSy为当前轨道控制周期火星探测器在惯性坐标系下速度增量;aINSz为当前轨道控制周期火星探测器在惯性坐标系下速度增量;T为火星探测器的轨道控制周期。
所述惯性坐标系下目标推力方向与速度增量方向夹角Δθ的计算公式为:
所述目标推力方向与速度增量方向的偏差四元数Δq为:
所述步骤(3)中采用偏差四元数对轨道控制期间的目标四元数进行修正的方法为:
其中,Δqbo为火星探测器的目标四元数,qb′o为修正后的火星探测器的目标四元数。
所述惯性坐标系为J2000坐标系、地心平赤道惯性坐标系、火星惯性坐标系。
本发明与现有技术相比的有益效果是:
(1)、本发明利用加表的输出的加速度积分得到速度增量,速度增量方向与目标速度增量的方向修正探测器的姿态,以减小实际的速度增量方向与目标速度增量方向的偏差,提高了深空探测轨道控制的精度;
(2)、本发明采用了将速度增量的方向引入控制的方法修正探测器的姿态,该方法实现了速度增量方向的闭环控制,将实际轨道控制执行的速度增量方向进行在线修正,以提高与目标速度增量方向的偏差,提高了轨道控制精度。
(3)、本发明采用了加表的输出进行累加得到轨道控制的速度增量,这个方式实现轨道控制期间速度增量的实时计算。
附图说明
图1为本发明实施例基于加速度计反馈的火星探测轨道精确控制方法流程图;
图2为本发明实施例坐标系及速度增量关系;
图3为本发明实施例修正后的姿态基准。
具体实施方式
以下结合附图和具体实施例对本发明进行详细说明。
如图1所示,本发明提供了一种基于加速度计反馈的火星探测轨道精确控制方法的具体实施例,该方法包括如下步骤:
(1)、根据加速度计测量得到的火星探测器在其本体坐标系下的加速度,计算从轨道控制开始时刻到当前轨道控制周期火星探测器在惯性坐标系下速度增量;具体实现为:
(1.1)、获取加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度;
(1.2)、将加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度转化为当前轨道控制周期火星探测器在惯性坐标系下的加速度;所述惯性坐标系为J2000坐标系、地心平赤道惯性坐标系、火星惯性坐标系。
具体计算公式为:
其中,aINSx为当前轨道控制周期火星探测器在惯性坐标系下的加速度x方向分量;aINSy为当前轨道控制周期火星探测器在惯性坐标系下速度增量y方向分量;aINSz为当前轨道控制周期火星探测器在惯性坐标系下速度增量z方向分量;
ax为加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度x方向分量;ay为加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度y方向分量;az为加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度z方向分量;
其中qbi=[q0 q1 q2 q3]为当前探测器的惯性四元数。
(1.3)、将火星探测器在惯性坐标系下的加速度进行累加,计算得到从轨道控制开始时刻到当前轨道控制周期火星探测器在惯性坐标系下的速度增量。
计算公式为:
ΔVINSx(k)=ΔVINSx(k-1)+aINSx×T
ΔVINSy(k)=ΔVINSy(k-1)+aINSy×T
ΔVINSz(k)=ΔVINSz(k-1)+aINSz×T
其中:ΔVINSx(k)为从轨道控制开始时刻到第k个轨道控制周期火星探测器在惯性坐标系下x方向的速度增量;ΔVINSy(k)为从轨道控制开始时刻到第k个轨道控制周期火星探测器在惯性坐标系下y方向的速度增量;ΔVINSz(k)为从轨道控制开始时刻到第k个轨道控制周期火星探测器在惯性坐标系下z方向的速度增量;ΔVINSx(k-1)为从轨道控制开始时刻到第k-1个轨道控制周期火星探测器在惯性坐标系下x方向的速度增量;ΔVINSy(k-1)为从轨道控制开始时刻到第k-1个轨道控制周期火星探测器在惯性坐标系下y方向的速度增量;ΔVINSz(k-1)为从轨道控制开始时刻到第k-1个轨道控制周期火星探测器在惯性坐标系下z方向的速度增量;aINSx为当前轨道控制周期火星探测器在惯性坐标系下速度增量;aINSy为当前轨道控制周期火星探测器在惯性坐标系下速度增量;aINSz为当前轨道控制周期火星探测器在惯性坐标系下速度增量;T为火星探测器的轨道控制周期。
(2)、计算从轨道控制开始时刻到当前轨道控制周期火星探测器在惯性坐标系下速度增量与火星探测器目标姿态推力方向夹角Δθ,从而得到从轨道控制开始时刻到当前轨道控制周期速度增量方向与目标推力方向之间的偏差四元数;
所述惯性坐标系下目标推力方向与速度增量方向夹角Δθ的计算公式为:
(3)、利用从轨道控制开始时刻到当前轨道控制周期速度增量方向与目标推力方向之间的偏差四元数,对火星探测器目标四元数进行修正;
所述目标推力方向与速度增量方向的偏差四元数Δq为:
采用偏差四元数对轨道控制期间的目标四元数进行修正的方法为:
其中,Δqbo为火星探测器的目标四元数,qb′o为修正后的火星探测器的目标四元数。
(4)、利用修正后火星探测器目标四元数,进行火星探测轨道精确控制。
本步骤可以采用双关机策略进行轨道控制,轨控过程将加速度信息引入闭环控制,利用速度增量的反向修正目标姿态,减小探测器最终产生的实际速度增量方向与目标速度增量方向误差。
实施例:
以下以J2000惯性坐标系为例,对本发明提供的一种基于加速度计反馈的火星探测轨道精确控制方法进行说明,本实施例中主要包括如下步骤:
1)、探测器在J2000惯性坐标系中的速度增量计算。
其中qbi=[q0 q1 q2 q3]
将深空探测器本体系下的加速度转化为J2000惯性系下的加速度
将J2000系下的加速度进行累加计算得到J2000系下的速度增量:
ΔVJ2000x(k)=ΔVJ2000x(k-1)+aJ2000x×T
ΔVJ2000y(k)=ΔVJ2000y(k-1)+aJ2000y×T
ΔVJ2000z(k)=ΔVJ2000z(k-1)+aJ2000z×T
其中,T为探测器的控制周期。
2)计算偏差四元数
计算目标推力方向与速度增量方向的偏差四元数:
3)、修正目标姿态
将计算得到的偏差四元数对轨道控制期间的目标四元数进行修正:
其中,Δqbo为探测器的目标四元数,qb′o为修正后的目标四元数。
4)、利用修正后火星探测器目标四元数,进行火星探测轨道精确控制。
实施例:
如图3所示,本发明某一具体实施例中,轨控前5min进入200ms喷气惯性保持模式,速度增量开始累加,3000N开机时开启加速度计反馈控制算法,对姿态进行补偿,则3000N开机时的控制用基准跳变,该跳变角度为加表反馈的姿态偏差,对控制基准进行修正。
本说明书中未进行详细描述部分属于本领域技术人员公知常识。
Claims (9)
1.一种基于加速度计反馈的火星探测轨道精确控制方法,其特征在于包括如下步骤:
(1)、根据加速度计测量得到的火星探测器在其本体坐标系下的加速度,计算从轨道控制开始时刻到当前轨道控制周期火星探测器在惯性坐标系下速度增量;
(2)、计算从轨道控制开始时刻到当前轨道控制周期火星探测器在惯性坐标系下速度增量与火星探测器目标姿态推力方向夹角,从而得到从轨道控制开始时刻到当前轨道控制周期速度增量方向与目标推力方向之间的偏差四元数;
(3)、利用从轨道控制开始时刻到当前轨道控制周期速度增量方向与目标推力方向之间的偏差四元数,对火星探测器目标四元数进行修正;
(4)、利用修正后火星探测器目标四元数,进行火星探测轨道精确控制。
2.根据权利要求1所述的一种基于加速度计反馈的火星探测轨道精确控制方法,其特征在于所述步骤(1)的具体实现为:
(1.1)、获取加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度;
(1.2)、将加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度转化为当前轨道控制周期火星探测器在惯性坐标系下的加速度;
(1.3)、将火星探测器在惯性坐标系下的加速度进行累加,计算得到从轨道控制开始时刻到当前轨道控制周期火星探测器在惯性坐标系下的速度增量。
3.根据权利要求2所述的一种基于加速度计反馈的火星探测轨道精确控制方法,其特征在于所述步骤(1.2)的计算公式为:
其中,aINSx为当前轨道控制周期火星探测器在惯性坐标系下的加速度x方向分量;aINSy为当前轨道控制周期火星探测器在惯性坐标系下速度增量y方向分量;aINSz为当前轨道控制周期火星探测器在惯性坐标系下速度增量z方向分量;
ax为加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度x方向分量;ay为加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度y方向分量;az为加速度计测量得到的当前轨道控制周期火星探测器在其本体坐标系下的加速度z方向分量;
5.根据权利要求2所述的一种基于加速度计反馈的火星探测轨道精确控制方法,其特征在于所述步骤(1.3)的计算公式为:
ΔVINSx(k)=ΔVINSx(k-1)+aINSx×T
ΔVINSy(k)=ΔVINSy(k-1)+aINSy×T
ΔVINSz(k)=ΔVINSz(k-1)+aINSz×T
其中:ΔVINSx(k)为从轨道控制开始时刻到第k个轨道控制周期火星探测器在惯性坐标系下x方向的速度增量;ΔVINSy(k)为从轨道控制开始时刻到第k个轨道控制周期火星探测器在惯性坐标系下y方向的速度增量;ΔVINSz(k)为从轨道控制开始时刻到第k个轨道控制周期火星探测器在惯性坐标系下z方向的速度增量;ΔVINSx(k-1)为从轨道控制开始时刻到第k-1个轨道控制周期火星探测器在惯性坐标系下x方向的速度增量;ΔVINSy(k-1)为从轨道控制开始时刻到第k-1个轨道控制周期火星探测器在惯性坐标系下y方向的速度增量;ΔVINSz(k-1)为从轨道控制开始时刻到第k-1个轨道控制周期火星探测器在惯性坐标系下z方向的速度增量;aINSx为当前轨道控制周期火星探测器在惯性坐标系下速度增量;aINSy为当前轨道控制周期火星探测器在惯性坐标系下速度增量;aINSz为当前轨道控制周期火星探测器在惯性坐标系下速度增量;T为火星探测器的轨道控制周期。
9.根据权利要求1所述的一种基于加速度计反馈的火星探测轨道精确控制方法,其特征在于所述惯性坐标系为J2000坐标系、地心平赤道惯性坐标系或者火星惯性坐标系。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010121024.8A CN112129318B (zh) | 2020-02-26 | 2020-02-26 | 一种基于加速度计反馈的火星探测轨道精确控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010121024.8A CN112129318B (zh) | 2020-02-26 | 2020-02-26 | 一种基于加速度计反馈的火星探测轨道精确控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112129318A CN112129318A (zh) | 2020-12-25 |
CN112129318B true CN112129318B (zh) | 2022-10-14 |
Family
ID=73850381
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010121024.8A Active CN112129318B (zh) | 2020-02-26 | 2020-02-26 | 一种基于加速度计反馈的火星探测轨道精确控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112129318B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115236961B (zh) * | 2022-04-02 | 2023-09-12 | 北京航天飞行控制中心 | 火星时间的确定方法、装置、存储介质以及电子装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105511490A (zh) * | 2015-12-15 | 2016-04-20 | 北京理工大学 | 一种静止轨道卫星位置保持-角动量卸载联合控制方法 |
CN108454883A (zh) * | 2018-02-27 | 2018-08-28 | 北京控制工程研究所 | 一种动力上升二次轨控可靠入轨方法及系统 |
CN108548542A (zh) * | 2018-07-13 | 2018-09-18 | 北京航空航天大学 | 一种基于大气阻力加速度测量的近地轨道确定方法 |
CN108594802A (zh) * | 2018-02-28 | 2018-09-28 | 北京控制工程研究所 | 探测器目标着陆区域确定及避障制导方法与装置 |
CN109625323A (zh) * | 2018-11-09 | 2019-04-16 | 中国科学院空间应用工程与技术中心 | 一种卫星化学推进变轨方法及系统 |
-
2020
- 2020-02-26 CN CN202010121024.8A patent/CN112129318B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105511490A (zh) * | 2015-12-15 | 2016-04-20 | 北京理工大学 | 一种静止轨道卫星位置保持-角动量卸载联合控制方法 |
CN108454883A (zh) * | 2018-02-27 | 2018-08-28 | 北京控制工程研究所 | 一种动力上升二次轨控可靠入轨方法及系统 |
CN108594802A (zh) * | 2018-02-28 | 2018-09-28 | 北京控制工程研究所 | 探测器目标着陆区域确定及避障制导方法与装置 |
CN108548542A (zh) * | 2018-07-13 | 2018-09-18 | 北京航空航天大学 | 一种基于大气阻力加速度测量的近地轨道确定方法 |
CN109625323A (zh) * | 2018-11-09 | 2019-04-16 | 中国科学院空间应用工程与技术中心 | 一种卫星化学推进变轨方法及系统 |
Non-Patent Citations (1)
Title |
---|
行星际小推力轨道Lambert解及应用;尚海滨等;《航空学报》;20100930;第31卷(第9期);1752-1757 * |
Also Published As
Publication number | Publication date |
---|---|
CN112129318A (zh) | 2020-12-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104142686B (zh) | 一种卫星自主编队飞行控制方法 | |
Crassidis et al. | Predictive filtering for attitude estimation without rate sensors | |
Jiancheng et al. | Study on innovation adaptive EKF for in-flight alignment of airborne POS | |
Crassidis et al. | Minimum model error approach for attitude estimation | |
CN102620886B (zh) | 两步在轨辨识组合航天器转动惯量估计方法 | |
CN105806369B (zh) | 一种星敏感器在轨光行差修正方法 | |
CN108959734B (zh) | 一种基于实时递推太阳光压力矩辨识方法及系统 | |
CN111989265B (zh) | 超低轨道卫星轨道自主维持方法 | |
CN110304279A (zh) | 一种电推进卫星的质心在轨标定补偿方法 | |
CN100559190C (zh) | 一种对加速度计零位偏差进行在轨标定的方法 | |
CN112129318B (zh) | 一种基于加速度计反馈的火星探测轨道精确控制方法 | |
CN101200221A (zh) | 一种利用定轨数据标定加速度计的方法 | |
Ye et al. | Fuzzy sliding mode control of nonparallel-ground-track imaging satellite with high precision | |
CN108516107A (zh) | 一种在线发动机推力和比冲估计方法及系统 | |
CN111207773A (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
CN105573332B (zh) | 延长空间仪器太阳测量时间的太阳跟踪系统姿态调整方法 | |
CN110955255B (zh) | 基于cmg的高精度轨控姿态维持方法、系统及介质 | |
CN111024128B (zh) | 一种机载光电吊舱光轴稳定状态传递对准方法 | |
CN112306075A (zh) | 一种高精度离轨反向迭代制导方法 | |
CN107228683B (zh) | 一种多星敏感器间慢变误差实时在轨修正方法 | |
CN107132850B (zh) | 基于角速度跟踪的变轨姿态保持控制方法 | |
CN111947668B (zh) | 基于在线估计的木星探测器测角/测距组合导航方法 | |
Keqiang et al. | A satellite attitude determination method based on error compensation | |
CN112498747B (zh) | 深空探测器推力矢量与目标加速度偏差角计算方法及系统 | |
Adnane et al. | Reliable Kalman filtering for satellite attitude estimation under gyroscope partial failure |
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 |