本发明公开了一种在近圆轨道航天器后方根据相对运动特征量进行伴飞初始化控制的方法。该方法包括轨道周期解算模块、相对运动特征量解算模块、轨道控制策略模块以及推力器开关机控制模块。该控制方法存储于追踪航天器数据处理单元内，借助追踪航天器上装备的相对跟瞄设备、INS/GPS组合导航设备和推力器控制追踪航天器在目标航天器的后方区域内由逼近状态转换为长期、稳定的伴飞状态。该控制方法具有数据处理过程简洁，计算量小，控制效果好的优点。
1.一种基于航天器间相对运动特征量的伴飞初始化控制方法，其特征在于，实施步骤如下：步骤一：轨道周期解算模块的实施
步骤1.1：接收INS/GPS组合导航设备输出的追踪航天器在地球惯性坐标系OGXGYGZG下的位置 与速度步骤1.2：根据追踪航天器 的惯性位置 与速 度 解算追踪航天器的轨道半长轴a200，然后得出追踪航天器的轨道周期T200；
步骤1.3：将追踪航天器的轨道周期T200输出给相对运动特征量解算模块和轨道控制策略模块；
所 述 追 踪 航 天 器 的 轨 道 半 长 轴 a200 按 照 公 式 得出；其中，μ为
相对运动特征量解算模块的实施包括以下三个步骤：步骤2.1：接收相对跟瞄设备输出的目标航天器在追踪航天器的轨道坐标系OHXHYHZH下的相对位置 和相对速度 以及轨道周期解算模块输出的追踪航天器的轨道周期T200；
步骤2.2：采用相对运动特征量解算方法以T200为周期得出相对运动特征量步骤2.3：将相对运动特征量 输出给轨道控制策略模块；
所述相对运动特征量 追踪航天器位于轨道坐标系OHXHYHZH 的原点OH；目标航天器在OHXHYHZH下的相对位置 随时间进行周期性的变化，有逐渐接近追踪航天器的趋势，并且在OHXHZH平面内的相对运动与沿OHYH轴方向的相对运动解耦；相对运动特征量 表征相对位置 的变化规律，具体定义为：
(1)在OHXHZH平面内，目标航天器沿OHXH轴有逼近追踪航天器的趋势；设目标航天器在任意的τ时刻相对追踪航天器的位置在OHXH轴的投影记为Δx(τ)；在一个追踪航天器的轨道周期T200后，目标航天器相对追踪航天器的位置在OHXH轴的投影变为Δx(τ+T200)；
所以目标航天器相对于追踪航天器在一个T200周期内沿OHXH轴的漂移量记为h＝Δx(τ+T200)-Δx(τ)；
(2)在OHXHZH平面内，目标航天器沿OHZH轴做幅值恒定的周期性运动；在OHZH轴方向投影的最大值记为Δzmax，最小值记为Δzmin，所以沿OHZH轴的幅值记为q＝Δzmax-Δzmin；
(3)目标航天器沿OHYH轴方向的相对运动独立解耦，做幅值恒定的振荡变化；在OHYH轴方向投影的最大值记为Δymax，最小值记为Δymin，所以沿OHYH轴的振荡幅值记为p＝Δymax-Δymin；
所述的相对运动特征量解算方法在一个追踪航天器的轨道周期T200内完成；具体步骤为：(1)沿OHXH轴方向，记录τ时刻目标航天器的相对位置Δx(τ)，记录τ+T200时刻目标航天器的相对位置Δx(τ+T200)，输出一个T200周期内沿OHXH轴的漂移量h＝Δx(τ+T200)-Δx(τ)；
(2)沿OHYH轴方向，记录最大值Δymax和最小值Δymin，输出一个T200周期内的幅值p＝Δymax-Δymin；
(3)沿OHZH轴方向，记录最大值Δzmax和最小值Δzmin，输出一个T200周期内的幅值q＝Δzmax-Δzmin；
步骤3.1：接收相对跟瞄设备输出的目标航天器在追踪航天器的轨道坐标系 OHXHYHZH下的相对位置 和相对速度步骤3.2：接收轨道周期解算模块输出的追踪航天器的轨道周期T200；
步骤3.3：接收相对运动特征量解算模块输出的相对运动特征量 ；
步骤3.4：根据伴飞初始化控制策略生成轨道控制A1，A2，A3和A4的作用时刻和脉冲作用矢量 和其中伴飞初始化控制策略主要是用于控制追踪航天器在目标航天器后方的伴飞区域内由逼近状态转变为伴飞状态；设长方形伴飞区域的中心在轨道坐标系OHXHYHZH下的坐标为 轨道控制策略模块接收目标航天器的相对位置 和相对速度 并以T200为周期接收相对运动特征量解算模块提供的相对运动特征量 当目标航天器的相对位置满足条件|Δx-ΔxB|＜h时，伴飞初始化控制开始；
伴飞初始化控制开始后，轨道控制策略分为两个独立的部分进行控制，步骤为：第一部分的控制内容主要是消除沿OHYH轴方向幅值恒定的振荡运动；其控制方法为：当相对运动状态满足条件Δy(t-Δt)·Δy(t)＜0时，对追踪航天器沿OHYH轴施加轨道控制，轨道控制作用时刻记为ty1，脉冲作用矢量记为 其中，t表示当前采样时刻，t-Δt表示当前采样时刻的前一采样时刻；sgn(·)为符号函数，(·)大于0时返回1，(·)小于0时返回-1，其它情况返回0；
第二部分的控制内容主要是在OHXHZH平面内，消除沿OHXH轴方向的周期性逼近运动，以及消除沿OHZH轴方向的幅值恒定的周期性运动；按如下步骤进行：(1)当相对运动状态同时满足条件 时，
记录目标航天器在轨道坐标系OHXHYHZH下的相对位置沿OHXH轴的投影ΔxS，对追踪航天器沿OHXH轴施加轨道控制，轨道控制作用时刻记为tx1，脉冲作用矢量记为(2)tx1+T200/2时刻，对追踪航天器沿OHXH轴施加轨道控制，轨道控制的作用时刻记为tx2＝tx1+T200/2，脉冲作用矢量记为(3)tx1+T200时刻，对追踪航天器沿OHXH轴施加轨道控制，轨道控制作用的时刻记为tx3＝tx1+T200，脉冲作用矢量记为最后，将轨道控制量 和 按控制作用
时刻的先后顺序进行排列，构成轨道控制A1，A2，A3和A4的作用时刻和脉冲作用矢量步骤3.5：将轨道控制A1，A2，A3和A4的作用时刻和脉冲作用矢量和 输出给推力器开关机判断模块；其中，第n次轨道控制An的作用时刻和脉冲作用矢量分别为tn和 mxn、myn、mzn表示脉冲作用矢量在追踪航天器200的轨道坐标系OHXHYHZH上的沿OHXH、OHYH和OHZH轴的投影，其中，n＝
步骤4.1：接收INS/GPS组合导航设备输出的比力矢量步骤4.2：接收轨道控制策略模块输出的轨道控制A1，A2，A3和A4的作用时刻和脉冲作用矢量步骤4.3：根据比力矢量 轨道控制A1，A2，A3和A4的作用时刻和脉冲作用矢量和 以及推力器开关机判断条件得出开关机指令cmx、cmy和cmz；
步骤4.4：将推力器开关机指令cmx、cmy和cmz输出给推力器；
其中，所述推力器开关机指令cmx、cmy和cmz的取值为-1，0，1，并有如下函数关系：其中，mmin为推力器进行开关机工作的最小脉冲作用幅值。
一种基于航天器间相对运动特征量的伴飞初始化控制方法
【技术领域】
[0001] 本发明一种基于航天器间相对运动特征量的伴飞初始化控制方法，涉及在近圆轨道条件下，追踪航天器在目标航天器后方建立长期、稳定伴飞状态的一种控制方法，属于航天器近程相对运动控制技术领域。【背景技术】
[0002] 航天器的伴飞初始化控制技术主要是通过轨道控制使追踪航天器由逐渐逼近目标航天器的状态转变为在目标航天器后方建立长期、稳定的伴飞状态的控制方法。航天器的伴飞初始化控制技术是空间交会对接任务、空间在轨服务与目标监视任务中的重要控制技术。
[0003] 由于运载火箭以化学推进剂作为燃料，自身运载能力有限，所以大型的航天任务通常需要将有效载荷分批发射，然后在近地轨道通过交会对接的方式实现任务航天器的组装。在交会对接任务中，通常在目标航天器后方的逼近通道上设计多个长时段停泊点。这些停泊点一方面用于降低追踪航天器逼近目标航天器的速度，另一方面便于地面测控人员检查追踪航天器与目标航天器的运行状态，并决定是否进行下一阶段的逼近或对接操作。航天器的伴飞初始化控制技术可以控制追踪航天器建立上述的停泊状态。
[0004] 伴随着卫星导航、卫星通信以及卫星对地观测技术的广泛应用，涉及上述功能的航天器逐渐被其所有者视为不可或缺的重要资产。对于这些重要资产的检测与维护，以及对于具有潜在威胁的空间目标的侦查、监视与干预成为近些年来航天领域所普遍讨论的话题。空间在轨服务与目标监视任务中，目标航天器后方的伴飞区域是一个位置极佳的观测位置。位于该区域的追踪航天器可以对目标航天器进行视场稳定的近距离观测。航天器的伴飞初始化控制技术可以控制追踪航天器在该区域建立长期、稳定的伴飞状态。
[0005] 传统的伴飞初始化控制技术主要是根据希尔（Hill-ClohessyWiltshire：HCW）方程设计控制方法。基于HCW方程设计的伴飞初始化控制方法以追踪航天器与目标航天器间的相对位置和相对速度作为控制输入，具有计算量小，数据处理简洁的优点，便于在实际工程中实现。但由于HCW方程中假设条件的局限性，基于HCW方程设计的伴飞初始化控制方法所建立的伴飞状态维持时间较短，需要在控制完成后额外进行多次的伴飞维持控制，燃料消耗较多。基于相对轨道要素（Relative Orbital Elements：ROE）方程设计的控制方法是另外一种伴飞初始化控制方法。由于ROE方程在模型精度上优于HCW方程，所以基于ROE方程设计的伴飞初始化控制方法所建立的伴飞状态维持时间较长，在控制完成后需要额外进行伴飞维持控制的次数较少，燃料消耗也相应的减少。但由于基于ROE方程设计的伴飞初始化控制方法以相对的平均轨道要素作为控制变量，需要进行繁琐的迭代求解计算或滤波估计处理，增加了追踪航天器的数据处理负担。【发明内容】
[0006] 本发明为了协调现有的伴飞初始化控制中的数据处理量与控制效果之间的矛盾，在基于ROE方程设计的控制方法的基础上，改进了控制量解算方法，优化了数据处理流程，设计了一种基于航天器间相对运动特征量的伴飞初始化控制方法。本发明所述的伴飞初始化控制方法存储于追踪航天器上装备的数据处理单元内，根据同时装备的相对跟瞄设备输出的相对位置与相对速度信息，INS/GPS组合导航设备输出的追踪航天器的惯性位置与速度信息以及轨道控制时加速度计输出的比力信息，通过相应的数据解算和控制策略，控制推力器的开机、关机操作，使追踪航天器由逼近目标航天器的状态转变为长期、稳定的伴飞状态。本发明所述的基于航天器间相对运动特征量的伴飞初始化控制方法包括有轨道周期解算模块、相对运动特征量解算模块、轨道控制策略模块和推力器开关机判断模块。
[0007] 本发明一种基于航天器间相对运动特征量的伴飞初始化控制方法，实施步骤如下：
[0008] 步骤一：轨道周期解算模块(231)的实施
[0009] 轨道周期解算模块(231)的实施包括以下三个步骤：
[0010] 步骤1.1：通过数据总线，接收INS/GPS组合导航设备(202)提供的追踪航天器200在地球惯性坐标系OGXGYGZG下的位置 与速度
[0011] 步骤1.2：根据追踪航天器(200)的惯性位置 与速度 得出追踪航天器(200)的轨道周期T200；
[0012] 步骤1.3：将轨道周期T200输出给相对运动特征量解算模块(232)和轨道控制策略模块(233)。
[0013] 步骤二：相对运动特征量解算模块(232)的实施
[0014] 相对运动特征量解算模块(232)的实施包括以下三个步骤：
[0015] 步骤2.1：通过数据总线，接收相对跟瞄设备(201)输出的目标航天器(100)在追踪航天器(200)的轨道坐标系OHXHYHZH下的相对位置 和相对速度 以及轨道周期解算模块(231)输出的追踪航天器(200)的轨道周期T200；
[0016] 步骤2.2：采用相对运动特征量解算方法，以T200为周期得出相对运动特征量[0017] 步骤2.3：将相对运动特征量 输出给轨道控制策略模块(233)。
[0018] 步骤三：轨道控制策略模块(233)的实施
[0019] 轨道控制策略模块(233)的实施包括以下五个步骤：
[0020] 步骤3.1：通过数据总线，接收相对跟瞄设备(201)输出的目标航天器(100)在追踪航天器(200)的轨道坐标系OHXHYHZH下的相对位置 和相对速度
[0021] 步骤3.2：读取轨道周期解算模块(231)输出的追踪航天器(200)的轨道周期T200；
[0022] 步骤3.3：读取相对运动特征量解算模块(232)输出的相对运动特征量[0023] 步骤3.4：根据伴飞初始化控制策略，生成轨道控制的作用时刻和脉冲作用矢量和
[0024] 步骤3.5：将轨道控制的作用时刻和脉冲作用矢量 和输出给推力器开关机判断模块(234)。
[0025] 步骤四：推力器开关机判断模块(234)的实施
[0026] 推力器开关机判断模块(234)的实施包括以下四个步骤：
[0027] 步骤4.1：通过数据总线，接收INS/GPS组合导航设备(202)输出的比力矢量[0028] 步骤4.2：读取轨道控制策略模块(233)输出的4次轨道控制A1，A2，A3和A4的作用时刻和脉冲作用矢量 和
[0029] 步骤4.3：根据比力矢量 轨道控制的作用时刻和脉冲作用矢量和 以及推力器开关机判断条件，分别得出开关机指令cmx、cmy和
cmz；
[0030] 步骤4.4：将推力器开关机指令cmx、cmy和cmz输出给推力器（204）。
[0031] 其中，步骤二中所述的相对运动特征量解算方法，是指根据相对跟瞄设备输出的相对位置，通过加减运算得到追踪航天器与目标航天器间相对运动特征的变量。
[0032] 步骤三中所述的伴飞初始化控制策略，是指根据高精度的相对导航设备输出的信息，确定精确的轨道控制的作用时刻，和根据相对运动特征量和追踪航天器的轨道周期，进行四则运算确定轨道控制的脉冲作用矢量。
[0033] 本发明一种基于航天器间相对运动特征量的伴飞初始化控制方法，具有以下优点：
[0034] ①本发明所述的控制方法一方面保证了伴飞初始化控制的控制效果，另一方面采用简便易
[0035] 行的控制量解算方法，避免了复杂控制变量的结算，简化了数据处理流程，减少了计算量。
[0036] ②轨道周期解算模块231仅解算追踪航天器的轨道周期，并将其作为唯一的输出量，数据的处理量和传输量得到明显减少。
[0037] ③相对运动特征量解算模块232根据相对跟瞄设备输出的相对位置，通过加减运算得到追踪航天器与目标航天器间相对运动特征的变量。表述形式简明，数据处理简便。由于采用高精度的相对导航信息进行解算，解算的精度可以得到保证。
[0038] ④轨道控制策略模块233根据高精度的相对导航信息确定精确的轨道控制的作用时刻，根据相对运动特征量和追踪航天器的轨道周期进行四则运算确定轨道控制的脉冲作用矢量，具有数据处理简便的优点。
[0039] ⑤推力器开关机判断模块234在生成推力器开机关机指令时采用INS/GPS组合导航设备中的加速度计进行实时测量，提高了轨道控制的控制精度。【附图说明】
[0040] 图1是伴飞初始化控制示意图。
[0041] 图2是本发明中伴飞初始化的信息处理流程图。
[0042] 图3是目标航天器相对于追踪航天器的运动规律示意图。
[0043] 图4A、4B、4C、4D、4E、4F是伴飞初始化控制的数值仿真结果比较图。
[0044] 其中，图1中所述的A1，A2，A3和A4分别表示轨道控制策略模块233输出的第1次轨道控制，第2次轨道控制，第3次轨道控制和第4次轨道控制。
[0045] 其中，图4A、4B为基于HCW方程的伴飞初始化控制的数值仿真结果；图4C、4D为基于ROE方程的伴飞初始化控制的数值仿真结果；图4E、4F为基于相对运动特征量的伴飞初始化控制的数值仿真结果。
[0046] 其中，图4A、4B、4C、4D、4E、4F中所述的x(km)，y(km)，z(km)中的km表示以千米为单位，所述的t(轨道周期)表示以追踪航天器的轨道周期为单位。
[0047] 图中序号说明如下：100为目标航天器，200为追踪航天器；300为目标航天器后方的伴飞区域；201为相对跟瞄设备、202为INS/GPS组合导航设备、203为数据处理单元、204为推力器；231为轨道周期解算模块、232为相对运动特征量解算模块、233为轨道控制策略模块、234为推力器开关机判断模块、【具体实施方式】
[0048] 下面将结合附图对本发明做进一步的详细说明。
[0049] 参见图1所示的伴飞初始化控制示意图，目标航天器100位于偏心率接近于0的近圆形地球轨道上，处于被动运动状态。追踪航天器200在目标航天器100的后方沿中心渐变的椭圆线（图中虚线）逐渐逼近目标航天器100，并期望在目标航天器100后方的长方形伴飞区域300内建立长期、稳定的伴飞状态。
[0050] 本发明中伴飞初始化控制方法是指控制追踪航天器200由逼近状态转变为伴飞状态的过程。所述的追踪航天器200的逼近状态为追踪航天器200沿中心渐变的椭圆线逐渐逼近目标航天器100的状态，所述的追踪航天器200的伴飞状态为追踪航天器200在目标航天器100后方的长方形区域内进行伴飞。
[0051] 本发明基于航天器间相对运动特征量的伴飞初始化控制方法中，所述的进行伴飞初始化控制的追踪航天器200需要配备相对跟瞄设备201、INS/GPS组合导航设备202、数据处理单元203以及推力器204。基于航天器间相对运动特征量的伴飞初始化控制方法借助上述设备使追踪航天器200在逼近到目标航天器100后方的伴飞区域300后，通过施加4次轨道控制A1、A2、A3和A4，建立长期、稳定的伴飞状态。所述的轨道控制是指追踪航天器200的数据处理单元203根据相对跟瞄设备201和INS/GPS组合导航设备202提供的导航数据，结合数据解算与轨道控制策略，控制推力器204的开关，以达到将追踪航天器200由逼近状态转变为伴飞状态的目的。其中，第1次轨道控制记为A1，第2次轨道控制记为A2，……，第4次轨道控制记为A4。
[0052] 参见图2所示，本发明所述伴飞初始化控制的信息流在追踪航天器200装备的相对跟瞄设备201、INS/GPS组合导航设备202、数据处理单元203和推力器204间传递。
[0053] 相对跟瞄设备201：相对跟瞄设备201通过相对导航敏感器测量和滤波估计方法处理将目标航天器100在追踪航天器200的轨道坐标系ＯHＸHＹHＺH下的相对位置和相对速度 输出给数据处理单元203。所述追踪航天器200的轨道坐标系ＯHＸHＹHＺH是指该坐标系的原点ＯH位于追踪航天器200的质心，平面ＯHＸHＺH位于航天器运行的轨道平面，ＯHＺH由追踪航天器200的质心指向地球中心，ＯHＸH轴垂直于ＯHＺH指向前，ＯHＹH轴由右手定则确定。所述Δx、Δy和Δz是指相对位置 在轨道坐标系ＯHＸHＹHＺH下沿ＯHＸH、ＯHＹH和ＯHＺH轴的投影。所述 和 是指相对速度 在轨道坐标系ＯHＸHＹHＺH下沿ＯHＸH、ＯH
ＹH和ＯHＺH轴的投影。
[0054] INS/GPS组合导航设备202：INS/GPS组合导航设备202通过惯性导航技术、卫星定位技术和滤波估计方法处理将追踪航天器200在地球惯性坐标系ＯGＸGＹGＺG下的位置 速度 以及轨道控制时在轨道坐标系OHXHHYHZH下INS/GPS组合导航设备202中的加速度计输出的比力矢量输出给数据处理单元203。所述地球惯性坐标系OGXGYGZG是指该
坐标系的原点OG位于地球中心，平面OGXGYG位于地球赤道平面，OGXG轴指向春分点，OXZG轴垂直于地球赤道平面，指向北极，OGYG轴由右手定则确定。所述x200、y200和z200为惯性位置在地球惯性坐标系OGXGYGZG下沿OGXG、OGYG和OGZG轴的投影。所述 和 为惯
性速度 在地球惯性坐标系OGXGYGZG下沿OGXG、OGYG和OGZG轴的投影。所述加速度计输出的比力矢量 是指加速度计测量得到的加速度矢量中的非万有引力部分。所述acx、acy和acz为比力矢量 在追踪航天器200的轨道坐标系OHXHYHZH下沿OHXH、OHYH和OHZH轴的投影。
[0055] 数据处理单元203：数据处理单元203用于存储本发明所述的伴飞初始化控制方法。伴飞初始化控制方法包括四个部分，分别为轨道周期解算模块231，相对运动特征量解算模块232、轨道控制策略模块233和推力器开关机判断模块234。
[0056] 推力器204：推力器204接收数据处理单元203输出推力器开关机指令cmx、cmy和cmz，控制相应的推力器组工作，为本发明所述的伴飞初始化控制提供控制力。当推力器开关机指令cmx、cmy、cmz取值为1时，沿OHXH、OHYH、OHZH轴正向产生控制力的推力器组开始工作。当推力器开关机指令cmx、cmy、cmz取值为-1时，沿OHXH、OHYH、OHZH轴负向产生控制力的推力器组开始工作。当推力器开关机指令cmx、cmy、cmz取值为0时，沿OHXH、OHYH、OHZH轴正、负向产生控制力的推力器组停止工作。
[0057] 本发明一种基于航天器间相对运动特征量的伴飞初始化控制方法，具体实施步骤为：
[0058] 步骤一：轨道周期解算模块231的实施
[0059] 轨道周期解算模块231的实施包括以下三个步骤：
[0060] 步骤1.1：接收INS/GPS组合导航设备202输出的追踪航天器200在地球惯性坐标系OGXGYGZG下的位置 与速度
[0061] 步骤1.2：根据追踪航天器200的惯性位置 与速度解算追踪航天器200的轨道半长轴a200，然后得出追踪航天器200
的轨道周期T200；
[0062] 步骤1.3：将追踪航天器200的轨道周期T200输出给相对运动特征量解算模块232和轨道控制策略模块233。
[0063] 所 述 追 踪 航 天 器 200 的 轨 道 半 长 轴 a200 按 照 公 式得出。其中，μ为地球引力常数。
[0064] 所述追踪航天器200的轨道周期T200按照公式 得出。
[0065] 步骤二：相对运动特征量解算模块232的实施
[0066] 相对运动特征量解算模块232的实施包括以下三个步骤：
[0067] 步骤2.1：接收相对跟瞄设备201输出的目标航天器100在追踪航天器200的轨道坐标系OHXHYHZH下的相对位置 和相对速度 以及轨道周期解算模块231输出的追踪航天器200的轨道周期T200；
[0068] 步骤2.2：采用相对运动特征量解算方法以T200为周期得出相对运动特征量[0069] 步骤2.3：将相对运动特征量 输出给轨道控制策略模块233。
[0070] 所述相对运动特征量 如图3所示。追踪航天器200位于轨道坐标系OHXHYHZH的原点OH。目标航天器100在OHXHYHZH下的相对位置
随时间进行周期性的变化，有逐渐接近追踪航天器200的趋势，并且在OHXHZH平面内的相对运动与沿OHYH轴方向的相对运动解耦。相对运动特征量 表征相对位置
的变化规律，具体定义为：
[0071] （1）在OHXHZH平面内，目标航天器100沿OHXH轴有逼近追踪航天器200的趋势。设目标航天器100在任意的τ时刻相对追踪航天器200的位置在OHXH轴的投影记为Δx(τ)。在一个追踪航天器200的轨道周期T200后，目标航天器100相对追踪航天器200的位置在OHXH轴的投影变为Δx(τ+T200)。所以目标航天器100相对于追踪航天器200在一个T200周期内沿OHXH轴的漂移量记为h=Δx(τ+T200)-Δx(τ)。
[0072] （2）在OHXHZH平面内，目标航天器100沿OHZH轴做幅值恒定的周期性运动。在OHZH轴方向投影的最大值记为Δzmax，最小值记为Δzmin，所以沿OHZH轴的幅值记为q=Δzmax-Δzmin。
[0073] （3）目标航天器100沿OHYH轴方向的相对运动独立解耦，做幅值恒定的振荡变化。在OHYH轴方向投影的最大值记为Δymax，最小值记为Δymin，所以沿OHYH轴的振荡幅值记为p=Δymax-Δymin。
[0074] 所述的相对运动特征量解算方法在一个追踪航天器200的轨道周期T200内完成。具体步骤为：
[0075] （1）沿OHXH轴方向，记录τ时刻目标航天器100的相对位置Δx(τ)，记录τ+T200时刻目标航天器100的相对位置Δx(τ+T200)，输出一个T200周期内沿OHXH轴的漂移量h=Δx(τ+T200)-Δx(τ)。
[0076] （2）沿OHYH轴方向，记录最大值Δymax和最小值Δymin，输出一个T200周期内的幅值p=Δymax-Δymin。
[0077] （3）沿OHZH轴方向，记录最大值Δzmax和最小值Δzmin，输出一个T200周期内的幅值q=Δzmax-Δzmin。
[0078] 步骤三：轨道控制策略模块233的实施
[0079] 轨道控制策略模块233的实施包括以下五个步骤：
[0080] 步骤3.1：接收相对跟瞄设备201输出的目标航天器100在追踪航天器200的轨道坐标系OHXHYHZH下的相对位置 和相对速度
[0081] 步骤3.2：接收轨道周期解算模块231输出的追踪航天器200的轨道周期T200；
[0082] 步骤3.3：接收相对运动特征量解算模块232输出的相对运动特征量
[0083] 步骤3.4：根据伴飞初始化控制策略生成轨道控制A1，A2，A3和A4的作用时刻和脉冲作用矢量 和
[0084] 其中伴飞初始化控制策略主要是用于控制追踪航天器200在目标航天器100后方的伴飞区域300内由逼近状态转变为伴飞状态。设长方形伴飞区域300的中心在轨道坐标T系OHXHYHZH下的坐标为[ΔxBO O]。轨道控制策略模块233接收目标航天器100的相对位置 和相对速度 并以T200为周期接收相对运动特
征量解算模块232提供的相对运动特征量 当目标航天器的相对位置满足
条件|Δx-ΔxB|＜h时，伴飞初始化控制开始。
[0085] 伴飞初始化控制开始后，轨道控制策略分为两个独立的部分进行控制，步骤为：
[0086] 第一部分的控制内容主要是消除沿OHYH轴方向幅值恒定的振荡运动；其控制方法为：当相对运动状态满足条件Δy(t-Δt)·Δy(t)＜0时，对追踪航天器200沿OHYH轴施加轨道控制，轨道控制作用时刻记为ty1，脉冲作用矢量记为其中，t表示当前采样时刻，t-Δt表示当前采样时刻的
前一采样时刻；sgn(·)为符号函数，(·)大于0时返回1，(·)小于0时返回-1，其它情况返回0。
[0087] 第二部分的控制内容主要是在OHXHZH平面内，消除沿OHXH轴方向的周期性逼近运动，以及消除沿OHZH轴方向的幅值恒定的周期性运动。按如下步骤进行：
[0088] （1）当相对运动状态同时满足条件 和Δz(t)＞0时，记录目标航天器100在轨道坐标系OHXHYHZH下的相对位置沿OHXH轴的投影ΔxS，对追踪航天器200沿OHXH轴施加轨道控制，轨道控制作用时刻记为tx1，脉冲作用矢量记为[0089] （2)tx1+T200/2时刻，对追踪航天器200沿OHXH轴施加轨道控制，轨道控制的作用时刻记为tx2＝tx1+T200/2，脉冲作用矢量记为
[0090] （3)tx1+T200 时 刻， 对 追 踪 航 天 器 200 沿 OHXH 轴 施 加 轨 道控 制，轨 道 控 制 作 用 的 时 刻 记 为tx3 ＝tx1+T200，脉 冲 作 用 矢 量 记 为[0091] 最后，将轨道控制量 和 按控制作用时刻的先后顺序进行排列，构成轨道控制A1，A2，A3和A4的作用时刻和脉冲作用矢量和
[0092] 步骤3.5：将轨道控制A1，A2，A3和A4的作用时刻和脉冲作用矢量和 输出给推力器开关机判断模块234。其中，第n次轨道控制An的作用时刻
和脉冲作用矢量分别为tn和 mxn、myn、mzn表示脉冲作用矢量
在追踪航天器200的轨道坐标系OHXHYHZH上的沿OHXH、OHYH和OHZH轴的投影（n=1,2,3,4）。
[0093] 步骤四：推力器开关机判断模块234的实施
[0094] 推力器开关机判断模块234的实施包括以下四个步骤：
[0095] 步 骤 4.1：接 收 INS/GPS 组 合 导 航 设 备 202输 出 的 比 力 矢 量[0096] 步骤4.2：接收轨道控制策略模块233输出的轨道控制A1，A2，A3和A4的作用时刻和脉冲作用矢量 和
[0097] 步骤4.3：根据比力矢量 轨道控制A1，A2，A3和A4的作用时刻和脉冲作用矢量 和 以及推力器开关机判断条件得出开关机指令cmx、cmy和cmz；
[0098] 步骤4.4：将推力器开关机指令cmx、cmy和cmz输出给推力器204。
[0099] 其中，所述推力器开关机指令cmx、cmy和cmz的取值为-1，0，1，并有如下函数关系：
[0100]
[0101]
[0102]
[0103] 其中，mmin为推力器204进行开关机工作的最小脉冲作用幅值。
[0104] 综述所述，图4A、4B、4C、4D、4E、4F是在近地轨道仿真条件下，追踪航天器200在目标航天器100的轨道坐标系下的伴飞初始化控制结果的比较图。其中，伴飞初始化控制的控制方法包括基于HCW方程的伴飞初始化控制方法、基于ROE方程的伴飞初始化控制方法以及本发明所述的基于相对运动特征量的伴飞初始化控制方法。
[0105] 所述近地轨道仿真条件，是指追踪航天器200与目标航天器100位于地球的太阳同步轨道，并且追踪航天器200位于目标航天器100的后方4.2km之外，并逐渐逼近目标航天器100，最后在目标航天器100的后方的3km处建立伴飞状态；相对跟瞄设备201输出的目标航天器100在追踪航天器200的轨道坐标系OHXHYHZH下的相对位置精度为1m（±σ，三轴），相对速度精度为0.001m/s（±σ，三轴）；INS/GPS组合导航设备202输出追踪航天器200在地球惯性坐标系OGXGYGZG下的位置精度为3m（±σ，三轴），速度精度为0.003m/s-4 2（±σ，三轴），加速度计的比力精度为2×10 m/s（±σ，三轴）。
[0106] 图4A、4B、4C、4D、4E、4F表明，本发明所述的基于相对运动特征量的伴飞初始化控制方法，在控制完成后形成移动区间较小的伴飞状态。这种伴飞状态有利于目标航天器100与追踪航天器200间长时间的相对位置保持，并有利于减少之后进行的伴飞维持控制，节省伴飞维持控制所消耗的燃料。因此基于相对运动特征量的伴飞初始化控制方法，在控制效果上优于基于HCW方程设计的伴飞初始化控制方法，与基于ROE方程设计的伴飞初始化控制方法基本相同。
