CN115933725A - 一种刚柔液耦合航天器高精度姿态控制方法 - Google Patents
一种刚柔液耦合航天器高精度姿态控制方法 Download PDFInfo
- Publication number
- CN115933725A CN115933725A CN202310072294.8A CN202310072294A CN115933725A CN 115933725 A CN115933725 A CN 115933725A CN 202310072294 A CN202310072294 A CN 202310072294A CN 115933725 A CN115933725 A CN 115933725A
- Authority
- CN
- China
- Prior art keywords
- rigid
- spacecraft
- flexible liquid
- flexible
- liquid
- 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
- 239000007788 liquid Substances 0.000 title claims abstract description 180
- 230000008878 coupling Effects 0.000 title claims abstract description 101
- 238000010168 coupling process Methods 0.000 title claims abstract description 101
- 238000005859 coupling reaction Methods 0.000 title claims abstract description 101
- 238000000034 method Methods 0.000 title claims abstract description 36
- 230000003044 adaptive effect Effects 0.000 claims abstract description 41
- 238000004088 simulation Methods 0.000 claims abstract description 11
- 239000011159 matrix material Substances 0.000 claims description 36
- 230000014509 gene expression Effects 0.000 claims description 12
- 238000013461 design Methods 0.000 claims description 11
- 238000013016 damping Methods 0.000 claims description 9
- 239000000446 fuel Substances 0.000 claims description 5
- 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 claims description 3
- 239000013589 supplement Substances 0.000 claims description 2
- 238000011160 research Methods 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001502 supplementing effect Effects 0.000 description 1
Images
Classifications
-
- 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
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种刚柔液耦合航天器高精度姿态控制方法,包括建立刚柔液耦合航天器面向控制模型、设计反切函数面、设计自适应补偿控制器和本方法有效性的验证,本发明采用上述刚柔液耦合航天器高精度姿态控制方法,为实现耦合航天器高精度姿态控制,首先设计比终端滑模面收敛更快的反正切函数面,保证耦合航天器姿态快速控制;其次,设计标称控制器,保证耦合航天器高精度姿态控制;接着,考虑综合不确定的影响,在标称控制器的基础上,设计补偿控制器估计综合不确定,实现了耦合航天器高精度姿态控制,并通过仿真验证了系统控制性能。
Description
技术领域
本发明涉及航天器姿态控制技术领域,尤其是涉及一种刚柔液耦合航天器高精度姿态控制方法。
背景技术
航天器又称空间飞行器,是指在稠密大气层外环绕地球或行星际空间,按照天体力学规律运行的飞行器。近年来,随着空间技术不断发展与航天任务愈加复杂,航天器结构日益复杂,同时受发射成本及运载能力的限制,航天器挠性越来越大。为完成长时间在轨运行目标,航天器需要携带越来越多的液体燃料,这会进一步破坏航天器系统稳定性。此外,航天器在运行过程中还会受到空间环境干扰力矩的影响,包括重力梯度力矩、太阳光压力矩、大气阻力力矩以及地磁力矩等,进一步影响航天器姿态控制精度。因此,研究与之相关的科学问题具有战略性及带动性,能够节省燃料消耗、提高航天器在轨运行能力提供新思路。
在刚柔液航天器姿态控制方面,国内外学者已进行了相关探索与研究,并取得了丰富的成果,目前主要存在以下不足:(1)在航天器姿态控制过程中,分别设计干扰观测器与姿态跟踪控制,使得整个闭环系统的稳定性不能得到保证;(2)在航天器姿态控制过程中,考虑刚柔液耦合航天器或刚液航天器姿态控制较多,同时考虑柔性振动与液体晃动的较少,通常会忽略刚体、柔性振动及液体晃动之间耦合的影响,使得建立动力学模型与实际动力学模型之间有偏差;(3)现有技术中通常假设外界干扰上界与柔性振动、液体晃动已知,但是在航天器实际运行过程中,由于太空环境的未知性、航天器刚体与柔性振动相互耦合,则该假设不严谨,使得航天器姿态控制的精度不佳。因此,考虑模型不确定、外界干扰、柔性振动与液体晃动的情况,设计一个快速高精度姿态控制器,对航天器安全平稳运行具有重要的理论意义及工程价值。
发明内容
本发明的目的是提供一种刚柔液耦合航天器高精度姿态控制方法,用以解决柔性振动、液体晃动和外界干扰等综合不确定因素影响刚柔液耦合航天器姿态控制作用时间和精度的问题。
为实现上述目的,本发明提供了如下技术方案:
一种刚柔液耦合航天器高精度姿态控制方法,包括以下步骤:
步骤1,建立刚柔液耦合航天器面向控制模型:考虑柔性振动、液体晃动的影响建立模型不确定与外界干扰影响下的刚柔液耦合航天器非线性运动学模型与动力学模型,为进一步实现刚柔液耦合航天器姿态控制提供理论基础;刚柔液耦合航天器姿态运动学与动力学模型表达式为:刚柔液耦合航天器姿态运动学与动力学模型表达式为:
其中,q=[q0 qv T]=[q0 q1 q2 q3]T刚柔液耦合航天器姿态四元数,q0,qv分别为单位四元数的标量及向量部分;ω=[ω1 ω2 ω3]T为刚柔液耦合航天器角速度;J=J0+ΔJ∈R3×3为刚柔液耦合航天器的转动惯量矩阵;I3为三阶单位矩阵,是斜对角矩阵并满足
u∈R3为控制输入力矩,d∈R3为外界干扰力矩;χ与η分别为柔性振动模态值与晃动液体模态值,δf∈R3×3为刚体与柔性振动耦合矩阵,d∈R3为外界干扰力矩,Cf=diag{2ξiΩi,i=1,2,...,N}为柔性附件的阻尼矩阵,为刚度矩阵,Ωi与ξi分别为第i阶振动模态的频率与阻尼,Mη=[ml1 ml1 ml2 ml2]T为晃动液体质量矩阵,mli为第i阶液体晃动模态晃动液体的质量,Cl=[ci1 ci1 ci2 ci2]T与Kl=[kl1 kl1 kl2 kl2]T分别为晃动液体柔性矩阵与晃动液体刚度矩阵,Ml为液体晃动补充力矩,刚液耦合矩阵为:
为实现刚柔液耦合航天器综合不确定部分有效估计,上述刚柔液耦合航天器运动学模型与动力学模型可以进一步转化为如下刚柔液耦合航天器面向控制模型:
步骤2,设计反正切函数面:基于刚柔液耦合航天器姿态四元数与角速度,设计反正切函数面,实现到达反正切函数面后航天器姿态四元数与角速度快速收敛,反正切函数面的表达式为:
步骤3,设计自适应补偿控制器:基于耦合航天器标称模型,设计标称控制器,进一步地考虑柔性振动、液体燃料晃动与外界干扰等综合不确定的影响,设计基于积分滑模的自适应补偿控制器,进行稳定性分析,实现在综合不确定影响下刚柔液耦合航天器快速高精度姿态控制,具体如下两个部分:
1)设计标称控制器
为避免滑模面奇异性问题,基于步骤2中的反正切函数面(5),针对步骤1中的刚柔液耦合航天器面向控制模型(3)-(4),设计如下非奇异反正切函数面:
s=ω+k1γ(qv) (6)
其中,s=[s1 s2 s3]T,非奇异部分γ(qv)=[γ(q1) γ(q2) γ(q3)]T设计如下:
针对刚柔液耦合航天器面向控制模型(3)-(4),基于非奇异反正切函数面(6),设计如下标称控制器:
2)设计基于积分滑模的自适应补偿控制器
针对刚柔液耦合航天器面向控制模型中的动力学模型(4),设计如下积分滑模面:
其中,ω(0)为角速度初值;
由式(9)可得积分滑模面sb的导数为:
ueq=ua-D (11)
将式(11)代入刚柔液耦合航天器面向控制模型中的动力学模型(4)可得:
由式(9)-(12)可知,当加入控制器后可以使得积分滑模面收敛,则耦合航天器实现在干扰情况下的姿态控制,因此,以下设计自适应补偿控制器,能够使积分滑模面在加入自适应补偿控制器后在有限时间收敛,自适应补偿控制器的设计如下:
针对刚柔液耦合航天器姿态模型(3)-(4),设计如下控制器:
u=ua+ub (13)
自适应补偿控制器设计为:
ρ(t)=α0(t)+α1(t)||ω||+α2(t)||ω||2 (14)
其中,0<r0<1,自适应增益αi(t)为:
步骤4,验证本方法的有效性:首先将刚柔液耦合航天器控制系统在Matlab/Simulink中进行集成设计,然后进行仿真实验,其中仿真过程主要包括刚柔液耦合航天器物理参数设置、控制器参数设置和结果分析。
优选的,步骤4中的刚柔液耦合航天器物理参数设置包括:
刚柔液耦合航天器实际转动惯量及其标称值分别为:
刚柔液耦合航天器前三阶振动模态的频率与阻尼分别为:Ω1=0.7681rad/s,Ω2=1.1038rad/s,Ω3=1.8733rad/s,ξ1=0.0056,ξ2=0.0086,ξ3=0.0013;
前四阶液体晃动模态矩阵为:Cl=diag(3.334,3.334,0.237,0.237);
刚度矩阵为Kl=diag(55.21,55.21,7.27,7.27);
晃动液体质量为m1=20kg,m2=0.8kg,b1=1.127m,b2=0.994m;
刚柔液耦合航天器姿态四元数及角速度初值分别为:
q(0)=[0.8832 0.3 -0.2 -0.3]T,ω(0)=[0 0 0]Trad/s;
刚柔液耦合航天器姿态四元数及角速度期望值分别为:
qd(0)=[1 0 0 0]T,ωd=[0.1 0 0]Trad/s;
刚柔液耦合航天器干扰力矩采用正弦函数形式给定,具体如下:
d=[0.7sin(0.2t) -0.7cos(0.1t) 0.7sin(0.1t)]TN·m。
优选的,步骤4中的控制器参数设置包括:k1=0.2,k2=1.5575,Θ=0.00001,a1=0.01,a2=0.01,σ1=80,σ2=3.5,ξ1=200,ξ2=100,ξ3=100,ζ1=0.5,ζ2=0.1,ζ3=0.1,l=0.001,r0=0.3。
优选的,步骤4中的结果分析包括两种情况下的仿真:情形1,终端滑模面(TSM)与反正切函数面(AF)对比;情形2,积分滑模控制器(ISM)与自适应补偿控制器(CISM)对比。
本发明采用上述结构的刚柔液耦合航天器高精度姿态控制方法,针对刚柔液耦合航天器姿态控制问题,首先设计比终端滑模面收敛更快的反正切函数面,保证刚柔液耦合航天器姿态快速控制;其次,忽略柔性振动、液体晃动与外界干扰等综合不确定的影响,设计标称控制器,保证刚柔液耦合航天器快速姿态控制;接着,考虑综合不确定的影响,在标称控制器的基础上,设计自适应补偿控制器,实现刚柔液耦合航天器快速高精度姿态控制。
附图说明
图1为本发明一种刚柔液耦合航天器高精度姿态控制方法的实施例的示意图;
图2为TSM与AF两种函数面作用下基于自适应补偿控制器的刚柔液耦合航天器姿态四元数对比曲线;
图3为TSM与AF两种函数面作用下基于自适应补偿控制器的刚柔液耦合航天器角速度对比曲线;
图4为TSM与AF两种函数面作用下基于自适应补偿控制器的刚柔液耦合航天器控制力矩对比曲线
图5为在控制输入ISM作用下刚柔液耦合航天器的姿态四元数曲线;
图6为在控制输入CISM作用下刚柔液耦合航天器的姿态四元数曲线;
图7为在控制输入ISM作用下刚柔液耦合航天器的角速度曲线;
图8为在控制输入CISM作用下刚柔液耦合航天器的角速度曲线;
图9为在控制输入ISM作用下刚柔液耦合航天器的控制力矩;
图10为在控制输入CISM作用下刚柔液耦合航天器的控制力矩;
图11为在控制输入CISM作用下刚柔液耦合航天器自适应补偿控制器控制力矩变化曲线;
图12为在控制输入CISM作用下刚柔液耦合航天器自适应补偿控制器自适应参数变化曲线。
具体实施方式
以下结合附图和实施例对本发明的技术方案作进一步说明。
如图所示的一种刚柔液耦合航天器高精度姿态控制方法,包括以下步骤:
步骤1,建立刚柔液耦合航天器面向控制模型:考虑柔性振动、液体晃动的影响建立模型不确定与外界干扰影响下的刚柔液耦合航天器非线性运动学模型与动力学模型,为进一步实现刚柔液耦合航天器姿态控制提供理论基础;刚柔液耦合航天器姿态运动学与动力学模型表达式为:刚柔液耦合航天器姿态运动学与动力学模型表达式为:
其中,刚柔液耦合航天器姿态四元数,q0,qv分别为单位四元数的标量及向量部分;ω=[ω1 ω2 ω3]T为刚柔液耦合航天器角速度;J=J0+ΔJ∈R3×3为刚柔液耦合航天器的转动惯量矩阵;I3为三阶单位矩阵,是斜对角矩阵并满足
u∈R3为控制输入力矩,d∈R3为外界干扰力矩;χ与η分别为柔性振动模态值与晃动液体模态值,δf∈R3×3为刚体与柔性振动耦合矩阵,d∈R3为外界干扰力矩,Cf=diag{2ξiΩi,i=1,2,...,N}为柔性附件的阻尼矩阵,为刚度矩阵,Ωi与ξi分别为第i阶振动模态的频率与阻尼,Mη=[ml1 ml1 ml2 ml2]T为晃动液体质量矩阵,mli为第i阶液体晃动模态晃动液体的质量,Cl=[ci1 ci1 ci2 ci2]T与Kl=[kl1 kl1 kl2 kl2]T分别为晃动液体柔性矩阵与晃动液体刚度矩阵,Ml为液体晃动补充力矩,刚液耦合矩阵为:
为实现刚柔液耦合航天器综合不确定部分有效估计,上述刚柔液耦合航天器运动学模型与动力学模型可以进一步转化为如下刚柔液耦合航天器面向控制模型:
步骤2,设计反正切函数面:基于刚柔液耦合航天器姿态四元数与角速度,设计反正切函数面,实现到达反正切函数面后航天器姿态四元数与角速度快速收敛,反正切函数面的表达式为:
步骤3,设计自适应补偿控制器:基于耦合航天器标称模型,设计标称控制器,进一步地考虑柔性振动、液体燃料晃动与外界干扰等综合不确定的影响,设计基于积分滑模的自适应补偿控制器,进行稳定性分析,实现在综合不确定影响下刚柔液耦合航天器快速高精度姿态控制,具体如下两个部分:
1)设计标称控制器
为避免滑模面奇异性问题,基于步骤2中的反正切函数面(5),针对步骤1中的刚柔液耦合航天器面向控制模型(3)-(4),设计如下非奇异反正切函数面:
s=ω+k1γ(qv) (6)
其中,s=[s1 s2 s3]T,非奇异部分γ(qv)=[γ(q1) γ(q2) γ(q3)]T设计如下:
针对刚柔液耦合航天器面向控制模型(3)-(4),基于非奇异反正切函数面(6),设计如下标称控制器:
2)设计基于积分滑模的自适应补偿控制器
针对刚柔液耦合航天器面向控制模型中的动力学模型(4),设计如下积分滑模面:
其中,ω(0)为角速度初值;
由式(9)可得积分滑模面sb的导数为:
ueq=ua-D (11)
将式(11)代入刚柔液耦合航天器面向控制模型中的动力学模型(4)可得:
由式(9)-(12)可知,当加入控制器后可以使得积分滑模面收敛,则耦合航天器实现在干扰情况下的姿态控制,因此,以下设计自适应补偿控制器,能够使积分滑模面在加入自适应补偿控制器后在有限时间收敛,自适应补偿控制器的设计如下:
针对刚柔液耦合航天器姿态模型(3)-(4),设计如下控制器:
u=ua+ub (13)
自适应补偿控制器设计为:
其中,0<r0<1,自适应增益αi(t)为:
步骤4,验证本方法的有效性:首先将刚柔液耦合航天器控制系统在Matlab/Simulink中进行集成设计,然后进行仿真实验,其中仿真过程主要包括刚柔液耦合航天器物理参数设置、控制器参数设置和结果分析,具体如下:
1)刚柔液耦合航天器物理参数设置包括:
刚柔液耦合航天器实际转动惯量及其标称值分别为:
刚柔液耦合航天器前三阶振动模态的频率与阻尼分别为:Ω1=0.7681rad/s,Ω2=1.1038rad/s,Ω3=1.8733rad/s,ξ1=0.0056,ξ2=0.0086,ξ3=0.0013;
前四阶液体晃动模态矩阵为:Cl=diag(3.334,3.334,0.237,0.237);
刚度矩阵为Kl=diag(55.21,55.21,7.27,7.27);
晃动液体质量为m1=20kg,m2=0.8kg,b1=1.127m,b2=0.994m;
刚柔液耦合航天器姿态四元数及角速度初值分别为:
q(0)=[0.8832 0.3 -0.2 -0.3]T,ω(0)=[0 0 0]Trad/s;
刚柔液耦合航天器姿态四元数及角速度期望值分别为:
qd(0)=[1 0 0 0]T,ωd=[0.1 0 0]Trad/s;
刚柔液耦合航天器干扰力矩采用正弦函数形式给定,具体如下:
d=[0.7sin(0.2t) -0.7cos(0.1t) 0.7sin(0.1t)]TN·m。
2)控制器参数设置包括:k1=0.2,k2=1.5575,Θ=0.00001,a1=0.01,a2=0.01,σ1=80,σ2=3.5,ξ1=200,ξ2=100,ξ3=100,ζ1=0.5,ζ2=0.1,ζ3=0.1,l=0.001,r0=0.3。
3)结果分析包括两种情况下的仿真:情形1,终端滑模面(TSM)与反正切函数面(AF)对比;情形2,积分滑模控制器(ISM)与自适应补偿控制器(CISM)对比。
情形1的仿真结果如图2-图4所示,其中,由图2与图3可知,在上述两种不同函数面作用下,刚柔液耦合航天器姿态四元数与角速度均可在有限时间收敛,AF比TSM收敛速度更快。因此,采用设计AF更适用于刚柔液耦合航天器快速姿态控制。由图4可知,本文提出的自适应补偿控制器是连续的,且大小适宜,符合工程实际,当加入自适应补偿控制器时,前20s控制力矩较大,在20s后,控制力矩较小,主要由自适应补偿控制器组成,用于估计并补偿综合不确定,减少综合不确定对姿态控制精度的影响,提高刚柔液耦合航天器姿态控制精度。
由图5到图8可知,当加入ISM与CISM时,均可实现刚柔液耦合航天器姿态控制,当加入设计ISM时姿态四元数与角速度控制精度分别为2×10-5与2×10-5rad/s,当加入设计CISM时姿态四元数与角速度控制精度提高到1×10-7与3×10-7rad/s。当加入设计自适应补偿控制器后,对综合不确定进行了有效估计,减少了对姿态控制精度的影响,提高姿态控制精度。
由图9到图10可知,相对于控制输入ISM,CISM控制器控制力矩较小,此外,控制输入一直有波动,这是由于刚柔液耦合航天器控制力矩不仅要实现姿态控制,同时需要补偿柔性振动、液体晃动、外界干扰等综合不确定带来的影响。
由图11可知,当加入设计自适应补偿控制器时,可以实现综合干扰有效估计,在2s左右可以实现对综合不确定有效估计,可以减少柔性振动等综合不确定对姿态控制精度的影响,提高刚柔液耦合航天器姿态控制精度,与刚柔液耦合航天器姿态控制图2与图3相对应。由图12可知,当跟踪误差较大时,自适应增益较大,反之亦然。
因此,本发明采用上述刚柔液耦合航天器高精度姿态控制方法,解决了柔性振动、液体晃动和外界干扰等综合不确定因素影响刚柔液耦合航天器姿态控制作用时间和精度的问题。
以上是本发明的具体实施方式,但本发明的保护范围不应局限于此。任何熟悉本领域的技术人员在本发明所揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内,因此本发明的保护范围应以权利要求书所限定的保护范围为准。
Claims (4)
1.一种刚柔液耦合航天器高精度姿态控制方法,其特征在于:包括以下步骤:
步骤1,建立刚柔液耦合航天器面向控制模型:考虑柔性振动、液体晃动的影响建立模型不确定与外界干扰影响下的刚柔液耦合航天器非线性运动学模型与动力学模型,为进一步实现刚柔液耦合航天器姿态控制提供理论基础;刚柔液耦合航天器姿态运动学与动力学模型表达式为:刚柔液耦合航天器姿态运动学与动力学模型表达式为:
其中,刚柔液耦合航天器姿态四元数,q0,qv分别为单位四元数的标量及向量部分;ω=[ω1ω2ω3]T为刚柔液耦合航天器角速度;J=J0+ΔJ∈R3×3为刚柔液耦合航天器的转动惯量矩阵;I3为三阶单位矩阵,是斜对角矩阵并满足
u∈R3为控制输入力矩,d∈R3为外界干扰力矩;χ与η分别为柔性振动模态值与晃动液体模态值,δf∈R3×3为刚体与柔性振动耦合矩阵,d∈R3为外界干扰力矩,Cf=diag{2ξiΩi,i=1,2,...,N}为柔性附件的阻尼矩阵,为刚度矩阵,Ωi与ξi分别为第i阶振动模态的频率与阻尼,Mη=[ml1 ml1 ml2 ml2]T为晃动液体质量矩阵,mli为第i阶液体晃动模态晃动液体的质量,Cl=[ci1 ci1 ci2 ci2]T与Kl=[kl1 kl1 kl2 kl2]T分别为晃动液体柔性矩阵与晃动液体刚度矩阵,Ml为液体晃动补充力矩,刚液耦合矩阵为:
为实现刚柔液耦合航天器综合不确定部分有效估计,上述刚柔液耦合航天器运动学模型与动力学模型可以进一步转化为如下刚柔液耦合航天器面向控制模型:
步骤2,设计反正切函数面:基于刚柔液耦合航天器姿态四元数与角速度,设计反正切函数面,实现到达反正切函数面后航天器姿态四元数与角速度快速收敛,反正切函数面的表达式为:
sA= ω+k0arctan(k2qv)r1 (5)
步骤3,设计自适应补偿控制器:基于耦合航天器标称模型,设计标称控制器,进一步地考虑柔性振动、液体燃料晃动与外界干扰等综合不确定的影响,设计基于积分滑模的自适应补偿控制器,进行稳定性分析,实现在综合不确定影响下刚柔液耦合航天器快速高精度姿态控制,具体如下两个部分:
1)设计标称控制器
为避免滑模面奇异性问题,基于步骤2中的反正切函数面(5),针对步骤1中的刚柔液耦合航天器面向控制模型(3)-(4),设计如下非奇异反正切函数面:
s=ω+k1γ(qv) (6)
其中,s=[s1 s2 s3]T,非奇异部分γ(qv)=[γ(q1)γ(q2)γ(q3)]T设计如下:
针对刚柔液耦合航天器面向控制模型(3)-(4),基于非奇异反正切函数面(6),设计如下标称控制器:
2)设计基于积分滑模的自适应补偿控制器
针对刚柔液耦合航天器面向控制模型中的动力学模型(4),设计如下积分滑模面:
其中,ω(0)为角速度初值;
由式(9)可得积分滑模面sb的导数为:
ueq=ua-D (11)
将式(11)代入刚柔液耦合航天器面向控制模型中的动力学模型(4)可得:
由式(9)-(12)可知,当加入控制器后可以使得积分滑模面收敛,则耦合航天器实现在干扰情况下的姿态控制,因此,以下设计自适应补偿控制器,能够使积分滑模面在加入自适应补偿控制器后在有限时间收敛,自适应补偿控制器的设计如下:
针对刚柔液耦合航天器姿态模型(3)-(4),设计如下控制器:
u=ua+ub (13)
自适应补偿控制器设计为:
ρ(t)=α0(t)+α1(t)||ω||+α2(t)||ω||2 (14)
其中,0<r0<1,自适应增益αi(t)为:
步骤4,验证本方法的有效性:首先将刚柔液耦合航天器控制系统在Matlab/Simulink中进行集成设计,然后进行仿真实验,其中仿真过程主要包括刚柔液耦合航天器物理参数设置、控制器参数设置和结果分析。
2.根据权利要求1所述的一种刚柔液耦合航天器高精度姿态控制方法,其特征在于:步骤4中的刚柔液耦合航天器物理参数设置包括:
刚柔液耦合航天器实际转动惯量及其标称值分别为:
刚柔液耦合航天器前三阶振动模态的频率与阻尼分别为:Ω1=0.7681rad/s,Ω2=1.1038rad/s,Ω3=1.8733rad/s,ξ1=0.0056,ξ2=0.0086,ξ3=0.0013;
前四阶液体晃动模态矩阵为:Cl=diag(3.334,3.334,0.237,0.237);
刚度矩阵为Kl=diag(55.21,55.21,7.27,7.27);
晃动液体质量为m1=20kg,m2=0.8kg,b1=1.127m,b2=0.994m;
刚柔液耦合航天器姿态四元数及角速度初值分别为:
q(0)=[0.8832 0.3 -0.2 -0.3]T,ω(0)=[0 0 0]Trad/s;
刚柔液耦合航天器姿态四元数及角速度期望值分别为:
qd(0)=[1 0 0 0]T,ωd=[0.1 0 0]Trad/s;
刚柔液耦合航天器干扰力矩采用正弦函数形式给定,具体如下:
d=[0.7sin(0.2t) -0.7cos(0.1t) 0.7sin(0.1t)]TN·m。
3.根据权利要求2所述的一种刚柔液耦合航天器高精度姿态控制方法,其特征在于:步骤4中的控制器参数设置包括:k1=0.2,k2=1.5575,Θ=0.00001,a1=0.01,a2=0.01,σ1=80,σ2=3.5,ξ1=200,ξ2=100,ξ3=100,ζ1=0.5,ζ2=0.1,ζ3=0.1,l=0.001,r0=0.3。
4.根据权利要求3所述的一种刚柔液耦合航天器高精度姿态控制方法,其特征在于:步骤4中的结果分析包括两种情况下的仿真:情形1,终端滑模面(TSM)与反正切函数面(AF)对比;情形2,积分滑模控制器(ISM)与自适应补偿控制器(CISM)对比。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310072294.8A CN115933725B (zh) | 2023-02-07 | 2023-02-07 | 一种刚柔液耦合航天器高精度姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310072294.8A CN115933725B (zh) | 2023-02-07 | 2023-02-07 | 一种刚柔液耦合航天器高精度姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115933725A true CN115933725A (zh) | 2023-04-07 |
CN115933725B CN115933725B (zh) | 2023-09-08 |
Family
ID=86556102
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310072294.8A Active CN115933725B (zh) | 2023-02-07 | 2023-02-07 | 一种刚柔液耦合航天器高精度姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115933725B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117648000A (zh) * | 2024-01-30 | 2024-03-05 | 北京航空航天大学 | 一种挠性充液卫星紧耦合抗干扰姿态控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102008039333A1 (de) * | 2008-08-22 | 2010-02-25 | Eads Deutschland Gmbh | Verfahren und Vorrichtung zur analogen Winkelsignalauswertung |
CN103576689A (zh) * | 2013-10-08 | 2014-02-12 | 北京控制工程研究所 | 一种交会对接六自由度相对控制方法 |
CN103792945A (zh) * | 2014-01-26 | 2014-05-14 | 南京航空航天大学 | 一种充液航天器系统的姿态控制和燃料晃动抑制方法 |
CN104898683A (zh) * | 2015-05-20 | 2015-09-09 | 哈尔滨工业大学 | 一种挠性卫星神经网络反步滑模姿态控制方法 |
CN108958275A (zh) * | 2018-06-25 | 2018-12-07 | 南京理工大学 | 一种刚柔液耦合系统姿态控制器和机动路径联合优化方法 |
CN112364571A (zh) * | 2020-10-09 | 2021-02-12 | 天津大学 | 大型复杂耦合航天器动力学模型建模方法 |
-
2023
- 2023-02-07 CN CN202310072294.8A patent/CN115933725B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102008039333A1 (de) * | 2008-08-22 | 2010-02-25 | Eads Deutschland Gmbh | Verfahren und Vorrichtung zur analogen Winkelsignalauswertung |
CN103576689A (zh) * | 2013-10-08 | 2014-02-12 | 北京控制工程研究所 | 一种交会对接六自由度相对控制方法 |
CN103792945A (zh) * | 2014-01-26 | 2014-05-14 | 南京航空航天大学 | 一种充液航天器系统的姿态控制和燃料晃动抑制方法 |
CN104898683A (zh) * | 2015-05-20 | 2015-09-09 | 哈尔滨工业大学 | 一种挠性卫星神经网络反步滑模姿态控制方法 |
CN108958275A (zh) * | 2018-06-25 | 2018-12-07 | 南京理工大学 | 一种刚柔液耦合系统姿态控制器和机动路径联合优化方法 |
CN112364571A (zh) * | 2020-10-09 | 2021-02-12 | 天津大学 | 大型复杂耦合航天器动力学模型建模方法 |
Non-Patent Citations (2)
Title |
---|
张秀云: "面向安全飞行的复杂航天器非线性鲁棒控制方法研究", 《CNKI博士电子期刊》 * |
朱婉婉: "复杂航天器柔性振动与姿态控制方法研究", 《万方》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117648000A (zh) * | 2024-01-30 | 2024-03-05 | 北京航空航天大学 | 一种挠性充液卫星紧耦合抗干扰姿态控制方法 |
CN117648000B (zh) * | 2024-01-30 | 2024-04-09 | 北京航空航天大学 | 一种挠性充液卫星紧耦合抗干扰姿态控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN115933725B (zh) | 2023-09-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104267732B (zh) | 基于频域分析的挠性卫星高稳定度姿态控制方法 | |
CN109189085B (zh) | 基于事件触发的航天器网络化系统姿态控制方法 | |
Zhang et al. | Extended state observer based robust adaptive control on SE (3) for coupled spacecraft tracking maneuver with actuator saturation and misalignment | |
CN104932510B (zh) | 一种针对飞轮低速摩擦的挠性航天器姿态控制系统与方法 | |
CN107479370B (zh) | 一种基于非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 | |
CN113306747B (zh) | 基于so(3)群的挠性航天器姿态稳定控制方法和系统 | |
CN110758774B (zh) | 带有挠性附件和液体晃动航天器的自抗扰姿态控制方法 | |
CN109782787B (zh) | 一种太阳光压辅助下欠驱动航天器姿态的双模mpc控制方法 | |
CN105807780B (zh) | 一种基于飞轮输出偏差的抗干扰姿态控制方法及验证装置 | |
CN111338368B (zh) | 一种航天器快速机动姿态跟踪自适应鲁棒控制方法 | |
CN113619814B (zh) | 一种交会对接最后逼近段相对姿轨耦合控制方法 | |
CN107861386B (zh) | 一种基于角速度观测器的抗干扰姿态控制地面验证系统及其控制方法 | |
Lee et al. | Adaptive variable-structure finite-time mode control for spacecraft proximity operations with actuator saturation | |
CN107458630B (zh) | 悬挂式主动重力补偿系统悬挂点跨尺度跟踪方法 | |
CN113859589A (zh) | 一种基于模型预测控制与滑模控制的航天器姿态控制方法 | |
CN115933725B (zh) | 一种刚柔液耦合航天器高精度姿态控制方法 | |
Qi et al. | Constrained attitude tracking control and active sloshing suppression for liquid-filled spacecraft | |
CN113778047A (zh) | 考虑测量误差及综合故障的复杂航天器容错控制方法 | |
CN113485396B (zh) | 一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法 | |
Zhang et al. | Finite-time attitude optimization maneuver control for coupled spacecraft under attitude measurement errors and actuator faults | |
Chen et al. | Active tilting flutter suppression of gyrowheel with composite-structured adaptive compensator | |
CN112305917A (zh) | 充液航天器的固定时间终端滑模鲁棒容错控制方法及装置 | |
Tao et al. | Attitude maneuvering and vibration reducing control of flexible spacecraft subject to actuator saturation and misalignment | |
Xu et al. | Relative position and attitude coupled control with finite-time convergence for spacecraft rendezvous and docking | |
CN117022674A (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 |