CN109606739A - 一种探测器地月转移轨道修正方法及装置 - Google Patents
一种探测器地月转移轨道修正方法及装置 Download PDFInfo
- Publication number
- CN109606739A CN109606739A CN201910108507.1A CN201910108507A CN109606739A CN 109606739 A CN109606739 A CN 109606739A CN 201910108507 A CN201910108507 A CN 201910108507A CN 109606739 A CN109606739 A CN 109606739A
- Authority
- CN
- China
- Prior art keywords
- correction
- orbit
- time
- state quantity
- sub
- 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
- 238000012546 transfer Methods 0.000 title claims abstract description 29
- 238000002715 modification method Methods 0.000 title abstract 2
- 238000012937 correction Methods 0.000 claims abstract description 141
- 239000013598 vector Substances 0.000 claims description 67
- 238000000034 method Methods 0.000 claims description 39
- PEDCQBHIVMGVHV-UHFFFAOYSA-N Glycerine Chemical compound OCC(O)CO PEDCQBHIVMGVHV-UHFFFAOYSA-N 0.000 claims description 31
- 238000004422 calculation algorithm Methods 0.000 claims description 24
- 230000010354 integration Effects 0.000 claims description 16
- 206010048669 Terminal state Diseases 0.000 claims description 15
- 238000004364 calculation method Methods 0.000 claims description 13
- 239000000523 sample Substances 0.000 claims description 13
- 230000005484 gravity Effects 0.000 claims description 5
- 238000012986 modification Methods 0.000 claims description 3
- 230000004048 modification Effects 0.000 claims description 3
- 239000003607 modifier Substances 0.000 claims 2
- 238000002347 injection Methods 0.000 abstract 1
- 239000007924 injection Substances 0.000 abstract 1
- 230000008569 process Effects 0.000 description 12
- 239000011159 matrix material Substances 0.000 description 8
- 238000006243 chemical reaction Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 238000013459 approach Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000013461 design Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 108091092878 Microsatellite Proteins 0.000 description 1
- 238000002485 combustion reaction Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012804 iterative process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/242—Orbits and trajectories
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- General Physics & Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Pure & Applied Mathematics (AREA)
- Remote Sensing (AREA)
- Computational Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Combustion & Propulsion (AREA)
- Operations Research (AREA)
- Aviation & Aerospace Engineering (AREA)
- Algebra (AREA)
- Chemical & Material Sciences (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Navigation (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种探测器地月转移轨道修正方法,包括:获取主卫星入轨时刻的状态量,将获取到的所述状态量作为所述探测器的入轨时刻状态量;以所述入轨时刻状态量作为初值在预设的轨道动力学模型下进行轨道数值积分运算,求得修正时刻状态量;以所述修正时刻状态量作为初值在所述预设的轨道动力学模型下进行轨道数值积分运算,求得终端时刻状态量;计算所述终端时刻状态量与终端时刻标准量的差值,所述差值为第一偏差量;根据所述第一偏差量计算第一修正量;按照所述第一修正量对所述修正时刻状态量进行修正。本发明还公开了一种探测器地月转移轨道修正装置。
Description
技术领域
本发明涉及航天技术领域,尤其涉及一种探测器地月转移轨道修正方法及装置。
背景技术
月球是距离地球最近的天体,且其蕴藏着丰富的自然资源和能源,一直以来都是各个国家进行深空探测任务的起点和基础。对月球进行探测是我们走出地球探索宇宙的第一步,同时也是为未来月球资源的开发和利用奠定基础。
目前,随着航天技术的发展,微纳卫星凭借其低成本、小型化的特点得到了大家的青睐。在利用微纳卫星对月球进行探测活动时,为了降低成本,通常利用其他主要探月任务的剩余载荷,采取搭载发射的发射方式。这样,由于主卫星已进行了详细的地月转移轨道设计,而搭载的微纳卫星的入轨速度与主卫星的入轨速度非常接近。因此,不需要再对搭载的微纳卫星进行地月转移轨道设计。
但由于入轨误差以及导航误差的存在,微纳卫星在进入地月转移轨道时会产生一定的偏差。如果不对这些偏差进行修正,则微纳卫星很有可能不能进入月球卫星轨道,从而导致探月任务失败。因此,必须在地月转移轨道阶段对卫星轨道进行中途修正使其到达预定位置。目前在求解中途修正所要施加的速度增量主要采用的方法是微分修正算法。该算法主要依赖于偏导数矩阵的求解以及初值的确定。现有技术对初值的确定,通常采用圆锥曲线拼接法和伪状态理论等方法,得到的初值存在较大误差。而微分修正算法对初值的精度要求比较高,如果初值选取不当,会导致迭代发散。
发明内容
有鉴于此,本发明实施例提供了一种探测器地月转移轨道修正的方法及装置。
本发明实施例提供一种探测器地月转移轨道修正的方法,包括:
获取主卫星入轨时刻的状态量,将获取到的所述状态量作为所述探测器的入轨时刻状态量;
以所述入轨时刻状态量作为初值在预设的轨道动力学模型下进行轨道数值积分运算,求得修正时刻状态量;其中,所述入轨时刻早于所述修正时刻;
以所述修正时刻状态量作为初值在所述预设的轨道动力学模型下进行轨道数值积分运算,求得终端时刻状态量;其中,所述修正时刻早于所述终端时刻;
计算所述终端时刻状态量与终端时刻标准量的差值,所述差值为第一偏差量;
根据所述第一偏差量计算第一修正量;
按照所述第一修正量对所述修正时刻状态量进行修正。
上述方案中,所述根据所述第一偏差量计算第一修正量,具体包括:
根据所述第一偏差量,通过微分修正算法计算所述第一修正量。
上述方案中,所述根据所述第一偏差量,通过微分修正算法计算所述第一修正量,具体包括:
将所述第一偏差量分为N个子偏差量,进而得到N个子终端状态值,其中,N为正整数;
通过微分修正算法依次计算所述N个子终端状态值对应的N个子修正量;
将所述N个子修正量相加,得到所述第一修正量。
上述方案中,所述将所述第一偏差量分为N个子偏差量,包括:
将所述第一偏差量等分为N个子偏差量。
上述方案中,所述预设的轨道动力学模型表达式为
其中,μE为地球引力常数,μM为月球引力常数,μS为太阳引力常数,r为所述探测器相对于地球的位置矢量,rM为所述探测器相对于月球的位置矢量,rS为所述探测器相对于太阳的位置矢量,ρM为月球相对于地球的位置矢量,ρS为太阳相对于地球的位置矢量,v表示所述探测器相对于地球的速度矢量,为r的一阶导数,为v的一阶导数。
本发明实施例提供一种探测器地月转移轨道修正的装置,包括:
主控模块,用于获取主卫星入轨时刻的状态量,将获取到的所述状态量作为所述探测器的入轨时刻状态量;
运算模块,用于以所述入轨时刻状态量作为初值在预设的轨道动力学模型下进行轨道数值积分运算,求得修正时刻状态量;其中,所述入轨时刻早于所述修正时刻;
所述运算模块,还用于以所述修正时刻状态量作为初值在所述预设的轨道动力学模型下进行轨道数值积分运算,求得终端时刻状态量;其中,所述修正时刻早于所述终端时刻;
所述运算模块,还用于计算所述终端时刻状态量与终端时刻标准量的差值,所述差值为第一偏差量;
修正量计算模块,用于根据所述第一偏差量计算第一修正量;
修正模块,用于按照所述第一修正量对所述修正时刻状态量进行修正。
上述方案中,所述修正量计算模块,还用于根据所述第一偏差量,通过微分修正算法计算所述第一修正量。
上述方案中,所述修正量计算模块,还用于将所述第一偏差量分为N个子偏差量,进而得到N个子终端状态值,其中,N为正整数;通过微分修正算法依次计算所述N个子终端状态值对应的N个子修正量;将所述N个子修正量相加,得到所述第一修正量。
上述方案中,所将所述第一偏差量分为N个子偏差量,包括:
将所述第一偏差量等分为N个子偏差量。
上述方案中,所述预设的轨道动力学模型表达式为
其中,μE为地球引力常数,μM为月球引力常数,μS为太阳引力常数,r为所述探测器相对于地球的位置矢量,rM为所述探测器相对于月球的位置矢量,rS为所述探测器相对于太阳的位置矢量,ρM为月球相对于地球的位置矢量,ρS为太阳相对于地球的位置矢量,v表示所述探测器相对于地球的速度矢量,为r的一阶导数,为v的一阶导数。
本发明实施例提供的探测器地月转移轨道修正的方法,通过获取主卫星入轨时刻的状态量,将获取到的所述状态量作为所述探测器的入轨时刻状态量;以所述入轨时刻状态量作为初值在预设的轨道动力学模型下进行轨道数值积分运算,求得修正时刻状态量;以所述修正时刻状态量作为初值在所述预设的轨道动力学模型下进行轨道数值积分运算,求得终端时刻状态量;计算所述终端时刻状态量与终端时刻标准量的差值,所述差值为第一偏差量;根据所述第一偏差量计算第一修正量;按照所述第一修正量对所述修正时刻状态量进行修正;其中,所述入轨时刻早于所述修正时刻,所述修正时刻早于所述终端时刻。在实际应用中,由于主卫星的体积远大于探测器,体积越大的设备在太空中越容易被探测到;而且主卫星所能够携带的设备数量和运行功率也远大于探测器,能够实现更加稳定的数据测量和通信交互;而探测器是与主卫星搭载发射的,故探测器的地月转移轨道与主卫星的地月转移轨道相接近,故入轨时刻主卫星与探测器的状态量也非常接近;因此,对主卫星的状态量获取的精确度远高于直接获取探测器的状态量,如此,本发明在现有技术的基础上,通过获取主卫星入轨时刻的状态量作为探测器的入轨时刻状态量,可以实现比直接获取所述探测器的状态量精确度更高的技术效果,并进一步在预设的轨道动力学模型下推算,所得的修正时刻状态量和终端时刻状态量也更加精确,减少了现有技术在轨道修正计算中初值误差较大的问题。
附图说明
附图以示例而非限制的方式大体示出了本文中所讨论的各个实施例。
图1为本发明实施例一种探测器地月转移轨道修正方法流程示意图;
图2为本发明实施例一种探测器地月转移轨道修正装置结构示意图;
图3为本发明实施例一种基于同伦法的搭载微纳卫星地月转移轨道修正方法流程示意图;
图4为本发明实施例修正方法的计算过程效果示意图;
图5为本发明一个具体的实施例修正速度增量计算结果示意图。
具体实施方式
为了能够更加详尽地了解本发明实施例的特点与技术内容,下面结合附图对本发明实施例的实现进行详细阐述,所附附图仅供参考说明之用,并非用来限定本发明实施例。
本发明实施例提供一种探测器地月转移轨道修正方法,如图1所示,包括:
步骤101,获取主卫星入轨时刻的状态量,将获取到的所述状态量作为所述探测器入轨时刻状态量。
所述探测器包括:月球探测器、微纳卫星或其它与主卫星共同发射的探测设备。
所述主卫星包括:空间站、卫星或其它航天器。所述主卫星的体积和质量通常远大于所述探测器,例如,嫦娥四号中继星和搭载发射的微纳卫星。
由于主卫星已进行了详细的地月转移轨道设计,因此,不需要再对搭载的探测器进行地月转移轨道设计,而直接利用主卫星的转移轨道数据。即描述探测器与主卫星这样的关系,是为了说明探测器不需要再进行转移轨道设计这样复杂的工作。
步骤102,以所述入轨时刻状态量作为初值在预设的轨道动力学模型下进行轨道数值积分运算,求得修正时刻状态量;其中,所述入轨时刻早于所述修正时刻。
修正时刻包括探测器进行轨道修正的时刻,所述修正时刻为预设的时间;在一些实施例中,在所述修正时刻对探测器施加修正脉冲,实现探测器的状态量调整,进而实现轨道修正。
在一些实施例中,所述预设的轨道动力学模型的表达式为:
其中,μE为地球引力常数,μM为月球引力常数,μS为太阳引力常数,r为所述探测器相对于地球的位置矢量,rM为所述探测器相对于月球的位置矢量,rS为所述探测器相对于太阳的位置矢量,ρM为月球相对于地球的位置矢量,ρS为太阳相对于地球的位置矢量,v表示所述探测器相对于地球的速度矢量,为r的一阶导数,为v的一阶导数。
步骤103,以所述修正时刻状态量作为初值在所述预设的轨道动力学模型下进行轨道数值积分运算,求得终端时刻状态量;其中,所述修正时刻早于所述终端时刻。
终端时刻包括所述探测器抵达目标轨道的时刻。
步骤104,计算所述终端时刻状态量与终端时刻标准量的差值,所述差值为第一偏差量。
终端时刻标准量为所述探测器按照预设的目标轨道运行所需要的理论状态量。所述目标轨道包括目标月球轨道。
步骤105,根据所述第一偏差量计算第一修正量。
在一些实施例中,所述步骤105具体包括:根据所述第一偏差量,通过微分修正算法计算所述第一修正量。
在一些实施例中,所述步骤105具体包括:
将所述第一偏差量分为N个子偏差量,进而得到N个子终端状态值,其中,N为正整数;
通过微分修正算法依次计算所述N个子终端状态值对应的N个子修正量;
将所述N个子修正量相加,得到所述第一修正量。
在一些实施例中,所述将所述第一偏差量分为N个子偏差量,包括:将所述第一偏差量等分为N个子偏差量。
在一些实施例中,N值的确定过程包括:
所述终端时刻标准量的三个标称参数为近月点高度hp-req、真近点角为0°(转换为)和轨道倾角ip-req,定义终端要求标称参数向量其中,rp-req为所述终端时刻标准量的位置矢量,vp-req为所述终端时刻标准量的速度矢量;定义无修正脉冲时,所述终端时刻状态量的实际近月点高度为hp、实际真近点角为θp(转换为)和实际轨道倾角ip,终端实际参数向量为其中,rp为所述终端时刻标准量的位置矢量,vp为所述终端时刻标准量的速度矢量;定义第一偏差量errp=qp-qp-req,且|errp|表示所述第一偏差量的模值。若|errp|<0.5,则取N=1;若0.5≤|errp|<2,则取N=2;若2≤|errp|<25,则取N=5;若|errp|≥25,则取N=10。在实际应用中,若N过大,则形成的子问题越多,会导致本算法的计算代价增大;N过小,则有可能会使迭代过程不收敛,导致微分修正算法失效。对于本发明所应用的场景,通常N的取值在10以内就可得到合适的解。需要强调的是,以上N的取值只是为了举例说明本发明的实施方案,而非对本发明所公开方法的限制。
步骤106,按照所述第一修正量对所述修正时刻状态量进行修正。
在一些实施例中,所述步骤106具体包括:按照所述第一修正量生成修正指令,按照所述修正指令产生修正脉冲,所述修正脉冲用于对所述修正时刻状态量进行修正。
修正脉冲包括工质推进:根据动量守恒定律,通过向反方向喷射有质量物体获得向前的推进力,例如:喷射气体、发射有质量物体、排出发动机燃烧产物等。
本发明实施例提供一种探测器地月转移轨道修正装置,如图2所示,包括:
主控模块201,用于获取主卫星入轨时刻的状态量,将获取到的所述状态量作为所述探测器的入轨时刻状态量;
运算模块202,用于以所述入轨时刻状态量作为初值在预设的轨道动力学模型下进行轨道数值积分运算,求得修正时刻状态量;其中,所述入轨时刻早于所述修正时刻;
所述运算模块202,还用于以所述修正时刻状态量作为初值在所述预设的轨道动力学模型下进行轨道数值积分运算,求得终端时刻状态量;其中,所述修正时刻早于所述终端时刻;
所述运算模块202,还用于计算所述终端时刻状态量与终端时刻标准量的差值,所述差值为第一偏差量;
修正量计算模块203,用于根据所述第一偏差量计算第一修正量;
修正模块204,用于按照所述第一修正量对所述修正时刻状态量进行修正。
本发明实施例提供一种基于同伦法的搭载微纳卫星地月转移轨道修正方法,如图3所示,包括:
步骤301、在已知入轨时刻的探测器的状态量之后,在考虑误差的情况下,以该状态量作为初值在轨道动力学模型下进行数值积分运算,求得中途修正时刻探测器的状态值p0。
入轨时刻探测器的状态参数在J2000.0地心平赤道坐标系下给出,考虑的误差包括星箭分离时所导致的初始入轨误差以及修正前测定轨的导航误差。此外,入轨时刻、中途修正时刻也是预先设定的。
步骤302、以步骤一中得到的中途修正时刻的状态初值作为本方法的初值。在轨道动力学模型下递推得到终端时刻的状态值q0,终端参数选取为近月点高度、轨道倾角和真近点角。
经过轨道动力学模型递推后得到的终端参数需要经过坐标变换才能得到在J2000.0月心平赤道坐标系下的表示形式,即转换为近月点高度、轨道倾角和真近点角。所述终端时刻也是预先设定的。
在所述步骤301和所述步骤302中所采用的轨道动力学模型表达为:
其中,μE、μM和μS分别表示地球、月球和太阳的引力常数,r、rM和rS分别表示航天器相对于地球、月球和太阳的位置矢量,ρM和ρS分别表示月球和太阳相对于地球的位置矢量,v表示航天器相对于地球的速度矢量,|r|、|rM|、|rS|、|ρM|和|ρS|则分别表示相应矢量的模值,为r的一阶导数,为v的一阶导数。
步骤303、计算得到的终端状态值q0与标准参数qreq进行比较,获得参数偏差量errp。取正整数N,将所述参数偏差量进行N等分。引入同伦参数si,且si=i/N,i∈[1,N],则由式((1-si)·errp+qreq)可得到N个终端状态参数值。
正整数N应当在保证算法的有效性的同时,尽量的小,以降低计算成本。
终端标准参数为探测器的近月点高度、轨道倾角和真近点角,在J2000.0月心平赤道坐标系下给出。同时,正整数N的选取非常关键,N过大,则形成的子问题越多,会导致本算法的计算代价增大;N过小,则有可能会使本算法失效。针对本问题中的算例,N值的确定过程如下:所述终端时刻标准量的三个标称参数为近月点高度hp-req、真近点角为0°(转换为)和轨道倾角ip-req,定义终端要求标称参数向量其中,rp-req为所述终端时刻标准量的位置矢量,vp-req为所述终端时刻标准量的速度矢量;定义无修正脉冲时,所述终端时刻状态量的实际近月点高度为hp、实际真近点角为θp(转换为)和实际轨道倾角ip,终端实际参数向量为其中,rp为所述终端时刻标准量的位置矢量,vp为所述终端时刻标准量的速度矢量;定义第一偏差量errp=qp-qp-req,且|errp|表示所述第一偏差量的模值。若|errp|<0.5,则取N=1;若0.5≤|errp|<2,则取N=2;若2≤|errp|<25,则取N=5;若|errp|≥25,则取N=10。对于本问题,通常N的取值在10以内就可得到合适的解。
步骤304、逐次选取所述步骤303中N个终端状态参数值作为终端标称参数,得到N个中途修正子问题。
针对所得到的N个中途修正子问题必须按顺序依次求解,且第一个子问题的初值为中途修正时刻的状态初值,其余子问题的初值均为求解其前一个子问题后所得到的修正后的状态值。
步骤305、采用微分修正算法依次求解每一个子问题,将求得的N个子修正量相加,即为满足任务要求的中途修正速度增量。
所述修正方法的计算过程效果示意图如图4所示,其中,A0为修正时刻状态值,△v1为第1个子问题所得到的子修正速度增量,v0为修正时刻的状态初值速度矢量,v1为第1个子问题所得到的修正后的状态值的速度矢量,vN为第N个子问题所得到的修正后的状态值的速度矢量,B0、B1、Bi、BN分别为对应子问题修正后的终端时刻状态值,q0、q1、qi、qN分别为对应子问题的终端状态参数值。
求解每一个中途修正子问题所采用的算法为微分修正算法,具体过程如下(下角标E代表J2000.0地心平赤道坐标系,下角标M代表J2000.0月心平赤道坐标系):
探测器修正时刻的状态参数记为pE,探测器抵达月球目标轨道的终端参数记为qM。则月球探测器终端状态参数和初始状态参数可以用如下函数关系表示,即
qM=f(pE)
其中,f表示目标参数与控制量的函数关系。
将实际轨道在标称轨道附近进行泰勒展开后只保留线性项,得目标轨道终端参数的增量为
△qM=F△pE
其中△pE是被控制量,△qM为目标轨道终端参数的增量,即中途修正时刻探测器的速度向量,偏导数矩阵F的表达式为
下面给出偏导数矩阵的求解过程:
设修正时刻(最初设定的施加修正脉冲的时刻)和终端时刻(抵达目标轨道的时刻)月球探测器在J2000.0地心平赤道坐标系下的位置和速度的状态量为终端时刻月球探测器在J2000.0月心平赤道坐标系下的位置和速度的状态量为则pE、qM存在如下的关系:
上式中fa表示目标轨道要求的状态参数与卫星终端状态参数的关系,fb表示J2000.0地心平赤道坐标系到J2000.0月心平赤道坐标系的转换关系;fc表示修正时刻到终端时刻的轨道动力学模型递推关系;fd表示修正时刻速度向量与修正时刻位置速度向量的关系。
若仅考虑一阶项,则得
即△qM=(Fa·Fb·Fc·Fd)△pE
其中Fa、Fb、Fc、Fd均为一阶偏导数构成的矩阵,则qM相对于pE的偏导数矩阵为:
F=Fa·Fb·Fc·Fd
其中Fd是探测器中途修正时刻位置速度向量关于该时刻速度向量的函数。可由下式求得:
Fc是状态转移矩阵,其各个元素值可以通过数值积分的方法求得:
其中,为Fc的一阶导数,F11,F12,F21,F22分别对应代表等号前面矩阵的四个部分,为计算过程符号,即:
Fb可以通过J2000.0地心平赤道坐标系到J2000.0月心平赤道坐标系的坐标变换矩阵MEM得到,表示形式如下:
Fa是月球探测器终端参数关于其终端时刻位置速度的函数,求解过程如下(在J2000.0月球赤道惯性坐标系下进行,推导过程省略下角标M):
设月球轨道的轨道倾角为iM,近月点高度为hM,探测器的飞行方向角为γM,月球平均半径为RM。目标轨道真近点角为0°,即等价于γM为90°,故令目标月球轨道的终端参数向量为
其中,q1、q2、q3为过程量,且
q1=hM=a(1-e)-RM
下面求解向量q关于探测器位置速度向量r,v的偏导数。注意到下面的基本偏导数:
其中[r×]表示向量r的外积斜对称矩阵。
由位置速度可知长半轴a的表达式为
所述a关于位置速度向量的偏导数
离心率向量关于位置速度向量的偏导数
因此,得到
另外,由q2的定义知其偏导数为
由q3的定义知其偏导数为
则Fa表示为
本发明一个具体的实施例,
设某搭载发射的探月微纳卫星于2018年5月20日21时54分20.766秒入轨,入轨参数为(J2000.0地心平赤道坐标系下):
其中,r0为所述卫星的位置矢量,v0为所述卫星的速度矢量。
入轨误差为(J2000.0地心平赤道坐标系下):
其中,err_r1为入轨误差位置矢量,err_v1为入轨误差速度矢量。
进行中途修正的时刻为入轨后第80个小时,且在修正前5个小时对卫星进行测定轨,导航误差为(J2000.0地心平赤道坐标系下):
其中,err_r2为导航误差位置矢量,err_v2为导航误差速度矢量。
终端时刻设定为2018年5月25日14时5分53秒,终端的标称状态为:近月点高度300km、目标轨道倾角20°以及探测器真近点角0°。
在上述条件下,采用本发明实施例所公开的方法,计算得到第一偏差量的模|errp|=20.4527,满足2≤|errp|<25,故选取N的值为5,依次求解对应的5个中途修正子问题,最终求解得到中途修正速度增量△v*为(J2000.0地心平赤道坐标系下):
其中,△vi(i=1,2,3,4,5)表示第i个中途修正子问题所对应的第i个子修正速度增量。
图5为本实施例的修正速度增量计算结果示意图,其中si为0时对应的为无修正转移轨道的情形。si=0.2,0.4,0.6,0.8,1分别对应该实施例的5个子问题,纵坐标为求解对应子问题所得到的子修正量的累加模值。且si=1时,纵坐标为5个子修正量的累加模值,即为满足飞行任务要求的解。
本发明提出了一种探测器地月转移轨道修正算法。在本发明中,直接选用中途修正时刻的状态初值作为计算初值,省去了选取初值的操作。采用本发明方法求解中途修正问题,只需要选择合适的N值,便可以求解得到满足任务要求的中途修正速度向量。本发明方法不仅可以解决地月转移轨道的中途修正问题,同时该算法的思想也适用于太阳系内其他深空探测任务的中途修正问题。
以上所述仅为本发明的简化的实施例而已,并不限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种探测器地月转移轨道修正方法,其特征在于,所述方法包括:
获取主卫星入轨时刻的状态量,将获取到的所述状态量作为所述探测器的入轨时刻状态量;
以所述入轨时刻状态量作为初值在预设的轨道动力学模型下进行轨道数值积分运算,求得修正时刻状态量;其中,所述入轨时刻早于所述修正时刻;
以所述修正时刻状态量作为初值在所述预设的轨道动力学模型下进行轨道数值积分运算,求得终端时刻状态量;其中,所述修正时刻早于所述终端时刻;
计算所述终端时刻状态量与终端时刻标准量的差值,所述差值为第一偏差量;
根据所述第一偏差量计算第一修正量;
按照所述第一修正量对所述修正时刻状态量进行修正。
2.根据权利要求1所述的方法,其特征在于,所述根据所述第一偏差量计算第一修正量,具体包括:
根据所述第一偏差量,通过微分修正算法计算所述第一修正量。
3.根据权利要求2所述的方法,其特征在于,所述根据所述第一偏差量,通过微分修正算法计算所述第一修正量,具体包括:
将所述第一偏差量分为N个子偏差量,进而得到N个子终端状态值,其中,N为正整数;
通过微分修正算法依次计算所述N个子终端状态值对应的N个子修正量;
将所述N个子修正量相加,得到所述第一修正量。
4.根据权利要求3所述的方法,其特征在于,所述将所述第一偏差量分为N个子偏差量,包括:
将所述第一偏差量等分为N个子偏差量。
5.根据权利要求1所述的方法,其特征在于,所述预设的轨道动力学模型表达式为:
其中,μE为地球引力常数,μM为月球引力常数,μS为太阳引力常数,r为所述探测器相对于地球的位置矢量,rM为所述探测器相对于月球的位置矢量,rS为所述探测器相对于太阳的位置矢量,ρM为月球相对于地球的位置矢量,ρS为太阳相对于地球的位置矢量,v表示所述探测器相对于地球的速度矢量,为r的一阶导数,为v的一阶导数。
6.一种探测器地月转移轨道修正装置,其特征在于,所述装置包括:
主控模块,用于获取主卫星入轨时刻的状态量,将获取到的所述状态量作为所述探测器的入轨时刻状态量;
运算模块,用于以所述入轨时刻状态量作为初值在预设的轨道动力学模型下进行轨道数值积分运算,求得修正时刻状态量;其中,所述入轨时刻早于所述修正时刻;
所述运算模块,还用于以所述修正时刻状态量作为初值在所述预设的轨道动力学模型下进行轨道数值积分运算,求得终端时刻状态量;其中,所述修正时刻早于所述终端时刻;
所述运算模块,还用于计算所述终端时刻状态量与终端时刻标准量的差值,所述差值为第一偏差量;
修正量计算模块,用于根据所述第一偏差量计算第一修正量;
修正模块,用于按照所述第一修正量对所述修正时刻状态量进行修正。
7.根据权利要求6所述的装置,其特征在于,所述修正量计算模块,还用于根据所述第一偏差量,通过微分修正算法计算所述第一修正量。
8.根据权利要求7所述的装置,其特征在于,所述修正量计算模块,还用于将所述第一偏差量分为N个子偏差量,进而得到N个子终端状态值,其中,N为正整数;通过微分修正算法依次计算所述N个子终端状态值对应的N个子修正量;将所述N个子修正量相加,得到所述第一修正量。
9.根据权利要求8所述的装置,其特征在于,所将所述第一偏差量分为N个子偏差量,包括:
将所述第一偏差量等分为N个子偏差量。
10.根据权利要求6所述的装置,其特征在于,所述预设的轨道动力学模型表达式为
其中,μE为地球引力常数,μM为月球引力常数,μS为太阳引力常数,r为所述探测器相对于地球的位置矢量,rM为所述探测器相对于月球的位置矢量,rS为所述探测器相对于太阳的位置矢量,ρM为月球相对于地球的位置矢量,ρS为太阳相对于地球的位置矢量,v表示所述探测器相对于地球的速度矢量,为r的一阶导数,为v的一阶导数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910108507.1A CN109606739B (zh) | 2019-01-18 | 2019-01-18 | 一种探测器地月转移轨道修正方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910108507.1A CN109606739B (zh) | 2019-01-18 | 2019-01-18 | 一种探测器地月转移轨道修正方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109606739A true CN109606739A (zh) | 2019-04-12 |
CN109606739B CN109606739B (zh) | 2020-10-27 |
Family
ID=66018819
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910108507.1A Active CN109606739B (zh) | 2019-01-18 | 2019-01-18 | 一种探测器地月转移轨道修正方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109606739B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111319801A (zh) * | 2020-03-10 | 2020-06-23 | 上海航天控制技术研究所 | 一种适用于火星探测的中途修正策略制定及实施方法 |
CN111361762A (zh) * | 2020-03-04 | 2020-07-03 | 北京空间飞行器总体设计部 | 一种地月转移轨道发动机试喷方法 |
CN111605736A (zh) * | 2020-04-29 | 2020-09-01 | 北京理工大学 | 地月l2点转移轨道最优误差修正点选择方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103198187A (zh) * | 2013-04-02 | 2013-07-10 | 哈尔滨工业大学 | 基于微分修正的深空探测器的轨道设计方法 |
CN105631095A (zh) * | 2015-12-18 | 2016-06-01 | 中国人民解放军国防科学技术大学 | 一种等间隔发射的多约束地月转移轨道簇搜索方法 |
CN106682274A (zh) * | 2016-12-05 | 2017-05-17 | 北京理工大学 | 考虑振幅约束的一种Halo轨道在轨保持方法 |
-
2019
- 2019-01-18 CN CN201910108507.1A patent/CN109606739B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103198187A (zh) * | 2013-04-02 | 2013-07-10 | 哈尔滨工业大学 | 基于微分修正的深空探测器的轨道设计方法 |
CN105631095A (zh) * | 2015-12-18 | 2016-06-01 | 中国人民解放军国防科学技术大学 | 一种等间隔发射的多约束地月转移轨道簇搜索方法 |
CN106682274A (zh) * | 2016-12-05 | 2017-05-17 | 北京理工大学 | 考虑振幅约束的一种Halo轨道在轨保持方法 |
Non-Patent Citations (1)
Title |
---|
赵玉辉等: "月球探测中转移轨道误差分析和中途修正计算", 《天文学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111361762A (zh) * | 2020-03-04 | 2020-07-03 | 北京空间飞行器总体设计部 | 一种地月转移轨道发动机试喷方法 |
CN111319801A (zh) * | 2020-03-10 | 2020-06-23 | 上海航天控制技术研究所 | 一种适用于火星探测的中途修正策略制定及实施方法 |
CN111319801B (zh) * | 2020-03-10 | 2021-10-01 | 上海航天控制技术研究所 | 一种适用于火星探测的中途修正策略制定及实施方法 |
CN111605736A (zh) * | 2020-04-29 | 2020-09-01 | 北京理工大学 | 地月l2点转移轨道最优误差修正点选择方法 |
CN111605736B (zh) * | 2020-04-29 | 2021-06-22 | 北京理工大学 | 地月l2点转移轨道最优误差修正点选择方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109606739B (zh) | 2020-10-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109606739B (zh) | 一种探测器地月转移轨道修正方法及装置 | |
CN108548542B (zh) | 一种基于大气阻力加速度测量的近地轨道确定方法 | |
CN104792340A (zh) | 一种星敏感器安装误差矩阵与导航系统星地联合标定与校正的方法 | |
CN109911249A (zh) | 低推重比飞行器的星际转移有限推力入轨迭代制导方法 | |
Somov et al. | Guidance and precise motion control of free-flying robots and land-survey mini-satellites | |
Ranieri et al. | Indirect optimization of three-dimensional finite-burning interplanetary transfers including spiral dynamics | |
Kim | Satellite control system: Part i-architecture and main components | |
Park et al. | Three-dimensional trajectory optimization of soft lunar landings from the parking orbit with considerations of the landing site | |
Rughani et al. | Swarm rpo and docking simulation on a 3dof air bearing platform | |
Kojima | Fly-around motion control based on exact linearization with adaptive law | |
Lowe et al. | Reduced-order model for spacecraft swarm orbit design | |
Sun et al. | Piecewise attitude tracking control of a gravity gradient microsatellite for coplanar orbital transfer | |
Lee et al. | Gimbal-angle vectors of the nonredundant CMG cluster | |
Li et al. | Earth-Phobos transfer with ballistic trajectory in the Sun-Mars system | |
Moore et al. | The effects of pointing error sources on energy delivery from orbiting solar reflectors | |
Walsh et al. | A method for general autonomous orbit matching | |
Pontani et al. | Post-aerocapture orbit selection and maintenance for the Aerofast mission to Mars | |
Possner et al. | Control of science orbits about planetary satellites | |
Xu et al. | Computational mission analysis and conceptual system design for super low altitude satellite | |
Lee | CubeSat constellation implementation and management using differential drag | |
Kinatas et al. | TRIAD aided adaptive Kalman filter for fault tolerant attitude estimation of a nanosatellite | |
Pernicka et al. | Simulation of the dynamics of a short tethered satellite system | |
CN112520070B (zh) | 深空探测器推力矢量实时修正方法和系统 | |
Hayashi et al. | Model Predictive Control Approach for Autonomous Sun-Synchronous Sub-Recurrent Orbit Control | |
Somova et al. | Guidance and control of a space robot during interorbital flights in a low-orbit constellation of mini-satellites. |
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 |