CN111506095A - 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 - Google Patents
一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 Download PDFInfo
- Publication number
- CN111506095A CN111506095A CN202010333570.8A CN202010333570A CN111506095A CN 111506095 A CN111506095 A CN 111506095A CN 202010333570 A CN202010333570 A CN 202010333570A CN 111506095 A CN111506095 A CN 111506095A
- Authority
- CN
- China
- Prior art keywords
- relative
- tracker
- coordinate system
- pose
- fixed time
- 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
- 238000000034 method Methods 0.000 title claims abstract description 35
- 230000000694 effects Effects 0.000 claims abstract description 11
- 230000003044 adaptive effect Effects 0.000 claims abstract description 7
- 239000011159 matrix material Substances 0.000 claims description 39
- 239000013598 vector Substances 0.000 claims description 18
- 238000006467 substitution reaction Methods 0.000 claims description 12
- 238000013461 design Methods 0.000 claims description 7
- 230000009977 dual effect Effects 0.000 claims description 7
- 229920006395 saturated elastomer Polymers 0.000 claims description 5
- 230000036544 posture Effects 0.000 claims description 4
- 238000003032 molecular docking Methods 0.000 description 4
- 238000004458 analytical method Methods 0.000 description 3
- 230000005484 gravity Effects 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005094 computer simulation Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Algebra (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法,包括:基于牛顿‑欧拉法建立追踪器与目标器的位姿动力学方程;根据建立的两刚体各自位姿动力学方程以及两刚体特征点间的相对位姿和相对速度,建立考虑模型不确定性的相对位姿动力学方程;根据建立的相对位姿动力学方程,设计固定时间扰动观测器;根据建立的固定时间非奇异终端滑动变量,设计非线性饱和补偿器,以解决执行器饱和效应;结合建立的固定时间扰动观测器以及非线性饱和补偿器,得到基于模型的鲁棒自适应控制器。本发明涉及三维空间中自主运动体的控制以及航天器领域。
Description
技术领域
本发明涉及三维空间中自主运动体的控制以及航天器技术领域,特别涉及一种基于扰动观测器的双刚体特征点间饱和固定时间相对位姿跟踪控制方法。
背景技术
高精度自主相对位姿控制是空间交会、空中加油、舰载机着舰等许多实际工程任务的重要技术。由于航天器、航空器和水下航行器的体积一般较大,在相对运动建模和自主运动控制设计中,需要考虑其特征点的位姿运动,如航天器上的对接口、航母上的着舰点等任务的控制系统设计,进而提高系统建模与控制精度。此外,由于一些实际任务执行时间短,执行器输出由于制造因素而受限制,需要研究先进的相对运动控制策略,以保证系统具有满意的控制性能,并处理响应时间和控制输入的约束。
有限/固定时间控制技术是控制系统设计中保证有限响应时间性能的有效方法。因此,有限响应时间要求的问题可以用有限时间或固定时间的控制方法来解决。特别是近年来,人们对有限/固定时间控制理论和应用进行了大量的研究。比如提出的一般连续自治系统的有限时间稳定性和有限时间输入状态稳定性定理。由于在传统的基于Lyapunov的控制器技术中引入了非线性状态反馈信号,因此可以根据控制器中的参数计算系统状态的收敛时间上界。研究针对受扰线性系统,提出了一种固定时间收敛的super-twisting控制器,并给出了收敛时间的估计方法。此外,在非对称控制输入约束条件下,针对多变量非线性系统设计了一种自适应固定时间控制器。除了上述关于线性和非线性系统在许多不同条件下的有限时间和固定时间系统设计的理论结果外,在一些工程场景下也有许多有限/固定时间控制设计,例如基于有限时间无源性方法的航天器姿态控制,自主水下机器人的有限时间输出反馈控制,航天器近距离操作的无源自适应有限时间控制,不确定机械系统的有限时间跟踪控制,航天器绕飞任务的自适应固定时间控制,机器人的固定时间跟踪控制等。
除了控制系统的收敛时间要求外,执行器饱和也是实际控制器设计中的一个重要问题。系统控制输入幅值的限制可能是执行器自身结构或能量限制的结果,也可能是控制系统安全性要求的结果。在这种情况下,控制器输出信号大于实际驱动系统的输出,则存在执行器饱和。由于执行器的工作能力有限,总是存在一个临界输出幅值,超过这个临界输出幅值,系统将无法稳定。因此,在理论设计和工程实践中必须考虑执行器饱和问题。近年来,有许多方法可以用来处理执行器饱和问题,如线性抗饱和补偿器、非线性抗饱和补偿器和基于连续有界函数的约束控制器。然而,这些控制方法不能同时处理执行器饱和固定时间收敛的要求,因此在Lyapunov框架下,提出一种控制器同时解决系统执行器饱和问题和满足状态固定时间收敛的需求具有较大的难度。
因此,在执行器饱和和固定时间收敛要求下,对三维空间中两刚体特征点之间的相对运动进行建模和控制具有重要意义。本发明则研究了同时受模型不确定性、未知动态耦合、执行器饱和、固定时间收敛要求的两个刚体特征点之间的相对位移和旋转运动控制问题。
发明内容
本发明的目的在于提供一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法,在设计的控制器下,能够实现在控制输入饱和和模型不确定性条件下的目标特征点位置跟踪和姿态同步,而且系统状态的收敛时间与初始状态是无关的,并由控制器参数估计;引入固定时间扰动观测器对未知有界扰动进行估计和补偿,在固定时间内观测误差收敛到零,还引入抗饱和补偿器解决了执行器饱和问题。
为解决上述技术问题,本发明的实施例提供如下方案:
一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法,包括以下步骤:
基于牛顿-欧拉法建立追踪器与目标器的位姿动力学方程;
根据建立的两刚体各自位姿动力学方程以及两刚体特征点间的相对位姿和相对速度,建立考虑模型不确定性的相对位姿动力学方程;
根据建立的相对位姿动力学方程,设计固定时间扰动观测器;
根据建立的固定时间非奇异终端滑动变量,设计非线性饱和补偿器,以解决执行器饱和效应;
结合建立的固定时间扰动观测器以及非线性饱和补偿器,得到基于模型的鲁棒自适应控制器。
优选地,所述基于牛顿-欧拉法建立追踪器与目标器的位姿动力学方程的步骤包括:基于牛顿-欧拉法推导动力学模型,具体包括:
定义三个坐标系和向量,其中fo={Oxiyizi}是惯性坐标系,ft={Pxtytzt}是目标器的固定坐标系,原点位于特征点P,fc={Qxyz}是追踪器的固定坐标系,原点Q位于追踪器的特征点,C点和T点分别是追踪器和目标器的质心;其中, P和Q也能够位于特征点延长线的任何位置;
在追踪器坐标系fc中对位置和姿态运动进行建模,将坐标系fc下的追踪器姿态运动学统一重写为:
其中,p=[rT,σT]T;q=[vT,ωT]T;A=diag{-S(ω),O3},B=diag{I3,G(σ)};
r和v是坐标系fc的位置和速度相对于坐标系fo在坐标系fc中的描述;σ和ω是基于修正的罗德里格斯参数描述的追踪器本体系姿态和角速度;I3和 O3是三维单位矩阵和零矩阵,S(a)表示任意a∈R3的斜对称矩阵;R3表示三维空间实数集;
追踪器质心的位置矢量在坐标系fo表示为:
rc=Rc(r+l)
其中,l是从点Q到追踪器质心C的常值位置矢量,Rc是从fc到fo的旋转矩阵;
由牛顿第二定律,坐标系fo中表示的位置动力学为:
式中,m是追踪器的质量;f是追踪器的控制力;w代表干扰;
基于刚体欧拉动力学方程,追踪器相对于质心C的姿态动力学为:
式中J为追踪器的惯性矩阵;τ为追踪器的控制力矩;δ为追踪器的未知干扰动力矩;
根据理论力学中的平行轴定理,追踪器相对于点Q的惯性矩阵为Jc=J+m(lTlI3-llT),从而可以得到:
Jcω=Jω+ml×ω×l=Jω-ml×l×ω
对ω求时间导数得到:
优选地,所述建立追踪器与目标器的位姿动力学方程的步骤包括:
其中,p=[rT,σT]T;q=[vT,ωT]T;A=diag{-S(ω),O3};
r和v是坐标系fc,即追踪器的本体坐标系的位置和速度相对于坐标系fo,即惯性坐标系在坐标系fc中的描述;σ和ω是追踪器本体系姿态和角速度;I3和O3是三阶单位矩阵和零矩阵,S(a)表示任意a∈R3的斜对称矩阵;f和τ是控制力和控制扭矩;w和δ是干扰力和转矩输入;
在目标器坐标系中描述不受控目标特征点的位姿运动学和动力学:
rt,vt,σt,ωt是坐标系ft,即目标器的本体坐标系相对于坐标系fo在ft中描述的位置、速度、姿态和角速度;mt和Jt是目标的质量和惯性矩阵;lt是特征点到质心的位置矢量;wt和δt有界干扰力和转矩输入。
优选地,所述根据建立的两刚体各自位姿动力学方程以及两刚体特征点间的相对位姿和相对速度,建立考虑模型不确定性的相对位姿动力学方程的步骤包括:
坐标系fc,即追踪器的本体固定坐标系中两个刚体上的特征点之间的相对姿态和相对速度表示为:
其中,re,σe,ve,ωe分别是坐标系fc中两刚体特征点间的相对位置、相对姿态、相对速度、相对角速度,其中:
R是从坐标系ft到fc的旋转矩阵,表示为:
根据建立的动力学方程以及上述两刚体特征点间的相对位姿和相对速度公式,建立考虑模型不确定性的相对位姿动力学方程。
优选地,所述相对位姿动力学方程表示为:
gej=(MejSe+Cej)(q-qe);j={0,Δ},Se=diag{S(ωe),S(ωe)},Re=diag{R,R},
m0,mΔ分别表示已知和未知部分质量,J0,JΔ分别表示已知和未知部分惯性矩阵,两个刚体的位置和姿态连续运动,使得未知的集中扰动δ满足利普希茨连续性,因此假设||δ||≤δ1和已知充分大的常数δ1>0和δ2>0。
优选地,所述根据建立的相对位姿动力学方程,设计固定时间扰动观测器的步骤包括:
固定时间扰动观测器表示为:
其中,和分别是qe和δe的估计值; 0<a1<1,0<a2<1,b1>1,b2>1,γ>δ2;m1,m2,n1和n2的选择使得A1=[-m1,1;-m2,0]和 A2=[-n1,1;-n2,0]是Hurwitz矩阵。
优选地,所述根据建立的固定时间非奇异终端滑动变量,设计非线性饱和补偿器的步骤包括:
定义固定时间非奇异终端滑动变量为:
其中,α1>0,α2>0而β=[β1,β2,…β6]T设计为:
其中,uΔ=u-u0表示执行器饱和效应;
设计非线性饱和补偿器以解决饱和效应:
优选地,所述结合建立的固定时间扰动观测器以及非线性饱和补偿器,得到基于模型的鲁棒自适应控制器的步骤包括:
考虑追踪器的执行器饱和,执行器输出u=[u1,u2,…u6]T受到以下非对称约束:
执行器输出定义为:
固定时间控制器设计为:
本发明的上述方案至少包括以下有益效果:
上述方案中,对三维空间中两刚体特征点的相对位姿建模和协调控制进行研究,通过建立两刚体特征点间的相对位姿动力学模型,提出了一种基于扰动观测器的双刚体特征点饱和固定时间相对位姿跟踪控制方法,可以实现在控制输入受限和模型不确定性条件下的目标特征点位置跟踪和姿态同步。本发明引入固定时间扰动观测器对未知有界扰动进行估计和补偿,在固定时间内观测误差收敛到零。针对执行器饱和问题,提出了一种新的固定时间饱和补偿器,将固定时间扰动观测器、固定时间饱和补偿器与非奇异终端滑模控制器相结合,在Lyapunov框架下,通过调整设计参数,严格证明了两个特征点之间的相对位置跟踪误差和姿态同步误差最终在固定时间内收敛到零的小邻域。
附图说明
图1是本发明实施例提供的双刚体特征点间饱和固定时间相对位姿跟踪控制方法的流程图;
图2是本发明实施例中两刚体相对位姿运动的场景示意图;
图3a和图3b是本发明实施例中控制器的相对位置和速度随时间变化的曲线图;
图4a和图4b是本发明实施例中控制器控制相对姿态和角速度随时间变化的曲线图;
图5a和图5b是本发明实施例中控制器控制力和力矩随时间变化的曲线图;
图6a和图6b是本发明实施例中饱和补偿器的状态随时间变化的曲线图;
图7a和图7b是本发明实施例中扰动观测器的观测状态随时间变化的曲线图。
具体实施方式
为使本发明要解决的技术问题、技术方案和优点更加清楚,下面将结合附图及具体实施例进行详细描述。
本发明的实施例提供了一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法,如图1所示,所述方法包括以下步骤:
S1、基于牛顿-欧拉法建立追踪器与目标器的位姿动力学方程;
S2、根据建立的两刚体各自位姿动力学方程以及两刚体特征点间的相对位姿和相对速度,建立考虑模型不确定性的相对位姿动力学方程;
S3、根据建立的相对位姿动力学方程,设计固定时间扰动观测器;
S4、根据建立的固定时间非奇异终端滑动变量,设计非线性饱和补偿器,以解决执行器饱和效应;
S5、结合建立的固定时间扰动观测器以及非线性饱和补偿器,得到基于模型的鲁棒自适应控制器。
本发明实施例所述的对三维空间中两刚体特征点的相对位姿建模和协调控制进行研究,通过建立两刚体特征点间的相对位姿动力学模型,提出了一种基于扰动观测器的双刚体特征点饱和固定时间相对位姿跟踪控制方法,可以实现在控制输入受限和模型不确定性条件下的目标特征点位置跟踪和姿态同步。引入固定时间扰动观测器对未知有界扰动进行估计和补偿,在固定时间内观测误差收敛到零。针对执行器饱和问题,提出了一种新的固定时间饱和补偿器,将固定时间扰动观测器、固定时间饱和补偿器与非奇异终端滑模控制器相结合,在Lyapunov框架下,通过调整设计参数,严格证明了两个特征点之间的相对位置跟踪误差和姿态同步误差最终在固定时间内收敛到零的小邻域。
为了更好地理解本发明实施例提供的基于扰动观测器的双刚体特征点饱和固定时间相对位姿跟踪控制方法,对其进行详细说明,具体可以包括以下步骤:
S1、基于牛顿-欧拉法建立追踪器与目标器的位姿动力学方程。
基于牛顿-欧拉法推导动力学模型,具体包括:
如图2所示,定义三个坐标系和向量,其中fo={Oxiyizi}是惯性坐标系, ft={Pxtytzt}是目标器的固定坐标系,原点位于特征点P,fc={Qxyz}是追踪器的固定坐标系,原点Q位于追踪器的特征点,C点和T点分别是追踪器和目标器的质心;其中,P和Q也能够位于特征点延长线的任何位置;
在追踪器坐标系fc中对位置和姿态运动进行建模,将坐标系fc下的追踪器姿态运动学统一重写为:
其中,p=[rT,σT]T;q=[vT,ωT]T;A=diag{-S(ω),O3},B=diag{I3,G(σ)};
r和v是坐标系fc的位置和速度相对于坐标系fo在坐标系fc中的描述;σ和ω是基于修正的罗德里格斯参数描述的追踪器本体系姿态和角速度;I3和 O3是三维单位矩阵和零矩阵,S(a)表示任意a∈R3的斜对称矩阵;R3表示三维空间实数集;
追踪器质心的位置矢量在坐标系fo表示为:
rc=Rc(r+l) (2)
其中,l是从点Q到追踪器质心C的常值位置矢量,Rc是从fc到fo的旋转矩阵;
由牛顿第二定律,坐标系fo中表示的位置动力学为:
式中,m是追踪器的质量;f是追踪器的控制力;w代表干扰;
对(2)中的rc在坐标系fc中求两次时间导数得到:
将(4)代入(3)可得到点Q的位置动力学为:
基于刚体欧拉动力学方程,追踪器相对于质心C的姿态动力学为:
式中J为追踪器的惯性矩阵;τ为追踪器的控制力矩;δ为追踪器的未知干扰动力矩;
根据理论力学中的平行轴定理,追踪器相对于点Q的惯性矩阵为 Jc=J+m(lTlI3-llT),从而可以得到:
Jcω=Jω+ml×ω×l=Jω-ml×l×ω (7)
对(7)中ω求时间导数得到:
再由(5)得出:
将(9)代入(8)得到:
将(7)和(10)代入(6)得到:
将(11)代入(6)得到:
将(7)和(8)代入(12)得到在坐标系fc中所表示的追踪器特征点的姿态动力学为:
进一步地,建立追踪器与目标器的位姿动力学方程的步骤包括:
由(5)和(13)得到在追踪器的本体固定坐标系中表示的位姿运动学方程:
其中,p=[rT,σT]T;q=[vT,ωT]T;A=diag{-S(ω),O3};
r和v是坐标系fc,即追踪器的本体坐标系的位置和速度相对于坐标系 fo,即惯性坐标系在坐标系fc中的描述;σ和ω是追踪器本体系姿态和角速度;I3和O3是三阶单位矩阵和零矩阵,S(a)表示任意a∈R3的斜对称矩阵;f和τ是控制力和控制扭矩;w和δ是干扰力和转矩输入;
在目标器坐标系中描述不受控目标特征点的位姿运动学和动力学:
rt,vt,σt,ωt是坐标系ft,即目标器的本体坐标系相对于坐标系fo在ft中描述的位置、速度、姿态和角速度;mt和Jt是目标的质量和惯性矩阵;lt是特征点到质心的位置矢量;wt和δt有界干扰力和转矩输入。
S2、根据建立的两刚体各自位姿动力学方程以及两刚体特征点间的相对位姿和相对速度,建立考虑模型不确定性的相对位姿动力学方程。
坐标系fc,即追踪器的本体固定坐标系中两个刚体上的特征点之间的相对姿态和相对速度表示为:
其中,re,σe,ve,ωe分别是坐标系fc中两刚体特征点间的相对位置、相对姿态、相对速度、相对角速度,其中:
R是从坐标系ft到fc的旋转矩阵,表示为:
根据建立的动力学方程以及上述两刚体特征点间的相对位姿和相对速度公式(16),建立考虑模型不确定性的相对位姿动力学方程。
考虑模型不确定性的相对位姿动力学方程为:
gej=(MejSe+Cej)(q-qe);j={0,Δ},Se=diag{S(ωe),S(ωe)},Re=diag{R,R},
m0,mΔ分别表示已知和未知部分质量,J0,JΔ分别表示已知和未知部分惯性矩阵,由于两个刚体的位置和姿态连续运动,使得未知的集中扰动δ满足利普希茨连续性,因此假设||δ||≤δ1和已知充分大的常数δ1>0和δ2>0。
本实施例中,满足假设m和J是不确定但恒定的参数,而mt和Jt是完全未知但恒定的。此外,追踪器的参数可被视为m=m0+mΔ和J=J0+JΔ,已知部分m0和J0以及未知部分mΔ和JΔ。外部扰动是未知的,但分别以和为界并且和是未知恒定的,向量l和lt是常数,但是l是已知的,lt是未知的。
S3、根据建立的相对位姿动力学方程,建立固定时间扰动观测器。
固定时间扰动观测器表示为:
其中,和分别是qe和δe的估计值; 0<a1<1,0<a2<1,b1>1,b2>1,γ>δ2;m1,m2,n1和n2的选择使得A1=[-m1,1;-m2,0]和 A2=[-n1,1;-n2,0]是Hurwitz矩阵。
为了下文系统的分析,引入定理:
根据已公开发表文献[Basin M,Yu P,Shtessel Y.Finite and fixed-timedifferentiators utilising HOSM techniques.IET Control Theory andApplications, 2017,11(8):1144–1152.]中稳定性分析过程可知当t≥T0时,观测误差和可以收敛到零,扰动观测器的收敛时间T0与初始状态无关。
S4、根据建立的固定时间非奇异终端滑动变量,设计非线性饱和补偿器。
定义固定时间非奇异终端滑动变量为:
其中,α1>0,α2>0而β=[β1,β2,…β6]T设计为:
对(19)中的s相对时间求导,得到:
将(20)代入(17)得:
其中,uΔ=u-u0表示执行器饱和效应;
设计非线性饱和补偿器以解决饱和效应:
为了下文对系统的分析,引入定理:
定理3:如果存在一个连续函数V(x)≥0,并且它的时间导数其中λ1>0,λ2>0,γ1>1和0<γ2<1。V(x)收敛到平衡点的到达时间Tr由限定。这个界限可以用一个规定的常数来设定,这个常数不依赖于初始状态x0,而只依赖于设计参数λj和γj(j=1,2)。当时,由(17)中的第一个子方程导出得:
S5、结合建立的固定时间扰动观测器以及非线性饱和补偿器,得到基于模型的鲁棒自适应控制器。
考虑追踪器的执行器饱和,执行器输出u=[u1,u2,…u6]T受到以下非对称约束:
执行器输出定义为:
固定时间控制器设计为:
接着,采用计算机数值仿真对本实施例提供的基于扰动观测器的双刚体特征点饱和固定时间相对位姿跟踪控制方法的有效性进行验证,仿真平台基于 win10x64位操作系统下的Matlab软件进行。
考虑两个航天器的物理参数分别是:
mt=5425.6(kg),m=58.2(kg)
m0=60(kg),J0=diag{35,40,40}(kgm2)
两个刚性航天器对接端口在其本体固连坐标系内表示的位置矢量分别为:
lt=[0,0.3,0]T(m),l=[0.2,0,0]T(m)
地球扁率引起的引力和摄动力以及追踪器和目标器的重力梯度力矩分别为:
对于追踪器和目标器,大气阻力、太阳辐射和第三体效应引起的外部干扰分别假设为:
wf=[1+2sin(ωot),0.8+3cos(ωot),1+4sin(ωot)]T×10-4(N),
δf=[2+4sin(ωot),1+5cos(ωot),1.5+3sin(ωot)]T×10-5(Nm),
wl=[0.5+2sin(ωott),0.5+3cos(ωott),0.5+4sin(ωott)]T×10-3(N),
δl=[1.5+4sin(ωott),1+5cos(ωott),1.5+3sin(ωott)]T×10-4(Nm),
其中,和分别是追踪器和目标器的平均轨道速度;rci和分别是向量rc=Rc(r+l)和的第i项;Rc和Rt=RRc是基于MRP 的旋转矩阵,分别表示从追踪器和目标器的本体坐标系到地心惯性坐标系;为二次纬向调和系数,μg=398600.4418(km3/s2)为地球引力常数,是地球的平均赤道半径。因此,除了控制输入外,两个航天器的外力和力矩如下:w=fg+wf,δ=τg+δf,wt=fgt+wl,δt=τgt+δl。
追踪器运动和相对运动的初始条件分别设置为:
r(0)=[1,1,1]T×7.078×108(m),v(0)=[0.2,0.3,-0.2]T(m/s),σ(0)=0,
ω(0)=0(rad/s),re(0)=[5,5,-5]T(m),ve(0)=[-0.03,-0.02,0.03]T(m/s),
σe(0)=[0.8,-0.9,0.7]T,ωe(0)=[0.02,0.02,-0.02]T
六自由度控制输入的非对称约束为:
umax=[20,20,20,3,3,3]T,umin=[15,15,15,5,5,5]T
饱和补偿器和扰动观测器的初始状态均设为0,且可调参数设置为:
仿真结果如图3a-图3b、图4a-图4b、图5a-图5b、图6a-图6b、图7a-图 7b所示,其中,如图3a-图3b所示,两航天器对接端口之间的相对位置和相对速度在30(s)内收敛到零的小邻域,稳态相对位置和相对速度误差分别小于2×10-5(m)和2×10-4(m/s)。这意味着相对平动运动控制良好,精度高,稳定性好。图4a-图4b所示,两航天器对接口之间的相对姿态和相对角速度在 20(s)内收敛到零的小邻域,稳态相对姿态和相对角速度误差分别小于5× 10-6和2×10-4(rad/s)。这意味着相对旋转同步也得到了很好的控制,具有较高的精度和较快的稳定性。图5a-图5b表明,控制力和扭矩总是受到规定的不对称限制的约束。图6a-图6b、图7a-图7b表示饱和补偿器和扰动观测器在相对运动系统中工作时具有满意的性能,其中补偿器和扰动观测误差的状态也在 30(s)内收敛到零的小邻域。通过仿真验证了所提出的控制策略的有效性。
以上所述是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明所述原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (8)
1.一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法,其特征在于,包括以下步骤:
基于牛顿-欧拉法建立追踪器与目标器的位姿动力学方程;
根据建立的两刚体各自位姿动力学方程以及两刚体特征点间的相对位姿和相对速度,建立考虑模型不确定性的相对位姿动力学方程;
根据建立的相对位姿动力学方程,设计固定时间扰动观测器;
根据建立的固定时间非奇异终端滑动变量,设计非线性饱和补偿器,以解决执行器饱和效应;
结合建立的固定时间扰动观测器以及非线性饱和补偿器,得到基于模型的鲁棒自适应控制器。
2.根据权利要求1所述的双刚体特征点间饱和固定时间相对位姿跟踪控制方法,其特征在于,所述基于牛顿-欧拉法建立追踪器与目标器的位姿动力学方程的步骤包括:基于牛顿-欧拉法推导动力学模型,具体包括:
定义三个坐标系和向量,其中fo={Oxiyizi}是惯性坐标系,ft={Pxtytzt}是目标器的固定坐标系,原点位于特征点P,fc={Qxyz}是追踪器的固定坐标系,原点Q位于追踪器的特征点,C点和T点分别是追踪器和目标器的质心;其中,P和Q也能够位于特征点延长线的任何位置;
在追踪器坐标系fc中对位置和姿态运动进行建模,将坐标系fc下的追踪器姿态运动学统一重写为:
其中,p=[rT,σT]T;q=[vT,ωT]T;A=diag{-S(ω),O3},B=diag{I3,G(σ)};
r和v是坐标系fc的位置和速度相对于坐标系fo在坐标系fc中的描述;σ和ω是基于修正的罗德里格斯参数描述的追踪器本体系姿态和角速度;I3和O3是三维单位矩阵和零矩阵,S(a)表示任意a∈R3的斜对称矩阵;R3表示三维空间实数集;
追踪器质心的位置矢量在坐标系fo表示为:
rc=Rc(r+l)
其中,l是从点Q到追踪器质心C的常值位置矢量,Rc是从fc到fo的旋转矩阵;
由牛顿第二定律,坐标系fo中表示的位置动力学为:
式中,m是追踪器的质量;f是追踪器的控制力;w代表干扰;
基于刚体欧拉动力学方程,追踪器相对于质心C的姿态动力学为:
式中J为追踪器的惯性矩阵;τ为追踪器的控制力矩;δ为追踪器的未知干扰动力矩;
根据理论力学中的平行轴定理,追踪器相对于点Q的惯性矩阵为Jc=J+m(lTlI3-llT),从而可以得到:
Jcω=Jω+ml×ω×l=Jω-ml×l×ω
对ω求时间导数得到:
3.根据权利要求2所述的双刚体特征点间饱和固定时间相对位姿跟踪控制方法,其特征在于,所述建立追踪器与目标器的位姿动力学方程的步骤包括:
其中,p=[rT,σT]T;q=[vT,ωT]T;A=diag{-S(ω),O3};
r和v是坐标系fc,即追踪器的本体坐标系的位置和速度相对于坐标系fo,即惯性坐标系在坐标系fc中的描述;σ和ω是追踪器本体系姿态和角速度;I3和O3是三阶单位矩阵和零矩阵,S(a)表示任意a∈R3的斜对称矩阵;f和τ是控制力和控制扭矩;w和δ是干扰力和转矩输入;
在目标器坐标系中描述不受控目标特征点的位姿运动学和动力学:
rt,vt,σt,ωt是坐标系ft,即目标器的本体坐标系相对于坐标系fo在ft中描述的位置、速度、姿态和角速度;mt和Jt是目标的质量和惯性矩阵;lt是特征点到质心的位置矢量;wt和δt有界干扰力和转矩输入。
5.根据权利要求4所述的双刚体特征点间饱和固定时间相对位姿跟踪控制方法,其特征在于,所述相对位姿动力学方程表示为:
gej=(MejSe+Cej)(q-qe);j={0,Δ},Se=diag{S(ωe),S(ωe)},Re=diag{R,R},
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010333570.8A CN111506095B (zh) | 2020-04-24 | 2020-04-24 | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010333570.8A CN111506095B (zh) | 2020-04-24 | 2020-04-24 | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111506095A true CN111506095A (zh) | 2020-08-07 |
CN111506095B CN111506095B (zh) | 2021-04-06 |
Family
ID=71876828
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010333570.8A Active CN111506095B (zh) | 2020-04-24 | 2020-04-24 | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111506095B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112650303A (zh) * | 2021-01-20 | 2021-04-13 | 南京航空航天大学 | 一种基于固定时间技术的无人机编队容错控制方法 |
CN113064349A (zh) * | 2021-03-22 | 2021-07-02 | 中国人民解放军国防科技大学 | 固定时间收敛的非线性平台滑模控制方法、装置及系统 |
CN113110048A (zh) * | 2021-04-13 | 2021-07-13 | 中国空气动力研究与发展中心设备设计与测试技术研究所 | 采用hosm观测器的非线性系统输出反馈自适应控制系统和方法 |
CN114019796A (zh) * | 2021-10-27 | 2022-02-08 | 黄山学院 | 一种考虑输入约束的移动机器人固定时间跟踪控制方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104950899A (zh) * | 2015-06-10 | 2015-09-30 | 北京理工大学 | 一种固定时间收敛的飞行器姿态控制方法 |
CN106707751A (zh) * | 2016-12-20 | 2017-05-24 | 哈尔滨工业大学 | 航天器终端接近的有限时间饱和避碰控制方法 |
CN109613827A (zh) * | 2018-12-29 | 2019-04-12 | 西北工业大学 | 一种相对速度未知的平动点轨道交会控制方法 |
CN110347173A (zh) * | 2019-08-21 | 2019-10-18 | 哈尔滨工业大学 | 一种基于非连续自适应控制的航天器姿态跟踪控制方法 |
CN110543183A (zh) * | 2018-09-28 | 2019-12-06 | 浙江工业大学 | 一种考虑执行器受限问题的刚体飞行器固定时间姿态跟踪控制方法 |
CN111152225A (zh) * | 2020-01-15 | 2020-05-15 | 北京科技大学 | 存在输入饱和的不确定机械臂固定时间轨迹跟踪控制方法 |
CN111413995A (zh) * | 2020-03-24 | 2020-07-14 | 北京科技大学 | 双刚体特征点间相对位置跟踪与姿态同步控制方法及系统 |
-
2020
- 2020-04-24 CN CN202010333570.8A patent/CN111506095B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104950899A (zh) * | 2015-06-10 | 2015-09-30 | 北京理工大学 | 一种固定时间收敛的飞行器姿态控制方法 |
CN106707751A (zh) * | 2016-12-20 | 2017-05-24 | 哈尔滨工业大学 | 航天器终端接近的有限时间饱和避碰控制方法 |
CN110543183A (zh) * | 2018-09-28 | 2019-12-06 | 浙江工业大学 | 一种考虑执行器受限问题的刚体飞行器固定时间姿态跟踪控制方法 |
CN109613827A (zh) * | 2018-12-29 | 2019-04-12 | 西北工业大学 | 一种相对速度未知的平动点轨道交会控制方法 |
CN110347173A (zh) * | 2019-08-21 | 2019-10-18 | 哈尔滨工业大学 | 一种基于非连续自适应控制的航天器姿态跟踪控制方法 |
CN111152225A (zh) * | 2020-01-15 | 2020-05-15 | 北京科技大学 | 存在输入饱和的不确定机械臂固定时间轨迹跟踪控制方法 |
CN111413995A (zh) * | 2020-03-24 | 2020-07-14 | 北京科技大学 | 双刚体特征点间相对位置跟踪与姿态同步控制方法及系统 |
Non-Patent Citations (6)
Title |
---|
KEWEI XIA,WEI HUO: "Adaptive control for spacecraft rendezvous subject to actuator faults and saturations", 《ISA TRANSACTIONS》 * |
LIANG SUN,WEI HUO,ZONGXIA JIAO;: "Adaptive nonlinear robust relative pose control of spacecraft autonomous rendezvous and proximity operations", 《ISA TRANSACTIONS》 * |
QINGLEI HU,XIAODONG SHAO: "Smooth finite-time fault-tolerant attitude tracking control for rigid spacecraft", 《AEROSPACE SCIENCE AND TECHNOLOGY》 * |
董经纬: "基于终端滑模的航天器交会相对位置和姿态控制研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
邬树楠,吴国强,孙兆伟: "接近非合作目标的航天器相对轨道有限时间控制", 《大连理工大学学报》 * |
黄成: "航天器交会对接有限时间控制方法研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112650303A (zh) * | 2021-01-20 | 2021-04-13 | 南京航空航天大学 | 一种基于固定时间技术的无人机编队容错控制方法 |
CN113064349A (zh) * | 2021-03-22 | 2021-07-02 | 中国人民解放军国防科技大学 | 固定时间收敛的非线性平台滑模控制方法、装置及系统 |
CN113110048A (zh) * | 2021-04-13 | 2021-07-13 | 中国空气动力研究与发展中心设备设计与测试技术研究所 | 采用hosm观测器的非线性系统输出反馈自适应控制系统和方法 |
CN114019796A (zh) * | 2021-10-27 | 2022-02-08 | 黄山学院 | 一种考虑输入约束的移动机器人固定时间跟踪控制方法 |
CN114019796B (zh) * | 2021-10-27 | 2023-03-10 | 黄山学院 | 一种考虑输入约束的移动机器人固定时间跟踪控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111506095B (zh) | 2021-04-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111506095B (zh) | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 | |
Zheng et al. | Trajectory tracking control for a marine surface vessel with asymmetric saturation actuators | |
CN109189085B (zh) | 基于事件触发的航天器网络化系统姿态控制方法 | |
CN105159304B (zh) | 接近并跟踪空间非合作目标的有限时间容错控制方法 | |
CN110347170B (zh) | 可重复使用运载器再入段鲁棒容错制导控制系统及工作方法 | |
CN105353763B (zh) | 一种非合作目标航天器相对轨道姿态有限时间控制方法 | |
CN106970530B (zh) | 空间非合作目标自主视线交会的无模型预设性能控制方法 | |
Jiang et al. | An adaptive backstepping sliding mode method for flight attitude of quadrotor UAVs | |
CN114047773A (zh) | 一种基于扩张状态观测器的水下集矿机器人反步滑模自适应姿态控制方法 | |
CN106707749B (zh) | 一种针对仿生扑翼飞行机器人的控制方法 | |
Zhang et al. | Adaptive control on SE (3) for spacecraft pose tracking with harmonic disturbance and input saturation | |
Sun et al. | Adaptive relative pose control of spacecraft with model couplings and uncertainties | |
CN112965371A (zh) | 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法 | |
Giglio et al. | Selective compliance control for an unmanned aerial vehicle with a robotic arm | |
CN115480583B (zh) | 飞行作业机器人的视觉伺服跟踪与阻抗控制方法 | |
CN116142490A (zh) | 复杂约束下基于势函数的航天器姿态重定向控制方法 | |
CN108181806A (zh) | 基于采样输出的空间机器人位置与姿态自抗扰控制方法 | |
Zhao et al. | Minimum base disturbance control of free-floating space robot during visual servoing pre-capturing process | |
CN115366109A (zh) | 一种旋翼飞行机械臂复合分层抗干扰方法 | |
Qin et al. | Fuzzy adaptive robust control for space robot considering the effect of the gravity | |
CN112904872A (zh) | 基于扰动逼近的底栖式auv固定时间快速轨迹跟踪控制方法 | |
CN112327892A (zh) | 一种auv误差受限的抗扰控制方法 | |
Wu et al. | Neuroadaptive output-feedback trajectory tracking control for a stratospheric airship with prescribed performance | |
CN117055593A (zh) | 一种旋翼无人机避障滑模容错控制方法 | |
CN114671050B (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 |