CN105930305B - 一种三脉冲交会接近制导方法 - Google Patents

一种三脉冲交会接近制导方法 Download PDF

Info

Publication number
CN105930305B
CN105930305B CN201610230168.0A CN201610230168A CN105930305B CN 105930305 B CN105930305 B CN 105930305B CN 201610230168 A CN201610230168 A CN 201610230168A CN 105930305 B CN105930305 B CN 105930305B
Authority
CN
China
Prior art keywords
pulse
guidance
dynamic
equation
optimal
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
Application number
CN201610230168.0A
Other languages
English (en)
Other versions
CN105930305A (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.)
Shenzhen Graduate School Tsinghua University
Original Assignee
Shenzhen Graduate School Tsinghua 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 Shenzhen Graduate School Tsinghua University filed Critical Shenzhen Graduate School Tsinghua University
Priority to CN201610230168.0A priority Critical patent/CN105930305B/zh
Publication of CN105930305A publication Critical patent/CN105930305A/zh
Application granted granted Critical
Publication of CN105930305B publication Critical patent/CN105930305B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/11Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems

Abstract

本发明公开了一种三脉冲交会接近制导方法,包括以下步骤:利用C‑W方程建立空间机器人与GEO卫星之间的相对轨道动力学方程;利用相对轨道动力学方程建立带修正脉冲的三脉冲C‑W制导状态转移方程;根据状态转移方程确定燃料最省和制导精度的优化目标函数,确定脉冲大小、方向和时间为优化参数;根据优化目标函数得到最优结果。本发明提供的三脉冲交会接近制导方法,在交会接近的初始脉冲与最终脉冲之间施加一个修正脉冲以达到提高制导精度的目的。

Description

一种三脉冲交会接近制导方法
技术领域
本发明涉及航空器导航、制导与控制领域,尤其涉及一种三脉冲交会接近制导方法。
背景技术
近年来,利用空间机器人对地球静止轨道(Geostationary Orbit,GEO)卫星进行在轨服务的研究成为热点,空间机器人进行在轨服务的前提是实现对GEO卫星的自主交会接近,因而快速、准确、最优的交会接近制导方法至关重要。
交会接近制导方法的主要任务是利用航天器之间的相对轨道动力学,以交会接近时间、位置精度和燃料消耗等为约束条件,设计合理的、安全的交会接近运动轨迹。航天工程上,在近圆轨道上交会接近相对轨道动力学的描述方法主要是Clohessy-Wiltshire(C-W)方程。以C-W方程为基础,一些学者采用遗传优化算法,求得了以燃料和时间最优为指标的交会接近双脉冲速度解;一些学者研究了双脉冲最优交会时,考虑第一次脉冲位置变化的优化问题;一些学者推导出了多脉冲交会的一般算法,并以此为基础着重研究了双脉冲燃料消耗问题。上述研究成果多数为双脉冲C-W制导方法,然而,由于GEO轨道周期长、轨道引力弱,在外部轨道环境干扰下、有限精度相对导航和控制条件下,采用双脉冲C-W制导方法,空间机器人交会接近GEO卫星的实际运动轨迹与理想运动轨迹偏差较大。随着交会接近距离越远、时间越长,最终位置误差就越大。
随着GEO轨道在轨服务技术的不断发展,对交会接近技术的要求越来越高,需要进一步提高空间机器人对GEO卫星进行远距离交会接近的制导精度,同时提高优化算法的性能。
发明内容
为解决上述技术问题,本发明提供了一种三脉冲交会接近制导方法,在交会接近的初始脉冲与最终脉冲之间施加一个修正脉冲以达到提高制导精度的目的。
为达到上述目的,本发明采用以下技术方案:
本发明公开了一种三脉冲交会接近制导方法,包括以下步骤:
S1:利用C-W方程建立空间机器人与GEO卫星之间的相对轨道动力学方程;
S2:利用步骤S1中建立的相对轨道动力学方程建立带修正脉冲的三脉冲C-W制导状态转移方程;
S3:根据步骤S2中的状态转移方程确定燃料最省和制导精度的优化目标函数,确定脉冲大小、方向和时间为优化参数;
S4:根据步骤S3中的优化目标函数得到最优结果。
优选地,步骤S4进一步包括:采用改进动态权重-因子的粒子群优化算法对步骤S3中的优化目标函数进行优化得到最优结果。
优选地,步骤S1中利用C-W方程建立空间机器人与GEO卫星之间的相对轨道动力学方程为:
其中,r=[x,y,z]T,ac=[ax,ay,az]T为GEO卫星的轨道角速率,μ是地心引力常数,ac为外界加速度矢量,rt为GEO卫星在地心惯性坐标系下的位置矢量,r为空间机器人与GEO卫星之间的相对位置矢量;
作为状态变量,以相对轨道动力学方程为系统状态方程的状态转移方程线性解为:
其中,
其中,△t=t-t0,△τ=△tn,S0=sin(△τ),C0=cos(△τ)。
优选地,步骤S2中建立的带修正脉冲的三脉冲C-W制导状态转移方位为:
其中,t0为第一个脉冲的施加时间,t1为第二个脉冲的施加时间,t2为第三个脉冲的施加时间,△vj为tj时刻的速度脉冲。
优选地,步骤S3中的优化目标函数为:
T(y,M)=f(y)+MP(y)
其中,y为待优化参数,M为罚因子,MP(y)为罚函数,P(y)=||r-rf||,rf为空间机器人对GEO卫星进行三脉冲制导的实际最终相对位置,在进行迭代计算时,若P(y)≤R时M=0,反之M取极大值,R为空间机器人与GEO卫星的最终相对位置精度要求;
其中,待优化参数为:
y=(△v0,t1)=(△V0cosα,△V0sinα,t1)
其中,△v0为t0时刻的速度脉冲,△V0为施加第一个脉冲的大小,α为施加第一个脉冲的方向。
优选地,步骤S4具体包括:
S41:设定粒子群优化算法的粒子个数、搜索维数和最大迭代次数;
S42:初始化步骤S3中的优化参数的初始粒子的位置和速率;
S43:以步骤S3中的优化目标函数为粒子群适应度函数,计算每个粒子的适应度值,从中确定第i个粒子局部最优适应度值Pi_best和所有粒子的全局最优适应度值Pg_best
S44:采用改进动态权重-因子的位置、速率更新方程对步骤S42中的初始粒子的位置、速率进行更新,以实现参数的优化;
△yi(k+1)=ξ(k){ω(k)△yi(k)+c1(k)Rand1(k)(Pi_best-yi(k))
+c2(k)Rand2(k)(Pg_best-yi(k))}
yi(k+1)=yi(k)+△yi(k+1)
其中,k为迭代次数,yi(k)为第i个粒子位置,△yi(k)为第i个粒子速率,Rand1(k)和Rand2(k)为[0,1]之间的随机数,ω(k)为动态惯性权重因子,c1(k)为动态局部学习因子,c2(k)为动态全局学习因子,ξ(k)为动态收缩因子;
S45:重复步骤S43和步骤S44,直到达到最大迭代次数或者全局最优适应度值Pg_best满足精度要求,最终得到最优结果。
优选地,步骤S43中的第i个粒子局部最优适应度值Pi_best和所有粒子的全局最优适应度值Pg_best分别为:
其中,Fi(k)为粒子群适应度函数,Fi_best为第i个粒子的粒子群适应度函数最优值,Fg_best为所有粒子的粒子群适应度函数最优值。
优选地,动态惯性权重因子ω(k)根据下式进行更新:
其中,ωmax为动态权重最大值,ωmin为动态权重最小值,步骤S41还包括设定ωmax和ωmin
优选地,动态局部学习因子c1(k)和动态全局学习因子c2(k)根据下式进行更新:
其中,c1-max为动态局部学习因子最大值,c1-min为动态局部学习因子最小值,c2-max为动态全局学习因子最大值,c2-min为动态全局学习因子最小值,步骤S41还包括设定c1-max、c1-min、c2-max和c2-min
优选地,动态收缩因子ξ(k)根据下式进行更新:
其中,
与现有技术相比,本发明的有益效果在于:本发明在交会接近的初始脉冲与最终脉冲之间施加一个修正脉冲,与现有的双脉冲C-W制导仿真结果进行对比,本发明提高了空间机器人对GEO卫星进行远距离交会接近制导的最终位置精度。
在进一步的方案中,本发明提出一种改进的动态权重-因子的粒子群优化算法,与时间线性递减的惯性权重粒子群优化算法、带收缩因子粒子群优化算法仿真对比,本发明的粒子群优化算法不仅提高了前期全局搜索能力以发现高质量的局部解空间,而且也提高了后期局部解空间搜索能力以发现最优值。
附图说明
图1是空间机器人与GEO卫星的相对运动关系图及坐标系;
图2是本发明优选实施例的基于改进粒子群算法的三脉冲交会接近制导优化方法的步骤图;
图3是本发明优选实施例的改进动态权重-因子的粒子群优化算法流程图;
图4是空间机器人的双脉冲C-W制导最终误差统计图;
图5是改进动态权重-因子的粒子群优化算法性能对比图;
图6是基于改进粒子群优化算法的速度脉冲适应度函数最优值变化图;
图7是空间机器人的三脉冲C-W制导运动轨迹图;
图8是空间机器人的三脉冲C-W制导最终误差统计图。
具体实施方式
下面对照附图并结合优选的实施方式对本发明作进一步说明。
为描述空间机器人与GEO卫星之间的相对运动关系,建立如图1所示的坐标系,包括:地心惯性坐标系∑I、空间机器人轨道坐标系∑c和GEO卫星轨道坐标系∑t。空间机器人和GEO卫星在远距离交会接近时可以视作质点。
地心惯性坐标系∑I原点位于地心,基准面XY是历元为J2000.0时的地球平赤道平面,+X轴指向此历元时的平春分点方向,+Z轴指向北极,Y轴与XZ轴构成右手坐标系。空间机器人轨道坐标系∑c原点为空间机器人的质心;XcZc为轨道平面,+Zc指向地心的方向;+Xc垂直于+Zc指向飞行方向;+Yc垂直于轨道面的方向,形成右手直角坐标系。GEO卫星轨道坐标系∑t-XtYtZt定义与空间机器人相同。rc为空间机器人在地心惯性坐标系下的位置矢量;rt为GEO卫星在地心惯性坐标系下的位置矢量;r为两者之间的相对位置矢量。
如图2所示,本发明优选实施例的基于改进粒子群算法的三脉冲交会接近制导优化方法包括以下步骤:
S1:利用C-W方程建立空间机器人与GEO卫星之间的相对轨道动力学方程。
空间机器人与GEO卫星之间的相对轨道动力学表达式为:
上式(1)中,μ是地心引力常数,约为3.98603×1014m3/s2;ac为外界加速度矢量。
对上式(1)在矢量rt处进行一阶泰勒级数展开,得到空间机器人与GEO卫星之间的相对轨道动力学C-W方程为:
上式(2)中,r=[x,y,z]T,ac=[ax,ay,az]T为GEO卫星的轨道角速率。
作为状态变量,以C-W方程为系统状态方程的状态转移方程线性解为:
上式(3)中,
其中,△t=t-t0,△τ=△tn,S0=sin(△τ),C0=cos(△τ)。
S2:利用步骤S1中建立的相对轨道动力学状态转移方程建立带修正脉冲的三脉冲C-W制导状态转移方程。
其中:双脉冲C-W制导只在转移初始时刻t0和结束时刻t1施加速度脉冲,转移过程并不进行控制。由于施加速度脉冲的时间很短,可以将上式(3)相对运动状态转移方程简化为:
上式(6)中,△v0为初始时刻t0的速度脉冲,△v1为结束时刻t1的速度脉冲。状态转移矩阵拆分成4个3×3的子矩阵:
利用状态转移矩阵的性质:
Φ(tm+tn)=Φ(tm)Φ(tn) (8)
得到三脉冲C-W制导的状态转移方程为:
上式(9)中,△vj为tj时刻的速度脉冲。
S3:利用步骤S2中的状态转移方程确定燃料最省和制导精度的优化目标函数,确定脉冲大小、方向和时间为优化参数。
以固定时间燃料最省为优化问题,则三脉冲优化目标函数表示为:
上式(10)中,y为待优化参数。
增加最终制导精度要求,作为固定时间燃料最省优化问题的约束函数:
P(y)=||r-rf||≤R (11)
上式(11)中,r为空间机器人对GEO卫星进行三脉冲制导的期望最终相对位置,rf为实际最终相对位置,R为最终相对位置精度要求。
空间机器人的三脉冲制导优化问题转化为带约束的非线性最优问题,约束条件的处理是最优问题求解的重要环节,引入罚函数可以有效地将带约束的非线性优化问题转化为不带约束的非线性优化问题。因此,得到空间机器人三脉冲C-W制导新的优化目标函数为:
T(y,M)=f(y)+MP(y) (12)
上式(12)中,MP(y)为罚函数,M为罚因子。当进行优化迭代计算时,若P(y)≤R满足相对位置精度要求时,M=0;反之,则M取极大值。
三脉冲C-W制导待优化参数包括:第一个脉冲△v0和t0、第二个脉冲△v1和t1、第三个脉冲△v2和t2。由于初始时刻t0、结束时刻t2、初始位置r0、结束位置rf为已知;同时,速度脉冲△v1和△v2可以通过状态转移方程计算得到:
上式(13)中,v0为第一个脉冲前的相对速度,v1为第二个脉冲前的相对速度,vf为第三个脉冲后的相对速度,r1为第二个脉冲时刻的相对位置。
另外,空间机器人将进行轨道面内的远距离交会接近,Y轴方向的速度脉冲为零,那么空间机器人的三脉冲C-W制导待优化参数简化为:
y=(△v0,t1)=(△V0cosα,△V0sinα,t1) (14)
上式(14)中,△V0为施加第一个脉冲的大小,α为施加第一个脉冲的方向,t1为第二个脉冲的施加时间。
S4:采用改进动态权重-因子的粒子群优化算法对步骤S3中的优化目标函数进行优化得到最优结果,具体流程如图3所示,包括以下步骤:
S41:设定粒子群优化算法的粒子个数np、搜索维数D、最大迭代次数Nmax、罚因子M、动态权重最大值ωmax、动态权重最小值ωmin、动态局部学习因子最大值c1-max、动态局部学习因子最小值c1-min、动态全局学习因子最大值c2-max、动态全局学习因子最小值c2-min
S42:初始化步骤S3中的优化参数的np个粒子的位置y1(k)和速率△y1(k);
S43:以步骤S3中的式(12)的优化目标函数为粒子群适应度函数:
计算每个粒子的适应度值,从中确定第i个粒子局部最优适应度值Pi_best
从局部最优适应度中,确定所有粒子的全局最优适应度值Pg_best
S44:利用改进动态权重-学习因子的位置、速率更新方程对步骤S42中粒子的初始位置、速率进行更新,以实现参数的优化;
yi(k+1)=yi(k)+△yi(k+1) (21)
上述式(20)和(21)中,yi(k)为第i个粒子位置,△yi(k)为第i个粒子速率,Rand1(k)和Rand2(k)为[0,1]之间的随机数,ω(k)为动态惯性权重因子,c1(k)为动态局部学习因子,c2(k)为动态全局学习因子,ξ(k)为动态收缩因子。
在进一步的实施例中,根据下式采用动态惯性权重:
上式(22)中,ωmax为动态权重最大值,ωmin动态权重最小值。通过采用动态惯性权重,使得在粒子群优化算法中,在运行初期具有更强的全局搜索能力以发现高质量的局部解空间,在运行后期则需要细致的局部解空间搜索能力。
在更进一步的实施例中提出一种随惯性权重动态变化的学习因子改进方法:
上式(23)中,c1-max为动态局部学习因子最大值,c1-min为动态局部学习因子最小值,c2-max为动态全局学习因子最大值,c2-min为动态全局学习因子最小值。通过采用随惯性权重动态变化的学习因子,使得在粒子群优化算法中,在寻优的运行初期全局学习因子c2较大,局部学习因子c1较小,从而使得使粒子群的全局搜索能力增强;在寻优的运行后期局部学习因子c1较大,全局学习因子c2较小,粒子多向自身最优值学习,从而使得粒子群局部细致解的搜索能力增强。
进一步地,为了确保粒子群算法的收敛,在速度更新方程中增加动态收缩因子:
上式(24)中,
S45:重复步骤S43和步骤S44直到达到最大迭代次数或者全局最优适应度值Pg_best满足精度要求,最终得到三脉冲C-W制导的最优结果。
下述对现有技术的双脉冲C-W制导和本发明的三脉冲C-W制导方法进行对比仿真。假定空间机器人对GEO卫星进行交会接近制导的初始位置r0=[-200.0,0,10.0]Tkm、最终位置rf=[-8.0,0,0]Tkm,初始速度为v0=[-1.0,0,0.5]Tm/s,最终速度为vf=[0,0,0]Tm/s,制导时间为18000s,相对位置确定误差为500m,相对速度确定误差为0.3m/s,速度脉冲控制误差为5%。要求交会接近制导的最终位置误差R<2km。
(1)双脉冲C-W制导仿真
通过上述条件,利用式(6)的双脉冲相对运动状态转移方程计算得到的速度脉冲为:
基于以上两个速度脉冲,利用蒙特卡洛打靶法进行最终制导位置误差仿真,进行1000次仿真计算,误差统计结果如图4所示。由统计结果,位置误差在要求范围内(方框所示)的比例为23.5%,绝大多数不能满足最终位置误差要求,其中Z轴方向的最大偏差超过了6km,X轴方向的最大偏差则超过了10km。
(2)三脉冲C-W制导仿真
首先,利用优化评价函数Rastrigin函数,将本发明的改进动态权重-因子粒子群算法(Linear Decreasing Inertia Weight-PSO,DIWF-PSO)与时间线性递减的惯性权重粒子群算法(LDIW-PSO)、带收缩因子粒子群算法(Constraint Factor-PSO,CF-PSO)进行优化性能比较,结果如图5所示。由结果可以看出,本发明的优化方法搜索时间略优于另外两种方法,且全局最优适应度值明显优于另外两种方法。
然后,利用本发明改进动态权重-因子粒子群算法的三脉冲交会接近制导优化方法进行远距离交会接近制导优化。将本发明的离子群优化算法的参数设定为:
结合上式(26)的参数设置,根据本发明的方法得到的优化结果为:
在迭代过程中,空间机器人速度脉冲全局最优适应度值变化如图6所示。利用三脉冲C-W制导状态转移方程,得到空间机器人t1中间时刻速度脉冲、t2结束时刻速度脉冲以及总的速度脉冲增量为:
最后,利用上述式(27)和(28)三脉冲C-W制导优化结果进行交会接近制导,得到空间机器人的运动轨迹如图7所示;同样,利用蒙特卡洛打靶法进行最终制导位置误差仿真,进行1000次仿真计算,空间机器人的最终制导误差统计结果如图8所示。与双脉冲制导误差统计结果图4进行对比,本发明的三脉冲制导误差统计结果明显偏小,且全部满足最终位置误差要求。
以上内容是结合具体的优选实施方式对本发明所作的进一步详细说明,不能认定本发明的具体实施只局限于这些说明。对于本发明所属技术领域的技术人员来说,在不脱离本发明构思的前提下,还可以做出若干等同替代或明显变型,而且性能或用途相同,都应当视为属于本发明的保护范围。

Claims (9)

1.一种三脉冲交会接近制导方法,其特征在于,包括以下步骤:
S1:利用C-W方程建立空间机器人与GEO卫星之间的相对轨道动力学方程;
S2:利用步骤S1中建立的相对轨道动力学方程建立带修正脉冲的三脉冲C-W制导状态转移方程;
S3:根据步骤S2中的状态转移方程确定燃料最省和制导精度的优化目标函数,确定脉冲大小、方向和时间为优化参数;
S4:根据步骤S3中的优化目标函数得到最优结果;
其中步骤S4具体包括:
S41:设定粒子群优化算法的粒子个数、搜索维数和最大迭代次数;
S42:初始化步骤S3中的优化参数的初始粒子的位置和速率;
S43:以步骤S3中的优化目标函数为粒子群适应度函数,计算每个粒子的适应度值,从中确定第i个粒子局部最优适应度值Pi_best和所有粒子的全局最优适应度值Pg_best
S44:采用改进动态权重-因子的位置、速率更新方程对步骤S42中的初始粒子的位置、速率进行更新,以实现参数的优化;
Δyi(k+1)=ξ(k){ω(k)Δyi(k)+c1(k)Rand1(k)(Pi_best-yi(k))
+c2(k)Rand2(k)(Pg_best-yi(k))}
yi(k+1)=yi(k)+Δyi(k+1)
其中,k为迭代次数,yi(k)为第i个粒子位置,Δyi(k)为第i个粒子速率,Rand1(k)和Rand2(k)为[0,1]之间的随机数,ω(k)为动态惯性权重因子,c1(k)为动态局部学习因子,c2(k)为动态全局学习因子,ξ(k)为动态收缩因子;
S45:重复步骤S43和步骤S44,直到达到最大迭代次数或者全局最优适应度值Pg_best满足精度要求,最终得到最优结果。
2.根据权利要求1所述的三脉冲交会接近制导方法,其特征在于,步骤S4进一步包括:采用改进动态权重-因子的粒子群优化算法对步骤S3中的优化目标函数进行优化得到最优结果。
3.根据权利要求1所述的三脉冲交会接近制导方法,其特征在于,步骤S1中利用C-W方程建立空间机器人与GEO卫星之间的相对轨道动力学方程为:
x &CenterDot;&CenterDot; - 2 n z &CenterDot; = a x y &CenterDot;&CenterDot; + n 2 y = a y z &CenterDot;&CenterDot; + 2 n x &CenterDot; - 3 n 2 z = a z
其中,r=[x,y,z]T,ac=[ax,ay,az]T为GEO卫星的轨道角速率,μ是地心引力常数,ac为外界加速度矢量,rt为GEO卫星在地心惯性坐标系下的位置矢量,r为空间机器人与GEO卫星之间的相对位置矢量;
作为状态变量,以相对轨道动力学方程为系统状态方程的状态转移方程线性解为:
X ( t ) = &Phi; ( t , t 0 ) X ( t 0 ) + &Integral; t 0 t &Phi; ( t , u ) B U ( u ) d u
其中,
&Phi; ( t , t 0 ) = 1 0 6 ( &Delta; &tau; - S 0 ) ( 4 S 0 - 3 &Delta; &tau; ) / n 0 2 ( 1 - C 0 ) / n 0 C 0 0 0 S 0 / n 0 0 0 4 - 3 C 0 - 2 ( 1 - C 0 ) / n 0 S 0 / n 0 0 6 n ( 1 - C 0 ) 4 C 0 - 3 0 2 S 0 0 - nS 0 0 0 C 0 0 0 0 3 nS 0 - 2 S 0 0 C 0
&Integral; t 0 t &Phi; ( t , u ) B U ( u ) d u = 4 ( 1 - C 0 ) / n 2 - 1.5 &Delta;t 2 0 4 ( &Delta; t / n - S 0 / n 2 ) 0 ( 1 - C 0 ) / n 2 0 4 ( S 0 / n 2 - &Delta; t / n ) 0 ( 1 - C 0 ) / n 2 4 S 0 / n - 3 &Delta; t 0 2 ( 1 - C 0 ) / n 0 S 0 / n 0 - 2 ( 1 - C 0 / n ) 0 S 0 / n U ( t 0 )
其中,Δt=t-t0,Δτ=Δtn,S0=sin(Δτ),C0=cos(Δτ)。
4.根据权利要求3所述的三脉冲交会接近制导方法,其特征在于,步骤S2中建立的带修正脉冲的三脉冲C-W制导状态转移方位为:
X ( t 2 ) = &Phi; ( t 2 - t 0 ) X ( t 0 ) + &Sigma; j = 0 2 &Phi; ( t 2 - t j ) 0 &Delta; v j
其中,t0为第一个脉冲的施加时间,t1为第二个脉冲的施加时间,t2为第三个脉冲的施加时间,Δvj为tj时刻的速度脉冲。
5.根据权利要求4所述的三脉冲交会接近制导方法,其特征在于,步骤S3中的优化目标函数为:
T(y,M)=f(y)+MP(y)
其中,y为待优化参数,M为罚因子,MP(y)为罚函数,P(y)=||r-rf||,rf为空间机器人对GEO卫星进行三脉冲制导的实际最终相对位置,在进行迭代计算时,若P(y)≤R时M=0,反之M取极大值,R为空间机器人与GEO卫星的最终相对位置精度要求;
其中,待优化参数为:
y=(Δv0,t1)=(ΔV0cosα,ΔV0sinα,t1)
其中,Δv0为t0时刻的速度脉冲,ΔV0为施加第一个脉冲的大小,α为施加第一个脉冲的方向。
6.根据权利要求1所述的三脉冲交会接近制导方法,其特征在于,步骤S43中的第i个粒子局部最优适应度值Pi_best和所有粒子的全局最优适应度值Pg_best分别为:
P i _ b e s t = y i ( k ) , i f k = 1 y i ( k ) , e l s e i f F i ( k ) < F i _ b e s t P i _ b e s t , e l s e
P g _ b e s t = min ( y i ( k ) ) , i f k = 1 min ( y i ( k ) ) , e l s e i f min ( F i ( k ) ) < F g _ b e s t P g _ b e s t , e l s e ,
其中,Fi(k)为粒子群适应度函数,Fi_best为第i个粒子的粒子群适应度函数最优值,Fg_best为所有粒子的粒子群适应度函数最优值。
7.根据权利要求1所述的三脉冲交会接近制导方法,其特征在于,动态惯性权重因子ω(k)根据下式进行更新:
&omega; ( k ) = N m a x - k N m a x ( &omega; m a x - &omega; m i n ) + &omega; m i n
其中,ωmax为动态权重最大值,ωmin为动态权重最小值,步骤S41还包括设定ωmax和ωmin
8.根据权利要求7所述的三脉冲交会接近制导方法,其特征在于,动态局部学习因子c1(k)和动态全局学习因子c2(k)根据下式进行更新:
c 1 ( k ) = c 1 - m a x + c 1 - m i n 2 - c 1 - m a x - c 1 - m i n 2 c o s ( &phi; ( k ) ) c 2 ( k ) = c 2 - m a x + c 2 - m i n 2 + c 2 - m a x - c 2 - m i n 2 c o s ( &phi; ( k ) )
其中,c1-max为动态局部学习因子最大值,c1-min为动态局部学习因子最小值,c2-max为动态全局学习因子最大值,c2-min为动态全局学习因子最小值,步骤S41还包括设定c1-max、c1-min、c2-max和c2-min
9.根据权利要求8所述的三脉冲交会接近制导方法,其特征在于,动态收缩因子ξ(k)根据下式进行更新:
&xi; ( k ) = 2 | 2 - c ( k ) - c ( k ) 2 - 4 c ( k ) |
其中,
CN201610230168.0A 2016-04-14 2016-04-14 一种三脉冲交会接近制导方法 Active CN105930305B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610230168.0A CN105930305B (zh) 2016-04-14 2016-04-14 一种三脉冲交会接近制导方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610230168.0A CN105930305B (zh) 2016-04-14 2016-04-14 一种三脉冲交会接近制导方法

Publications (2)

Publication Number Publication Date
CN105930305A CN105930305A (zh) 2016-09-07
CN105930305B true CN105930305B (zh) 2017-07-21

Family

ID=56838974

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610230168.0A Active CN105930305B (zh) 2016-04-14 2016-04-14 一种三脉冲交会接近制导方法

Country Status (1)

Country Link
CN (1) CN105930305B (zh)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107422744B (zh) * 2017-05-02 2019-11-05 中国科学院声学研究所 一种基于径向速度控制的交会时间控制方法
CN107688351B (zh) * 2017-08-31 2020-07-07 北京理工大学 一种航天器两脉冲相对悬停方法
CN107526368B (zh) * 2017-09-12 2020-02-11 北京理工大学 一种考虑误差的多脉冲环月卫星编队初始化方法
CN110146903B (zh) * 2019-05-24 2020-11-13 国网浙江省电力有限公司信息通信分公司 一种基于反馈调整惯性权重的粒子群北斗卫星选择方法
CN110329544B (zh) * 2019-07-09 2021-03-26 北京控制工程研究所 一种用于自主快速交会对接的单脉冲制导方法、可读介质
CN113060306B (zh) * 2021-03-31 2022-02-08 中国空气动力研究与发展中心设备设计与测试技术研究所 有限推力的多脉冲交会迭代制导方法、装置及电子设备

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101381004A (zh) * 2008-08-20 2009-03-11 南京航空航天大学 基于大气阻力的微小卫星编队飞行控制方法及控制装置
CN101726296A (zh) * 2009-12-22 2010-06-09 哈尔滨工业大学 空间机器人视觉测量、路径规划、gnc一体化仿真系统

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3473748B2 (ja) * 1999-07-30 2003-12-08 シャープ株式会社 液晶表示装置
CN104200030B (zh) * 2014-09-05 2017-03-29 清华大学 一种圆参考轨道下给定边界的卫星初始相对状态确定方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101381004A (zh) * 2008-08-20 2009-03-11 南京航空航天大学 基于大气阻力的微小卫星编队飞行控制方法及控制装置
CN101726296A (zh) * 2009-12-22 2010-06-09 哈尔滨工业大学 空间机器人视觉测量、路径规划、gnc一体化仿真系统

Also Published As

Publication number Publication date
CN105930305A (zh) 2016-09-07

Similar Documents

Publication Publication Date Title
CN105930305B (zh) 一种三脉冲交会接近制导方法
CN101381004B (zh) 基于大气阻力的微小卫星编队飞行控制方法及控制装置
CN104590588B (zh) 一种基于隔离余量方法与脉宽融合策略的挠性卫星姿态轨道耦合控制方法
CN104527994B (zh) 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法
CN104309822B (zh) 一种基于参数优化的航天器单脉冲水滴形绕飞轨迹悬停控制方法
CN106814746A (zh) 一种航天器姿轨一体化反步跟踪控制方法
CN104898642A (zh) 一种用于航天器姿态控制算法的集成测试仿真系统
CN104345738A (zh) 一种绳系释放稳定控制方法及电动力绳系末级离轨稳定控制方法
CN105607478B (zh) 地球静止轨道航天器电推进转移轨道控制方法
McCamish et al. Autonomous distributed control of simultaneous multiple spacecraft proximity maneuvers
CN104656447A (zh) 一种航天器抗干扰姿态跟踪的微分几何非线性控制方法
CN105912819A (zh) 一种地月l1拉格朗日点转移轨道的快速设计方法
CN105865459A (zh) 一种考虑视线角约束的小天体接近段制导方法
CN107609267A (zh) 一种月球有限推力多次捕获轨道实现方法
Munoz Rapid path-planning algorithms for autonomous proximity operations of satellites
CN103863578B (zh) 火星着陆器喷气推力器和控制力矩陀螺复合控制系统
Liu et al. Collision-free trajectory design for long-distance hopping transfer on asteroid surface using convex optimization
Liu et al. Dynamic boundary layer based neural network quasi-sliding mode control for soft touching down on asteroid
CN103853047B (zh) 一种基于状态量反馈的小推力跟踪制导方法
Shen et al. Point return orbit design and characteristics analysis for manned lunar mission
CN103514362A (zh) 基于模型误差补偿的两行根数生成方法
Wang et al. Integration planning of gimbal angle and attitude motion for zero propellant maneuver under attitude and control moment gyroscope constraints
CN116400589A (zh) 深度强化学习sac算法的小行星柔性探测器智能控制方法
Ploen et al. Dynamics of earth orbiting formations
CN112389679B (zh) 一种考虑多种摄动力的小卫星常值推力轨道递推方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant