CN113697130A - 一种基于干扰观测器的航天器编队抓捕避碰控制方法 - Google Patents
一种基于干扰观测器的航天器编队抓捕避碰控制方法 Download PDFInfo
- Publication number
- CN113697130A CN113697130A CN202110858317.9A CN202110858317A CN113697130A CN 113697130 A CN113697130 A CN 113697130A CN 202110858317 A CN202110858317 A CN 202110858317A CN 113697130 A CN113697130 A CN 113697130A
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- target
- relative
- capturing
- formula
- 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
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 25
- 238000000034 method Methods 0.000 title claims abstract description 23
- 239000002131 composite material Substances 0.000 claims abstract description 9
- 230000008878 coupling Effects 0.000 claims abstract description 6
- 238000010168 coupling process Methods 0.000 claims abstract description 6
- 238000005859 coupling reaction Methods 0.000 claims abstract description 6
- 238000013461 design Methods 0.000 claims abstract description 6
- 150000001875 compounds Chemical class 0.000 claims description 15
- 230000014509 gene expression Effects 0.000 claims description 13
- 238000005096 rolling process Methods 0.000 claims description 7
- 239000011159 matrix material Substances 0.000 claims description 6
- 238000004088 simulation Methods 0.000 claims description 6
- 238000012795 verification Methods 0.000 claims description 5
- 230000001174 ascending effect Effects 0.000 claims description 3
- 238000011160 research Methods 0.000 abstract description 2
- 238000009795 derivation Methods 0.000 description 3
- 238000006467 substitution reaction Methods 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 206010034719 Personality change Diseases 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
Images
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
-
- 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
-
- 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/244—Spacecraft control systems
-
- 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/244—Spacecraft control systems
- B64G1/245—Attitude control algorithms for spacecraft attitude control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G4/00—Tools specially adapted for use in space
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于干扰观测器的航天器编队抓捕避碰控制方法,特别涉及一种针对空间非合作目标抓捕的多航天器协同避碰控制方法,属于航天器编队协同控制技术研究领域;本发明首先建立了抓捕航天器相对于目标的姿轨耦合的相对运动模型;然后针对抓捕过程中航天器内部以及与目标之间的可能发生的碰撞问题,利用超二次曲面来描述空间非合作目标和抓捕航天器的外形,建立复合人工势场;同时对于出现的复合干扰,设计了非线性干扰观测器对其进行估计,并在控制律的设计中进行抵消;最后,将滑模面与人工势场相结合,设计了安全鲁棒的控制律。
Description
技术领域
本发明属于航天器编队协同控制技术研究领域,具体涉及一种针对空间非合作目标抓捕的多航天器协同避碰控制方法。
背景技术
空间失效目标和空间碎片的增多,导致地球卫星轨道资源日趋紧张,面向低速翻滚的空间非合作目标的抓捕具有极大的研究价值和应用前景。由于非合作目标的本身故障而丧失姿态轨道调整能力导致其不可控,因此目标往往会因受到各种摄动和扰动影响而处于自由翻滚状态。传统的集成大型航天器系统体积大,灵活性差、成本高,与之相比,采用小型航天器编队或集群协同抓捕非合作目标拥有更高的可靠性及灵活性。而一个好的控制方法可以保证航天器编队能够更安全、更稳定的以期望姿态到达目标位置,从而更好地完成抓捕任务。
由于近距离阶段相对运动姿轨耦合更加严重,且小型航天器更容易受到各种摄动力等外部干扰的影响,这就需要在控制律地设计中可能出现的复合干扰进行处理。除此之外,目标的失控翻滚以及模型内部参数未知等也大大增加了航天器与目标以及航天器成员之间碰撞的风险,这使得为航天器成员设计安全可靠的控制律变得更加困难。
发明内容
本发明提出了一种基于干扰观测器的航天器编队抓捕避碰控制方法。具体而言,在考虑安全约束、编队构型约束以及存在复合干扰的情况下,针对航天器编队近距离抓捕低速翻滚空间非合作目标问题,为航天器成员设计一种安全鲁棒的控制律。
为了实现上述目的,本发明所采用的技术方案包括以下步骤:
(1)建立抓捕航天器与非合作目标之间姿轨耦合的相对运动模型;
(2)为满足安全性要求,进行人工势场设计;
(3)构建抓捕航天器姿态干扰观测器以及姿态控制器,并进行稳定性证明;
(4)构建抓捕航天器位置干扰观测器以及相对位置控制器,并进行稳定性证明;
(5)基于所设计的控制律进行仿真分析与验证。
所述步骤一的具体实现如下:
抓捕航天器相对于目标的相对姿态运动方程可以表示为:
抓捕航天器相对于目标的相对位置运动方程为:
式中, 表示第i个抓捕航天器相对于目标的速度矢量在其本体系中的投影,mc表示抓捕航天器的质量,和表示控制力和外界干扰力,表示第i个抓捕航天器相对于惯性系的位置矢量在其本体系中的投影,表示目标相对于惯性系的位置矢量在其本体系中的投影,μ为地球引力常数,rt,i表示抓捕航天器i的期望抓捕位置。
所述步骤二的具体实现如下:
由于非合作目标处于自由翻滚状态,为了防止抓捕航天器之间以及航天器与非合作目标之间发生碰撞,获得更大的安全接近区域,利用超二次曲面来描述非合作目标和抓捕航天器的外形,建立复合人工势场;
目标本体用圆柱体表示:
针对抓捕航天器编队内部之间的避碰问题,将其描述为球形障碍,即
式中,Xi,j=[xi,j,yi,j,zi,j]=Xc,i-Xc,j,且i≠j,表示抓捕航天器i和j之间的距离,l4与r是正常数,其值影响球形路径约束的半径;
势函数可以用式(6)表示:
所述步骤三的具体实现如下:
对于第i个航天器,设计一个非线性干扰观测器:
针对系统(1),设计以下姿态控制器:
所述步骤四的具体实现如下:
对于第i个航天器,设计一个非线性干扰观测器:
针对系统(3),设计以下位置控制器:
所述步骤五的具体实现如下:
假设目标的初始姿态与角速度为σt(0)=[0,0,0]T,ωt(0)=[0.02,0.05,-0.02]Trad/s,轨道半长轴为7830km,偏心率为0.13,轨道倾角为30deg,升交点赤经、近地点幅角、真近点角都为0,三个抓捕者的干扰观测器的初值分别为ε1,i(0)=[0,0,0]T,ε2,i(0)=[0,0,0]T。控制力与控制力矩的饱和上界分别为5N与1Nm,采用MATLAB数值方法进行仿真与验证。
与现有技术相比,本发明具有以下益处:
(1)建立了姿轨耦合的相对运动模型,更加符合工程实际;
(2)本发明提出一种基于超二次曲面的人工势场,可以根据不同的参数选取描述各种尺寸及形状的路径约束,在避免碰撞的前提下可以提高抓捕者的可接近范围;
(3)利用非线性干扰观测器对系统中可能出现的复合干扰进行估计,并在控制律的设计中进行抵消,有效抑制了姿态和位置控制中的各种扰动;
(4)设计了一种新型滑模面,并将人工势场与滑模面相结合,大大增加了控制器的鲁棒性和安全性。
附图说明
图1为本发明的流程图;
图2为抓捕航天器编队相对位置变化曲线;
图3为抓捕航天器编队相对速度变化曲线;
图4为抓捕航天器编队相对姿态变化曲线;
图5为抓捕航天器编队相对角速度变化曲线。
具体实施方式
本发明如图1所示,通过以下步骤实现:
第一步:建立抓捕航天器与非合作目标之间姿轨耦合的相对运动模型;
抓捕航天器相对于目标的相对姿态运动方程可以表示为:
抓捕航天器相对于目标的相对位置运动方程为:
式中, 表示第i个抓捕航天器相对于目标的速度矢量在其本体系中的投影,mc表示抓捕航天器的质量,和表示控制力和外界干扰力,表示第i个抓捕航天器相对于惯性系的位置矢量在其本体系中的投影,表示目标相对于惯性系的位置矢量在其本体系中的投影,μ为地球引力常数,rt,i表示抓捕航天器i的期望抓捕位置。
第二步:为满足安全性要求,进行人工势场设计人工势场设计;
由于非合作目标处于自由翻滚状态,为了防止抓捕航天器之间以及航天器与非合作目标之间发生碰撞,获得更大的安全接近区域,本发明利用超二次曲面来描述非合作目标和抓捕航天器的外形,建立复合人工势场。
目标本体用圆柱体表示:
针对抓捕航天器编队内部之间的避碰问题,将其描述为球形障碍,即
式中,Xi,j=[xi,j,yi,j,zi,j]=Xc,i-Xc,j,且i≠j,表示抓捕航天器i和j之间的距离,l4与r是正常数,其值影响球形路径约束的半径。
势函数可以用式(6)表示:
相关可调参数设置为:l1=3,l2=3,l3=6,l4=1,e1=0.1,e2=1,r1=0.5。
第三步:构建抓捕航天器姿态干扰观测器以及姿态控制器,并进行稳定性证明;
对于第i个航天器,设计一个非线性干扰观测器:
针对系统(1),设计以下姿态控制器:
系统稳定性证明如下:
首先构造Lyapunov函数:
对式(9)进行求导,并将式(8)代入,可得
根据杨氏不等式
将式(11)代入式(10)),可得
在S1,i≤ΔS1,i时,选择如下Lyapunov函数
对式(14)求导,并将式(1)代入,可得
由此可见,相对姿态角σe,i有界,且最终收敛到以下区域
第四步:构建抓捕航天器位置干扰观测器以及相对位置控制器,并进行稳定性证明;
对于第i个航天器,设计一个非线性干扰观测器:
针对系统(3),设计以下位置控制器:
系统稳定性证明如下:
首先构造Lyapunov函数:
对式(19)进行求导,并将式(18)代入,可得
根据杨氏不等式
将式(21)代入式(20),则有
在多航天器运动过程中,S2,i是始终有界的,另外,k2,itanh(k3,ivej,i)(j=1,2,3)是有界的,由这两点易得(k4,i+κi)ρe,i是有界的,根据势函数式(6),只有航天器在与目标发生碰撞时才会有κi趋近于无穷,因此根据(k4,i+κi)ρe,i有界,可以得知κi是有界的,即在整个任务过程中κi不会趋近于无穷。因此,抓捕者没有违反路径约束,即没有发生碰撞。
下面,将对相对位置ρe,i的有界性进行证明。
当滑模面S2,i收敛至0时,有
0=k2,i Tanh(k3,ive,i)+(k4,i+κi)ρe,i (24)
选取如下Lyapunov函数
对式(25)求导,可得
由此可见,当滑模面S2,i收敛至0时,ρe,i是渐进收敛的。
W=k2,i Tanh(k3,ive,i)+(k4,i+κi)ρe,i (27)
则根据式(25)、式(26)和式(27),可得ρe,i将收敛至以下区域
第五步:基于所设计的控制律进行仿真分析与验证。
为了验证本方法得可行性及有效性,假设目标的初始姿态与角速度为σt(0)=[0,0,0]T,ωt(0)=[0.02,0.05,-0.02]Trad/s,轨道半长轴为7830km,偏心率为0.13,轨道倾角为30deg,升交点赤经、近地点幅角、真近点角都为0。三个抓捕者的干扰观测器的初值分别为ε1,i(0)=[0,0,0]T,ε2,i(0)=[0,0,0]T。控制力与控制力矩的饱和上界分别为5N与1Nm。
基于干扰观测器的航天器编队抓捕避碰控制仿真结果如图2-5所示。从图中可以看出,本发明所提出的控制策略可以使三个抓捕航天器的相对位置与相对速度在60s内收敛,相对姿态与相对角速度在70s内收敛。
Claims (6)
1.一种基于干扰观测器的航天器编队抓捕避碰控制方法,其特征在于:利用干扰观测器估计航天器编队抓捕非合作目标过程中的复合干扰,并通过人工势函数与改进的滑模面相结合,保证抓捕航天器在抓捕目标的过程中避免发生碰撞,具体步骤如下:、
步骤一:建立抓捕航天器与非合作目标之间姿轨耦合的相对运动模型;
步骤二:为满足安全性要求,进行人工势场设计;
步骤三:构建抓捕航天器姿态干扰观测器以及姿态控制器;
步骤四:构建抓捕航天器位置干扰观测器以及相对位置控制器;
步骤五:基于所设计的控制律进行仿真分析与验证。
2.根据权利要求1所述的一种基于干扰观测器的航天器编队抓捕避碰控制方法,所述步骤一的具体实现如下:
抓捕航天器相对于目标的相对姿态运动方程可以表示为:
抓捕航天器相对于目标的相对位置运动方程为:
3.根据权利要求1所述的一种基于干扰观测器的航天器编队抓捕避碰控制方法,所述步骤二的具体实现如下:
由于非合作目标处于自由翻滚状态,为了防止抓捕航天器之间以及航天器与非合作目标之间发生碰撞,获得更大的安全接近区域,利用超二次曲面来描述非合作目标和抓捕航天器的外形,建立复合人工势场;
目标本体用圆柱体表示:
针对抓捕航天器编队内部之间的避碰问题,将其描述为球形障碍,即
式中,Xi,j=[xi,j,yi,j,zi,j]=Xc,i-Xc,j,且i≠j,表示抓捕航天器i和j之间的距离,l4与r是正常数,其值影响球形路径约束的半径;
势函数可以用式(6)表示:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110858317.9A CN113697130B (zh) | 2021-07-28 | 2021-07-28 | 一种基于干扰观测器的航天器编队抓捕避碰控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110858317.9A CN113697130B (zh) | 2021-07-28 | 2021-07-28 | 一种基于干扰观测器的航天器编队抓捕避碰控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113697130A true CN113697130A (zh) | 2021-11-26 |
CN113697130B CN113697130B (zh) | 2023-04-07 |
Family
ID=78650762
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110858317.9A Expired - Fee Related CN113697130B (zh) | 2021-07-28 | 2021-07-28 | 一种基于干扰观测器的航天器编队抓捕避碰控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113697130B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107529389B (zh) * | 2013-07-12 | 2016-09-07 | 上海新跃仪表厂 | 一种跟踪非合作目标特征部位的姿轨耦合控制方法 |
CN107065565A (zh) * | 2017-05-18 | 2017-08-18 | 中国人民解放军装备学院 | 一种用于集群航天器电磁拖拽的自抗扰控制方法 |
CN109250156A (zh) * | 2018-07-24 | 2019-01-22 | 西北工业大学 | 一种空间非合作目标电磁涡流消旋抓捕装置及方法 |
CN109765921A (zh) * | 2019-03-04 | 2019-05-17 | 北京航空航天大学 | 一种保证通信且避免碰撞的航天器编队协同控制方法 |
CN111367314A (zh) * | 2020-03-09 | 2020-07-03 | 西北工业大学 | 一种基于多航天器编队的空间非合作目标协同抓捕方法 |
-
2021
- 2021-07-28 CN CN202110858317.9A patent/CN113697130B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107529389B (zh) * | 2013-07-12 | 2016-09-07 | 上海新跃仪表厂 | 一种跟踪非合作目标特征部位的姿轨耦合控制方法 |
CN107065565A (zh) * | 2017-05-18 | 2017-08-18 | 中国人民解放军装备学院 | 一种用于集群航天器电磁拖拽的自抗扰控制方法 |
CN109250156A (zh) * | 2018-07-24 | 2019-01-22 | 西北工业大学 | 一种空间非合作目标电磁涡流消旋抓捕装置及方法 |
CN109765921A (zh) * | 2019-03-04 | 2019-05-17 | 北京航空航天大学 | 一种保证通信且避免碰撞的航天器编队协同控制方法 |
CN111367314A (zh) * | 2020-03-09 | 2020-07-03 | 西北工业大学 | 一种基于多航天器编队的空间非合作目标协同抓捕方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113697130B (zh) | 2023-04-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107688295B (zh) | 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 | |
CN106707751B (zh) | 航天器终端接近的有限时间饱和避碰控制方法 | |
CN106773713B (zh) | 针对欠驱动海洋航行器的高精度非线性路径跟踪控制方法 | |
CN106325291B (zh) | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及系统 | |
CN105159304B (zh) | 接近并跟踪空间非合作目标的有限时间容错控制方法 | |
CN109189085A (zh) | 基于事件触发的航天器网络化系统姿态控制方法 | |
CN104898683A (zh) | 一种挠性卫星神经网络反步滑模姿态控制方法 | |
CN105182985A (zh) | 高超声速飞行器俯冲段全量一体化制导控制方法 | |
CN109426147B (zh) | 捕获卫星后组合航天器的自适应增益调整控制方法 | |
CN111506095A (zh) | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 | |
CN106708078A (zh) | 一种适用于空间机器人执行器故障下的快速姿态稳定方法 | |
CN107977011B (zh) | 基于分数阶控制算法的四旋翼无人机飞行控制方法 | |
CN113268084A (zh) | 一种无人机编队智能容错控制方法 | |
CN115639830A (zh) | 一种空地智能体协同编队控制系统及其编队控制方法 | |
CN113406967A (zh) | 一种多航天器分布式协同编队控制方法 | |
CN110275542B (zh) | 一种基于自适应有限时间控制的四旋翼飞行器控制方法 | |
CN115097856A (zh) | 一种基于导航向量场的四旋翼无人机目标跟踪动态反馈控制方法 | |
CN115129072A (zh) | 固定翼无人机位置跟踪偏差约束下终端滑模控制方法 | |
CN107942672B (zh) | 一种基于对称时不变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 | |
CN107247464B (zh) | 一种四旋翼无人飞行器的状态受限控制方法和系统 | |
CN107783420B (zh) | 一种星载运动天线扰动抑制方法 | |
CN113697130B (zh) | 一种基于干扰观测器的航天器编队抓捕避碰控制方法 | |
CN116382332B (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
CN117055593A (zh) | 一种旋翼无人机避障滑模容错控制方法 | |
CN111190440A (zh) | 一种悬挂负载空中机器人的抗摆控制方法 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20230407 |