CN113485395A - 一种误差约束下固定时间相对姿轨跟踪控制方法 - Google Patents

一种误差约束下固定时间相对姿轨跟踪控制方法 Download PDF

Info

Publication number
CN113485395A
CN113485395A CN202110728294.XA CN202110728294A CN113485395A CN 113485395 A CN113485395 A CN 113485395A CN 202110728294 A CN202110728294 A CN 202110728294A CN 113485395 A CN113485395 A CN 113485395A
Authority
CN
China
Prior art keywords
relative
tracking
orbit
attitude
error
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
Application number
CN202110728294.XA
Other languages
English (en)
Other versions
CN113485395B (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.)
Beijing Institute of Control Engineering
Original Assignee
Beijing Institute of Control Engineering
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 Beijing Institute of Control Engineering filed Critical Beijing Institute of Control Engineering
Priority to CN202110728294.XA priority Critical patent/CN113485395B/zh
Publication of CN113485395A publication Critical patent/CN113485395A/zh
Application granted granted Critical
Publication of CN113485395B publication Critical patent/CN113485395B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0825Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Mathematical Physics (AREA)
  • Mathematical Analysis (AREA)
  • Algebra (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Feedback Control In General (AREA)

Abstract

一种误差约束下固定时间相对姿轨跟踪控制方法,针对空间交会对接任务的特殊性,结合固定时间稳定概念显式给出了相对轨道与姿态跟踪误差收敛至稳态边界约束范围内的时间,即实现了收敛时间的预先设定,同时与传统预设性能控制方法相比,无需误差变换函数就可以保证相对姿轨跟踪误差具有期望的动态和稳态性能,同时通过设计非线性干扰观测器估计并补偿了系统不确定性、外界干扰等复合不确定性以提高系统鲁棒性,设计的控制器具有较高的控制精度和响应速度,满足实际交会对接任务对相对状态约束和收敛时间约束的要求。

Description

一种误差约束下固定时间相对姿轨跟踪控制方法
技术领域
本发明涉及一种误差约束下固定时间相对姿轨跟踪控制方法,属于航天器控制技术领域。
背景技术
随着航天技术的不断发展,航天器承担的空间任务日趋复杂,良好的相对轨道与姿态跟踪性能是完成诸如在轨维修、空间观测等交会对接任务的前提和保障。在实际工程中,相对轨道与姿态协同控制问题需要考虑的问题很多。首先,相对轨道与姿态跟踪系统是一个多输入多输出的非线性系统,且由于存在位姿耦合的特点,因此其精确的动力学模型往往难以获得,另外由于燃料消耗带来的航天器质量和转动惯量等参数存在不确定,也难以精确测量和估计。另一方面由于空间环境的复杂性,航天器在轨不可避免会受到诸如太阳光压、重力梯度和气动阻力等带来的外部干扰,这些干扰的精确模型也难以获取。此外,在交会对接任务中,要求相对轨道与姿态跟踪系统具有期望的动态过程或满足特定的约束条件。例如,在天宫二号和神舟十一号交会对接任务中,除了相对轨道控制外,同时还需要控制相对姿态使得两个航天器的对接口精确对准,以完成对接结构锁紧、成为组合体等过程。
包括PID控制、变结构控制等应用于交会对接的传统控制方法大多是渐进稳定的,即相对轨道与姿态跟踪误差的收敛时间是无限长的,而很多交会对接任务对快速性又具有较高要求。而且相对于渐进稳定,有限时间或者固定时间收敛具有更快的收敛速度并且具有抗干扰能力强的优势。因此,针对交会对接任务研究带有状态约束的误差约束下固定时间相对姿轨跟踪控制试验方法具有重要的工程意义。
发明内容
本发明解决的技术问题是:针对目前现有技术中存在的不足,提出了一种误差约束下固定时间相对姿轨跟踪控制方法,通过设计非线性干扰观测器估计并补偿了系统不确定性、外界干扰等复合不确定性。
本发明解决上述技术问题是通过如下技术方案予以实现的:
一种误差约束下固定时间相对姿轨跟踪控制方法,步骤如下:
(1)建立跟踪航天器与目标航天器间六自由度交会对接模型,包括两航天器间相对轨道和相对姿态跟踪控制运动学与动力学模型;
(2)根据交会对接任务中相对轨道与姿态跟踪控制误差的暂态和稳态性能指标要求,设计相对轨道与姿态跟踪误差固定时间收敛性能函数导数;
(3)根据步骤(2)所得相对轨道与姿态跟踪误差固定时间收敛性能函数导数,通过积分求解获取固定时间收敛性能函数;
(4)根据步骤(3)所得相对轨道与姿态跟踪误差性能函数,构造相对轨道与姿态跟踪控制器用的中间误差变量、设计误差变量;
(5)利用步骤(1)所得相对轨道和相对姿态跟踪控制运动学与动力学模型、步骤(4)所得设计误差变量,构造相对轨道与姿态虚拟控制量及其导数;
(6)通过步骤(1)所得相对轨道和相对姿态跟踪控制运动学与动力学模型、步骤(4)所得设计误差变量构造相对轨道与姿态跟踪系统非线性干扰观测器;
(7)根据步骤(1)所得相对轨道和相对姿态跟踪控制运动学与动力学模型、步骤(4)所得设计误差变量、步骤(6)所得相对轨道与姿态跟踪系统非线性干扰观测器设计固定时间相对姿轨跟踪控制器。
步骤(1)中,跟踪航天器和目标航天器相对姿态跟踪运动学与动力学模型分别为:
Figure BDA0003139353510000021
Figure BDA0003139353510000022
式中,
Figure BDA0003139353510000023
为用修正罗德里格斯参数描述的姿态跟踪误差,
Figure BDA0003139353510000024
为姿态跟踪误差,
Figure BDA0003139353510000025
为轨道器转动惯量矩阵,
Figure BDA0003139353510000026
Figure BDA0003139353510000027
分别表示干扰力矩与控制力矩;
其中,相对姿态动力学模型中矩阵G(σe)、Ca和非线性向量ha分别为:
Figure BDA0003139353510000031
Ca=S(J(ωe+R(σet))-S(R(σet)J-JS(R(σet)
Figure BDA0003139353510000032
轨道器本体系与上升器本体系之间的坐标转换矩阵R(σe)可表示为
Figure BDA0003139353510000033
跟踪航天器和目标航天器相对轨道跟踪运动学与动力学模型分别为:
Figure BDA0003139353510000034
Figure BDA0003139353510000035
式中,
Figure BDA0003139353510000036
Figure BDA0003139353510000037
分别表示相对轨道与速度跟踪误差,m为轨道器质量,
Figure BDA0003139353510000038
Figure BDA0003139353510000039
分别表示轨道器与上升器的角速度,满足ωe=ωs-R(σet
Figure BDA00031393535100000310
Figure BDA00031393535100000311
分别表示干扰力与控制力,S(·)为叉乘算子。
对于任意三维向量γ=[γ1γ2γ3]T,叉乘矩阵S(γ)为:
Figure BDA00031393535100000312
相对轨道动力学模型中非线性向量hp为:
Figure BDA00031393535100000313
式中,rt为上升器的位置矢量,μ为地心引力常数。
步骤(2)中,相对姿态跟踪误差固定时间收敛性能函数导数具体为:
Figure BDA00031393535100000314
式中,ασσ,pσ与gσ皆为正常数且满足pσ<1和gσ>1,相对姿态跟踪误差将在时间Tσ内收敛到期望稳态指标ρσ∞,其中,Tσ为:
Figure BDA0003139353510000041
相对轨道跟踪误差固定时间收敛性能函数导数为:
Figure BDA0003139353510000042
式中,αpp,pp与gp皆为正常数且满足pp<1和gp>1,相对轨道跟踪误差将在时间Tp内收敛到期望稳态指标ρp∞,其中,Tσ为:
Figure BDA0003139353510000043
步骤(3)中,相对轨道与姿态跟踪误差固定时间收敛性能函数分别为:
Figure BDA0003139353510000044
其中,相对姿态与轨道跟踪误差的预设性能约束为:
ρσli≤σei≤ρσui(i=1,2,3)
ρpli≤rei≤ρpui(i=1,2,3)
式中,ρσli与ρσui分别为相对姿态跟踪控制误差性能约束下界与上界,ρpli与ρpui分别为相对轨道跟踪控制误差性能约束下界与上界。
步骤(4)中,相对姿态跟踪控制器设计所需的中间误差变量为:
Figure BDA0003139353510000045
式中,ασ为相对姿态跟踪系统待设计的虚拟控制量,矩阵Mσ1,Mσ2与向量vσ1分别为:
Figure BDA0003139353510000051
Figure BDA0003139353510000052
相对轨道跟踪控制器设计所需的中间误差变量分别为:
Figure BDA0003139353510000053
式中,ασ为相对轨道跟踪系统待设计的虚拟控制量,矩阵Mp1,Mp2与向量vσ1分别为:
Figure BDA0003139353510000054
Figure BDA0003139353510000061
相对轨道与姿态跟踪控制器用的设计误差变量、χσ=[χσ1σ2σ3]T、χp=[χp1p2p3]T,具体为:
Figure BDA0003139353510000062
Figure BDA0003139353510000063
步骤(5)中,相对轨道与姿态虚拟控制量分别为:
ασ=G-1e)[-Kσ1χσ+Mσ2σe+vσ1]
αp=-Kp1χp+Mp2re+vp1
式中,Kσ1与Kp1均为对称正定矩阵;
相对轨道与姿态虚拟控制量的导数估计值
Figure BDA0003139353510000064
Figure BDA0003139353510000065
分别为:
Figure BDA0003139353510000066
Figure BDA0003139353510000067
式中,ζ12与ωn1n2分别为命令滤波器增益与阻尼比。
步骤(6)中,相对姿态跟踪系统非线性干扰观测器为:
Figure BDA0003139353510000068
式中,lσ1与lσ2为观测器设计参数,
Figure BDA0003139353510000069
为复合不确定性dτ的估计值,ησ为干扰观测器的状态变量,
Figure BDA00031393535100000610
相对轨道跟踪系统非线性干扰观测器为:
Figure BDA0003139353510000071
式中,lp1与lp2为观测器设计参数,
Figure BDA0003139353510000072
为复合不确定性df的估计值,ηp为干扰观测器的状态变量,
Figure BDA0003139353510000073
步骤(7)中,固定时间相对姿轨跟踪控制器具体为:
Figure BDA0003139353510000074
式中,Kσ2与Kp2均为对称正定矩阵。
本发明与现有技术相比的优点在于:
本发明提供的一种误差约束下固定时间相对姿轨跟踪控制方法,无需误差变换函数就可以保证相对姿轨跟踪误差具有期望的动态和稳态性能,给出了相对轨道与姿态跟踪误差收敛至稳态边界约束范围内的时间,即实现了收敛时间的预先设定,并通过设计非线性干扰观测器估计并有效补偿了系统不确定性、外界干扰等复合不确定性,进一步提高了鲁棒性。
附图说明
图1为发明提供的相对轨道与姿态跟踪控制系统闭环结构框图;
图2为发明提供的误差约束下固定时间相对姿轨跟踪控制试验方法流程框图;
图3为发明提供的不同收敛时间指标要求下的性能约束边界曲线示意图;
具体实施方式
一种误差约束下固定时间相对姿轨跟踪控制方法,结合固定时间稳定概念显式给出了相对轨道与姿态跟踪误差收敛至稳态边界约束范围内的时间,即实现了收敛时间的预先设定,同时与传统预设性能控制方法相比,无需误差变换函数就可以保证相对姿轨跟踪误差具有期望的动态和稳态性能,具体步骤如下:
(1)建立跟踪航天器与目标航天器间六自由度交会对接模型,包括两航天器间相对轨道和相对姿态跟踪控制运动学与动力学模型;
其中,跟踪航天器和目标航天器相对姿态跟踪运动学与动力学模型分别为:
Figure BDA0003139353510000081
Figure BDA0003139353510000082
式中,
Figure BDA0003139353510000083
为用修正罗德里格斯参数描述的姿态跟踪误差,
Figure BDA0003139353510000084
为姿态跟踪误差,
Figure BDA0003139353510000085
为轨道器转动惯量矩阵,
Figure BDA0003139353510000086
Figure BDA0003139353510000087
分别表示干扰力矩与控制力矩;
其中,相对姿态动力学模型中矩阵G(σe)、Ca和非线性向量ha分别为:
Figure BDA0003139353510000088
Ca=S(J(ωe+R(σet))-S(R(σet)J-JS(R(σet)
Figure BDA0003139353510000089
轨道器本体系与上升器本体系之间的坐标转换矩阵R(σe)可表示为
Figure BDA00031393535100000810
跟踪航天器和目标航天器相对轨道跟踪运动学与动力学模型分别为:
Figure BDA00031393535100000811
Figure BDA00031393535100000812
式中,
Figure BDA00031393535100000813
Figure BDA00031393535100000814
分别表示相对轨道与速度跟踪误差,m为轨道器质量,
Figure BDA00031393535100000815
Figure BDA00031393535100000816
分别表示轨道器与上升器的角速度,满足ωe=ωs-R(σet
Figure BDA00031393535100000817
Figure BDA00031393535100000818
分别表示干扰力与控制力,S(·)为叉乘算子;
对于任意三维向量γ=[γ1 γ2 γ3]T,叉乘矩阵S(γ)为:
Figure BDA00031393535100000819
相对轨道动力学模型中非线性向量hp为:
Figure BDA00031393535100000820
式中,rt为上升器的位置矢量,μ为地心引力常数。
(2)根据交会对接任务中相对轨道与姿态跟踪控制误差的暂态和稳态性能指标要求,设计相对轨道与姿态跟踪误差固定时间收敛性能函数导数;
其中,相对姿态跟踪误差固定时间收敛性能函数导数具体为:
Figure BDA0003139353510000091
式中,ασσ,pσ与gσ皆为正常数且满足pσ<1和gσ>1,相对姿态跟踪误差将在时间Tσ内收敛到期望稳态指标ρσ∞,其中,Tσ为:
Figure BDA0003139353510000092
相对轨道跟踪误差固定时间收敛性能函数导数为:
Figure BDA0003139353510000093
式中,αpp,pp与gp皆为正常数且满足pp<1和gp>1,相对轨道跟踪误差将在时间Tp内收敛到期望稳态指标ρp∞,其中,Tσ为:
Figure BDA0003139353510000094
(3)根据步骤(2)所得相对轨道与姿态跟踪误差固定时间收敛性能函数导数,通过积分求解获取固定时间收敛性能函数;
其中,相对轨道与姿态跟踪误差固定时间收敛性能函数分别为:
Figure BDA0003139353510000095
其中,相对姿态与轨道跟踪误差的预设性能约束可以描述:
ρσli≤σei≤ρσui(i=1,2,3)
ρpli≤rei≤ρpui(i=1,2,3)
式中,ρσli与ρσui分别为相对姿态跟踪控制误差性能约束下界与上界,ρpli与ρpui分别为相对轨道跟踪控制误差性能约束下界与上界;
(4)根据步骤(3)所得相对轨道与姿态跟踪误差性能函数,构造相对轨道与姿态跟踪控制器用的中间误差变量、设计误差变量;
其中,相对姿态跟踪控制器设计的中间误差变量为:
Figure BDA0003139353510000101
式中,ασ为相对姿态跟踪系统待设计的虚拟控制量,矩阵Mσ1,Mσ2与向量vσ1分别为:
Figure BDA0003139353510000102
Figure BDA0003139353510000103
相对轨道跟踪控制器设计的中间误差变量分别为:
Figure BDA0003139353510000104
式中,ασ为相对轨道跟踪系统待设计的虚拟控制量,矩阵Mp1,Mp2与向量vσ1分别为:
Figure BDA0003139353510000111
Figure BDA0003139353510000112
相对轨道与姿态跟踪控制器用的设计误差变量、χσ=[χσ1σ2σ3]T、χp=[χp1p2p3]T,具体为:
Figure BDA0003139353510000113
Figure BDA0003139353510000114
(5)利用步骤(1)所得相对轨道和相对姿态跟踪控制运动学与动力学模型、步骤(4)所得设计误差变量,构造相对轨道与姿态虚拟控制量及其导数;
其中,相对轨道与姿态虚拟控制量分别为:
ασ=G-1e)[-Kσ1χσ+Mσ2σe+vσ1]
αp=-Kp1χp+Mp2re+vp1
式中,Kσ1与Kp1均为对称正定矩阵;
相对轨道与姿态虚拟控制量的导数估计值
Figure BDA0003139353510000115
Figure BDA0003139353510000116
分别为:
Figure BDA0003139353510000117
Figure BDA0003139353510000121
式中,ζ12与ωn1n2分别为命令滤波器增益与阻尼比;
(6)通过步骤(1)所得相对轨道和相对姿态跟踪控制运动学与动力学模型、步骤(4)所得设计误差变量构造相对轨道与姿态跟踪系统非线性干扰观测器;
其中,相对姿态跟踪系统非线性干扰观测器为:
Figure BDA0003139353510000122
式中,lσ1与lσ2为观测器设计参数,
Figure BDA0003139353510000123
为复合不确定性dτ的估计值,ησ为干扰观测器的状态变量,
Figure BDA0003139353510000124
相对轨道跟踪系统非线性干扰观测器为:
Figure BDA0003139353510000125
式中,lp1与lp2为观测器设计参数,
Figure BDA0003139353510000126
为复合不确定性df的估计值,ηp为干扰观测器的状态变量,
Figure BDA0003139353510000127
(7)根据步骤(1)所得相对轨道和相对姿态跟踪控制运动学与动力学模型、步骤(4)所得设计误差变量、步骤(6)所得相对轨道与姿态跟踪系统非线性干扰观测器设计固定时间相对姿轨跟踪控制器。
其中,固定时间相对姿轨跟踪控制器具体为:
Figure BDA0003139353510000128
式中,Kσ2与Kp2均为对称正定矩阵。
下面结合具体实施例进行进一步说明:
本发明首先建立交会对接任务中追踪航天器与目标航天器间的相对轨道与姿态跟踪动力学与运动学模型,考虑了模型不确定性、外界干扰力矩扰动。然后,设计具有固定时间收敛特性的性能边界来约束相对轨道与姿态跟踪误差,可实现控制误差收敛时间的预先设定。最后,设计非线性干扰观测器估计并补偿包含模型不确定性、外界干扰力矩扰动等在内的复合不确定性,并由此得到最终的轨道器与上升器间的相对轨道与姿态跟踪控制律。
在本实施例中,如图1、图2所示,针对交会对接任务中跟踪航天器与目标航天器间的相对轨道与姿态跟踪控制问题提出了一种误差约束下固定时间相对姿轨跟踪控制试验方法,具体步骤为:
(1)建立跟踪航天器与目标航天器间六自由度交会对接模型,该模型包含两个航天器之间的相对轨道和相对姿态跟踪控制运动学与动力学。
Figure BDA0003139353510000131
Figure BDA0003139353510000132
式中,
Figure BDA0003139353510000133
为用修正罗德里格斯参数描述的姿态跟踪误差,
Figure BDA0003139353510000134
为姿态跟踪误差,
Figure BDA0003139353510000135
为轨道器转动惯量矩阵,
Figure BDA0003139353510000136
Figure BDA0003139353510000137
分别表示干扰力矩与控制力矩。
相对姿态动力学模型中矩阵G(σe)、Ca和非线性向量ha分别表示为
Figure BDA0003139353510000138
Ca=S(J(ωe+R(σet))-S(R(σet)J-JS(R(σet)
Figure BDA0003139353510000139
轨道器本体系与上升器本体系之间的坐标转换矩阵R(σe)可表示为
Figure BDA00031393535100001310
相对轨道跟踪控制系统的运动学与动力学模型分别为:
Figure BDA00031393535100001311
Figure BDA00031393535100001312
式中,
Figure BDA00031393535100001313
Figure BDA00031393535100001314
分别表示相对轨道与速度跟踪误差,m为轨道器质量,
Figure BDA0003139353510000141
Figure BDA0003139353510000142
分别表示轨道器与上升器的角速度,满足ωe=ωs-R(σet
Figure BDA0003139353510000143
Figure BDA0003139353510000144
分别表示干扰力与控制力。
相对轨道动力学模型中非线性向量hp
Figure BDA0003139353510000145
S(·)为叉乘算子,定义:对于任意三维向量γ=[γ1γ2γ3]T,叉乘矩阵S(γ)为
Figure BDA0003139353510000146
(2)根据交会对接任务中相对轨道与姿态跟踪控制误差的暂态和稳态性能指标要求,设计相对姿态跟踪误差固定时间收敛性能函数导数为
Figure BDA0003139353510000147
式中,ασσ,pσ与gσ皆为正常数且满足pσ<1和gσ>1,相对姿态跟踪误差将在时间Tσ内收敛到期望稳态指标ρσ∞,其中Tσ
Figure BDA0003139353510000148
同理,设计相对轨道跟踪误差固定时间收敛性能函数导数为
Figure BDA0003139353510000149
式中,αpp,pp与gp皆为正常数且满足pp<1和gp>1,相对轨道跟踪误差将在时间Tp内收敛到期望稳态指标ρp∞,其中Tσ
Figure BDA00031393535100001410
(3)基于步骤(2)的相对轨道与姿态跟踪误差固定时间收敛性能函数导数进行积分求解可得固定时间收敛性能函数分别为
Figure BDA0003139353510000151
那么相对姿态与轨道跟踪误差的预设性能约束可以描述为
ρσli≤σei≤ρσui(i=1,2,3)
ρpli≤rei≤ρpui(i=1,2,3)
式中,ρσli与ρσui分别为相对姿态跟踪控制误差性能约束下界与上界,ρpli与ρpui分别为相对轨道跟踪控制误差性能约束下界与上界。
(4)基于步骤(3)的相对轨道与姿态跟踪误差性能函数,构造用于后续相对轨道与姿态跟踪控制器设计的中间误差变量;
Figure BDA0003139353510000152
式中,ασ为相对姿态跟踪系统待设计的虚拟控制量,矩阵Mσ1,Mσ2与向量vσ1分别为
Figure BDA0003139353510000153
Figure BDA0003139353510000154
同理,构造相对轨道跟踪控制器设计的中间误差变量分别为
Figure BDA0003139353510000161
式中,ασ为相对轨道跟踪系统待设计的虚拟控制量,矩阵Mp1,Mp2与向量vσ1分别为
Figure BDA0003139353510000162
Figure BDA0003139353510000163
(5)基于步骤(3)的相对轨道与姿态跟踪误差性能函数构造用于后续相对轨道与姿态跟踪控制器设计的设计误差变量χσ=[χσ1σ2σ3]T与χp=[χp1p2p3]T,其中
Figure BDA0003139353510000164
Figure BDA0003139353510000165
(6)基于步骤步骤(1)的相对轨道与姿态运动学、步骤(5)中设计误差变量设计相对轨道与姿态虚拟控制量及其导数;
ασ=G-1e)[-Kσ1χσ+Mσ2σe+vσ1]
αp=-Kp1χp+Mp2re+vp1
式中,Kσ1与Kp1均为对称正定矩阵。
进一步的,求解相对轨道与姿态虚拟控制量的导数估计值
Figure BDA0003139353510000171
Figure BDA0003139353510000172
分别为
Figure BDA0003139353510000173
Figure BDA0003139353510000174
式中,ζ12与ωn1n2分别为命令滤波器增益与阻尼比。
(7)基于步骤(1)的相对轨道与姿态动力学、步骤(5)中相对轨道与姿态设计误差变量设计设计相对姿态跟踪系统非线性干扰观测器为
Figure BDA0003139353510000175
式中,lσ1与lσ2为观测器设计参数,
Figure BDA0003139353510000176
为复合不确定性dτ的估计值,ησ为干扰观测器的状态变量,
Figure BDA0003139353510000177
同理,设计相对轨道跟踪系统非线性干扰观测器为
Figure BDA0003139353510000178
式中,lp1与lp2为观测器设计参数,
Figure BDA0003139353510000179
为复合不确定性df的估计值,ηp为干扰观测器的状态变量,
Figure BDA00031393535100001710
(8)基于步骤(1)的相对轨道与姿态动力学、步骤(5)中相对轨道与姿态设计误差变量、步骤(6)的相对轨道与姿态虚拟控制量的导数、步骤(7)的相对轨道与姿态跟踪系统非线性干扰观测器设计固定时间相对姿轨跟踪控制器为
Figure BDA00031393535100001711
式中,Kσ2与Kp2均为对称正定矩阵。
本发明设计的误差约束下固定时间相对姿轨跟踪控制试验方法,通过设计一种新的固定时间收敛的预设性能函数,如图3所示,给出了相对轨道与姿态跟踪误差收敛至稳态边界约束范围内的时间,即实现了收敛时间的预先设定,此外,通过设计非线性干扰观测器估计并有效补偿了系统不确定性、外界干扰等复合不确定性,进一步提高了控制器的鲁棒性。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。

Claims (9)

1.一种误差约束下固定时间相对姿轨跟踪控制方法,其特征在于步骤如下:
(1)建立跟踪航天器与目标航天器间六自由度交会对接模型,包括两航天器间相对轨道和相对姿态跟踪控制运动学与动力学模型;
(2)根据交会对接任务中相对轨道与姿态跟踪控制误差的暂态和稳态性能指标要求,设计相对轨道与姿态跟踪误差固定时间收敛性能函数导数;
(3)根据步骤(2)所得相对轨道与姿态跟踪误差固定时间收敛性能函数导数,通过积分求解获取固定时间收敛性能函数;
(4)根据步骤(3)所得相对轨道与姿态跟踪误差性能函数,构造相对轨道与姿态跟踪控制器用的中间误差变量、设计误差变量;
(5)利用步骤(1)所得相对轨道和相对姿态跟踪控制运动学与动力学模型、步骤(4)所得设计误差变量,构造相对轨道与姿态虚拟控制量及其导数;
(6)通过步骤(1)所得相对轨道和相对姿态跟踪控制运动学与动力学模型、步骤(4)所得设计误差变量构造相对轨道与姿态跟踪系统非线性干扰观测器;
(7)根据步骤(1)所得相对轨道和相对姿态跟踪控制运动学与动力学模型、步骤(4)所得设计误差变量、步骤(6)所得相对轨道与姿态跟踪系统非线性干扰观测器设计固定时间相对姿轨跟踪控制器。
2.根据权利要求1所述的一种误差约束下固定时间相对姿轨跟踪控制方法,其特征在于:
所述步骤(1)中,跟踪航天器和目标航天器相对姿态跟踪运动学与动力学模型分别为:
Figure FDA0003139353500000011
Figure FDA0003139353500000012
式中,
Figure FDA0003139353500000013
为用修正罗德里格斯参数描述的姿态跟踪误差,
Figure FDA0003139353500000014
为姿态跟踪误差,
Figure FDA0003139353500000015
为轨道器转动惯量矩阵,
Figure FDA0003139353500000016
Figure FDA0003139353500000017
分别表示干扰力矩与控制力矩;
其中,相对姿态动力学模型中矩阵G(σe)、Ca和非线性向量ha分别为:
Figure FDA0003139353500000021
Ca=S(J(ωe+R(σet))-S(R(σet)J-JS(R(σet)
Figure FDA0003139353500000022
轨道器本体系与上升器本体系之间的坐标转换矩阵R(σe)可表示为
Figure FDA0003139353500000023
跟踪航天器和目标航天器相对轨道跟踪运动学与动力学模型分别为:
Figure FDA0003139353500000024
Figure FDA0003139353500000025
式中,
Figure FDA0003139353500000026
Figure FDA0003139353500000027
分别表示相对轨道与速度跟踪误差,m为轨道器质量,
Figure FDA0003139353500000028
Figure FDA0003139353500000029
分别表示轨道器与上升器的角速度,满足ωe=ωs-R(σet
Figure FDA00031393535000000210
Figure FDA00031393535000000211
分别表示干扰力与控制力,S(·)为叉乘算子。
3.根据权利要求2所述的一种误差约束下固定时间相对姿轨跟踪控制方法,其特征在于:
对于任意三维向量γ=[γ1 γ2 γ3]T,叉乘矩阵S(γ)为:
Figure FDA00031393535000000212
相对轨道动力学模型中非线性向量hp为:
Figure FDA00031393535000000213
式中,rt为上升器的位置矢量,μ为地心引力常数。
4.根据权利要求1所述的一种误差约束下固定时间相对姿轨跟踪控制方法,其特征在于:
所述步骤(2)中,相对姿态跟踪误差固定时间收敛性能函数导数具体为:
Figure FDA0003139353500000031
式中,ασσ,pσ与gσ皆为正常数且满足pσ<1和gσ>1,相对姿态跟踪误差将在时间Tσ内收敛到期望稳态指标ρσ∞,其中,Tσ为:
Figure FDA0003139353500000032
相对轨道跟踪误差固定时间收敛性能函数导数为:
Figure FDA0003139353500000033
式中,αpp,pp与gp皆为正常数且满足pp<1和gp>1,相对轨道跟踪误差将在时间Tp内收敛到期望稳态指标ρp∞,其中,Tσ为:
Figure FDA0003139353500000034
5.根据权利要求1所述的一种误差约束下固定时间相对姿轨跟踪控制方法,其特征在于:
所述步骤(3)中,相对轨道与姿态跟踪误差固定时间收敛性能函数分别为:
Figure FDA0003139353500000035
其中,相对姿态与轨道跟踪误差的预设性能约束为:
ρσli≤σei≤ρσui(i=1,2,3)
ρpli≤rei≤ρpui(i=1,2,3)
式中,ρσli与ρσui分别为相对姿态跟踪控制误差性能约束下界与上界,ρpli与ρpui分别为相对轨道跟踪控制误差性能约束下界与上界。
6.根据权利要求1所述的一种误差约束下固定时间相对姿轨跟踪控制方法,其特征在于:
所述步骤(4)中,相对姿态跟踪控制器设计所需的中间误差变量为:
Figure FDA0003139353500000041
式中,ασ为相对姿态跟踪系统待设计的虚拟控制量,矩阵Mσ1,Mσ2与向量vσ1分别为:
Figure FDA0003139353500000042
Figure FDA0003139353500000043
相对轨道跟踪控制器设计所需的中间误差变量分别为:
Figure FDA0003139353500000044
式中,ασ为相对轨道跟踪系统待设计的虚拟控制量,矩阵Mp1,Mp2与向量vσ1分别为:
Figure FDA0003139353500000051
Figure FDA0003139353500000052
相对轨道与姿态跟踪控制器用的设计误差变量、χσ=[χσ1σ2σ3]T、χp=[χp1p2p3]T,具体为:
Figure FDA0003139353500000053
Figure FDA0003139353500000054
7.根据权利要求1所述的一种误差约束下固定时间相对姿轨跟踪控制方法,其特征在于:
所述步骤(5)中,相对轨道与姿态虚拟控制量分别为:
ασ=G-1e)[-Kσ1χσ+Mσ2σe+vσ1]
αp=-Kp1χp+Mp2re+vp1
式中,Kσ1与Kp1均为对称正定矩阵;
相对轨道与姿态虚拟控制量的导数估计值
Figure FDA0003139353500000055
Figure FDA0003139353500000056
分别为:
Figure FDA0003139353500000057
Figure FDA0003139353500000061
式中,ζ12与ωn1n2分别为命令滤波器增益与阻尼比。
8.根据权利要求1所述的一种误差约束下固定时间相对姿轨跟踪控制方法,其特征在于:
所述步骤(6)中,相对姿态跟踪系统非线性干扰观测器为:
Figure FDA0003139353500000062
式中,lσ1与lσ2为观测器设计参数,
Figure FDA0003139353500000063
为复合不确定性dτ的估计值,ησ为干扰观测器的状态变量,
Figure FDA0003139353500000064
相对轨道跟踪系统非线性干扰观测器为:
Figure FDA0003139353500000065
式中,lp1与lp2为观测器设计参数,
Figure FDA0003139353500000066
为复合不确定性df的估计值,ηp为干扰观测器的状态变量,
Figure FDA0003139353500000067
9.根据权利要求1所述的一种误差约束下固定时间相对姿轨跟踪控制方法,其特征在于:
所述步骤(7)中,固定时间相对姿轨跟踪控制器具体为:
Figure FDA0003139353500000068
式中,Kσ2与Kp2均为对称正定矩阵。
CN202110728294.XA 2021-06-29 2021-06-29 一种误差约束下固定时间相对姿轨跟踪控制方法 Active CN113485395B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110728294.XA CN113485395B (zh) 2021-06-29 2021-06-29 一种误差约束下固定时间相对姿轨跟踪控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110728294.XA CN113485395B (zh) 2021-06-29 2021-06-29 一种误差约束下固定时间相对姿轨跟踪控制方法

Publications (2)

Publication Number Publication Date
CN113485395A true CN113485395A (zh) 2021-10-08
CN113485395B CN113485395B (zh) 2024-03-15

Family

ID=77936721

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110728294.XA Active CN113485395B (zh) 2021-06-29 2021-06-29 一种误差约束下固定时间相对姿轨跟踪控制方法

Country Status (1)

Country Link
CN (1) CN113485395B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114779799A (zh) * 2022-05-23 2022-07-22 哈尔滨工业大学 基于扩张干扰观测器的柔性航天器姿轨跟踪控制方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110018637A (zh) * 2018-12-27 2019-07-16 西北工业大学 一种考虑完成时间约束的航天器姿态跟踪保性能控制方法
GB201910669D0 (en) * 2018-07-25 2019-09-11 Univ Northwestern Polytechnical Method for controlling relative attitude of spacecrafts having multi-source disturbances and actuator saturation
CN110794863A (zh) * 2019-11-20 2020-02-14 中山大学 一种控制性能指标可定制的重型运载火箭姿态控制方法
CN110844122A (zh) * 2019-11-20 2020-02-28 中山大学 一种约束姿态跟踪误差的卫星姿态控制方法
CN111123961A (zh) * 2019-12-11 2020-05-08 上海卫星工程研究所 基于约束分析的双矢量夹角限制范围确定方法及系统
CN111637896A (zh) * 2020-05-12 2020-09-08 北京控制工程研究所 一种基于星历约束辅助的自主天文导航方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB201910669D0 (en) * 2018-07-25 2019-09-11 Univ Northwestern Polytechnical Method for controlling relative attitude of spacecrafts having multi-source disturbances and actuator saturation
CN110018637A (zh) * 2018-12-27 2019-07-16 西北工业大学 一种考虑完成时间约束的航天器姿态跟踪保性能控制方法
CN110794863A (zh) * 2019-11-20 2020-02-14 中山大学 一种控制性能指标可定制的重型运载火箭姿态控制方法
CN110844122A (zh) * 2019-11-20 2020-02-28 中山大学 一种约束姿态跟踪误差的卫星姿态控制方法
CN111123961A (zh) * 2019-12-11 2020-05-08 上海卫星工程研究所 基于约束分析的双矢量夹角限制范围确定方法及系统
CN111637896A (zh) * 2020-05-12 2020-09-08 北京控制工程研究所 一种基于星历约束辅助的自主天文导航方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
陶佳伟;张涛;: "具有预设性能的近距离星间相对姿轨耦合控制", 系统工程与电子技术, no. 05, pages 172 - 17 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114779799A (zh) * 2022-05-23 2022-07-22 哈尔滨工业大学 基于扩张干扰观测器的柔性航天器姿轨跟踪控制方法

Also Published As

Publication number Publication date
CN113485395B (zh) 2024-03-15

Similar Documents

Publication Publication Date Title
CN108803649B (zh) 一种垂直起降重复使用运载器自抗扰滑模控制方法
CN109189085B (zh) 基于事件触发的航天器网络化系统姿态控制方法
CN110794863B (zh) 一种控制性能指标可定制的重型运载火箭姿态控制方法
CN106970530B (zh) 空间非合作目标自主视线交会的无模型预设性能控制方法
CN109062043B (zh) 考虑网络传输以及执行器饱和的航天器自抗扰控制方法
CN113361013B (zh) 一种基于时间同步稳定的航天器姿态鲁棒控制方法
CN108563131B (zh) 一种卫星姿态控制系统执行器失控故障的自适应补偿方法
CN109597426A (zh) 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法
CN111338368B (zh) 一种航天器快速机动姿态跟踪自适应鲁棒控制方法
CN113619814A (zh) 一种交会对接最后逼近段相对姿轨耦合控制方法
CN112327926B (zh) 一种无人机编队的自适应滑模控制方法
CN114047773A (zh) 一种基于扩张状态观测器的水下集矿机器人反步滑模自适应姿态控制方法
CN108804846B (zh) 非合作目标组合体航天器的数据驱动姿态控制器设计方法
CN108427281B (zh) 一种航天器六自由度固定时间交会对接控制方法
CN113268084A (zh) 一种无人机编队智能容错控制方法
CN107797449A (zh) 一种信息不完备情形下的空间非合作目标接管控制方法
CN113485395A (zh) 一种误差约束下固定时间相对姿轨跟踪控制方法
CN116923730B (zh) 一种具有自调节预设性能约束的航天器姿态主动容错控制方法
CN115129072A (zh) 固定翼无人机位置跟踪偏差约束下终端滑模控制方法
CN116382332B (zh) 一种基于ude的战斗机大机动鲁棒飞行控制方法
Yongmei et al. Trajectory tracking of a high altitude unmanned airship based on adaptive feedback linearization
CN112506209B (zh) 一种基于自适应预测周期的再入飞行器预测控制方法
CN116360258A (zh) 基于固定时间收敛的高超声速变形飞行器抗干扰控制方法
CN115892519A (zh) 一种用于近距离航天器轨道脉冲博弈的航天器控制方法
Xiao et al. Large-angle velocity-free attitude tracking control of satellites: An observer-free framework

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