[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

CN115933725A - 一种刚柔液耦合航天器高精度姿态控制方法 - Google Patents

一种刚柔液耦合航天器高精度姿态控制方法 Download PDF

Info

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
Application number
CN202310072294.8A
Other languages
English (en)
Other versions
CN115933725B (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.)
China University of Mining and Technology CUMT
Original Assignee
China University of Mining and Technology CUMT
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 China University of Mining and Technology CUMT filed Critical China University of Mining and Technology CUMT
Priority to CN202310072294.8A priority Critical patent/CN115933725B/zh
Publication of CN115933725A publication Critical patent/CN115933725A/zh
Application granted granted Critical
Publication of CN115933725B publication Critical patent/CN115933725B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling 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,建立刚柔液耦合航天器面向控制模型:考虑柔性振动、液体晃动的影响建立模型不确定与外界干扰影响下的刚柔液耦合航天器非线性运动学模型与动力学模型,为进一步实现刚柔液耦合航天器姿态控制提供理论基础;刚柔液耦合航天器姿态运动学与动力学模型表达式为:刚柔液耦合航天器姿态运动学与动力学模型表达式为:
Figure BDA0004065084040000021
Figure BDA0004065084040000022
其中,q=[q0 qv T]=[q0 q1 q2 q3]T刚柔液耦合航天器姿态四元数,q0,qv分别为单位四元数的标量及向量部分;ω=[ω1 ω2 ω3]T为刚柔液耦合航天器角速度;J=J0+ΔJ∈R3×3为刚柔液耦合航天器的转动惯量矩阵;I3为三阶单位矩阵,
Figure BDA0004065084040000023
是斜对角矩阵并满足
Figure BDA0004065084040000031
u∈R3为控制输入力矩,d∈R3为外界干扰力矩;χ与η分别为柔性振动模态值与晃动液体模态值,δf∈R3×3为刚体与柔性振动耦合矩阵,d∈R3为外界干扰力矩,Cf=diag{2ξiΩi,i=1,2,...,N}为柔性附件的阻尼矩阵,
Figure BDA0004065084040000037
为刚度矩阵,Ωi与ξi分别为第i阶振动模态的频率与阻尼,Mη=[ml1 ml1 ml2 ml2]T为晃动液体质量矩阵,mli为第i阶液体晃动模态晃动液体的质量,Cl=[ci1 ci1 ci2 ci2]T与Kl=[kl1 kl1 kl2 kl2]T分别为晃动液体柔性矩阵与晃动液体刚度矩阵,Ml为液体晃动补充力矩,刚液耦合矩阵
Figure BDA0004065084040000032
为:
Figure BDA0004065084040000033
为实现刚柔液耦合航天器综合不确定部分有效估计,上述刚柔液耦合航天器运动学模型与动力学模型可以进一步转化为如下刚柔液耦合航天器面向控制模型:
Figure BDA0004065084040000034
Figure BDA0004065084040000035
其中,D表示刚柔液耦合航天器综合不确定,包括由柔性振动、液体晃动与外界干扰,并且
Figure BDA0004065084040000036
步骤2,设计反正切函数面:基于刚柔液耦合航天器姿态四元数与角速度,设计反正切函数面,实现到达反正切函数面后航天器姿态四元数与角速度快速收敛,反正切函数面的表达式为:
Figure BDA0004065084040000047
其中,sA=[sA1 sA2 sA3]T,反正切函数面参数k0>0,k2>1.5574,
Figure BDA0004065084040000041
为反正切函数;
步骤3,设计自适应补偿控制器:基于耦合航天器标称模型,设计标称控制器,进一步地考虑柔性振动、液体燃料晃动与外界干扰等综合不确定的影响,设计基于积分滑模的自适应补偿控制器,进行稳定性分析,实现在综合不确定影响下刚柔液耦合航天器快速高精度姿态控制,具体如下两个部分:
1)设计标称控制器
为避免滑模面奇异性问题,基于步骤2中的反正切函数面(5),针对步骤1中的刚柔液耦合航天器面向控制模型(3)-(4),设计如下非奇异反正切函数面:
s=ω+k1γ(qv) (6)
其中,s=[s1 s2 s3]T,非奇异部分γ(qv)=[γ(q1) γ(q2) γ(q3)]T设计如下:
Figure BDA0004065084040000042
其中,
Figure BDA0004065084040000043
指数0<r1<1,系数
Figure BDA0004065084040000044
Θ>0为设定的较小正常数;
针对刚柔液耦合航天器面向控制模型(3)-(4),基于非奇异反正切函数面(6),设计如下标称控制器:
Figure BDA0004065084040000045
其中,标称控制器参数0<σ1,0<σ2,0<r2<1为正常数,控制量
Figure BDA0004065084040000046
的奇异性是基于Fillipov意义下的;
2)设计基于积分滑模的自适应补偿控制器
针对刚柔液耦合航天器面向控制模型中的动力学模型(4),设计如下积分滑模面:
Figure BDA0004065084040000051
其中,ω(0)为角速度初值;
由式(9)可得积分滑模面sb的导数为:
Figure BDA0004065084040000052
由式(10)可知,当
Figure BDA0004065084040000053
时,则等效控制为:
ueq=ua-D (11)
将式(11)代入刚柔液耦合航天器面向控制模型中的动力学模型(4)可得:
Figure BDA0004065084040000054
由式(9)-(12)可知,当加入控制器后可以使得积分滑模面收敛,则耦合航天器实现在干扰情况下的姿态控制,因此,以下设计自适应补偿控制器,能够使积分滑模面在加入自适应补偿控制器后在有限时间收敛,自适应补偿控制器的设计如下:
针对刚柔液耦合航天器姿态模型(3)-(4),设计如下控制器:
u=ua+ub (13)
其中,控制器u是在假设1成立的条件下设计的,假设1即刚柔液耦合航天器运行过程中,综合不确定D中柔性振动、液体晃动及外界干扰是有界的,即存在正常数
Figure BDA0004065084040000055
使得
Figure BDA0004065084040000056
自适应补偿控制器设计为:
Figure BDA0004065084040000066
ρ(t)=α0(t)+α1(t)||ω||+α2(t)||ω||2 (14)
其中,0<r0<1,自适应增益αi(t)为:
Figure BDA0004065084040000062
其中,自适应参数ξi>0,ζi>0,i=0,1,2为正常数,基于假设1,式(8),(13),(14)可知,存在正常数
Figure BDA0004065084040000063
使得
Figure BDA0004065084040000064
步骤4,验证本方法的有效性:首先将刚柔液耦合航天器控制系统在Matlab/Simulink中进行集成设计,然后进行仿真实验,其中仿真过程主要包括刚柔液耦合航天器物理参数设置、控制器参数设置和结果分析。
优选的,步骤4中的刚柔液耦合航天器物理参数设置包括:
刚柔液耦合航天器实际转动惯量及其标称值分别为:
Figure BDA0004065084040000065
刚柔液耦合航天器前三阶振动模态的频率与阻尼分别为:Ω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,建立刚柔液耦合航天器面向控制模型:考虑柔性振动、液体晃动的影响建立模型不确定与外界干扰影响下的刚柔液耦合航天器非线性运动学模型与动力学模型,为进一步实现刚柔液耦合航天器姿态控制提供理论基础;刚柔液耦合航天器姿态运动学与动力学模型表达式为:刚柔液耦合航天器姿态运动学与动力学模型表达式为:
Figure BDA0004065084040000091
Figure BDA0004065084040000092
其中,
Figure BDA0004065084040000096
刚柔液耦合航天器姿态四元数,q0,qv分别为单位四元数的标量及向量部分;ω=[ω1 ω2 ω3]T为刚柔液耦合航天器角速度;J=J0+ΔJ∈R3×3为刚柔液耦合航天器的转动惯量矩阵;I3为三阶单位矩阵,
Figure BDA0004065084040000093
是斜对角矩阵并满足
Figure BDA0004065084040000094
u∈R3为控制输入力矩,d∈R3为外界干扰力矩;χ与η分别为柔性振动模态值与晃动液体模态值,δf∈R3×3为刚体与柔性振动耦合矩阵,d∈R3为外界干扰力矩,Cf=diag{2ξiΩi,i=1,2,...,N}为柔性附件的阻尼矩阵,
Figure BDA0004065084040000097
为刚度矩阵,Ωi与ξi分别为第i阶振动模态的频率与阻尼,Mη=[ml1 ml1 ml2 ml2]T为晃动液体质量矩阵,mli为第i阶液体晃动模态晃动液体的质量,Cl=[ci1 ci1 ci2 ci2]T与Kl=[kl1 kl1 kl2 kl2]T分别为晃动液体柔性矩阵与晃动液体刚度矩阵,Ml为液体晃动补充力矩,刚液耦合矩阵
Figure BDA0004065084040000095
为:
Figure BDA0004065084040000098
为实现刚柔液耦合航天器综合不确定部分有效估计,上述刚柔液耦合航天器运动学模型与动力学模型可以进一步转化为如下刚柔液耦合航天器面向控制模型:
Figure BDA0004065084040000101
Figure BDA0004065084040000105
其中,D表示刚柔液耦合航天器综合不确定,包括由柔性振动、液体晃动与外界干扰,并且
Figure BDA0004065084040000102
步骤2,设计反正切函数面:基于刚柔液耦合航天器姿态四元数与角速度,设计反正切函数面,实现到达反正切函数面后航天器姿态四元数与角速度快速收敛,反正切函数面的表达式为:
Figure BDA0004065084040000103
其中,sA=[sA1 sA2 sA3]T,反正切函数面参数k0>0,k2>1.5574,
Figure BDA0004065084040000104
为反正切函数;
步骤3,设计自适应补偿控制器:基于耦合航天器标称模型,设计标称控制器,进一步地考虑柔性振动、液体燃料晃动与外界干扰等综合不确定的影响,设计基于积分滑模的自适应补偿控制器,进行稳定性分析,实现在综合不确定影响下刚柔液耦合航天器快速高精度姿态控制,具体如下两个部分:
1)设计标称控制器
为避免滑模面奇异性问题,基于步骤2中的反正切函数面(5),针对步骤1中的刚柔液耦合航天器面向控制模型(3)-(4),设计如下非奇异反正切函数面:
s=ω+k1γ(qv) (6)
其中,s=[s1 s2 s3]T,非奇异部分γ(qv)=[γ(q1) γ(q2) γ(q3)]T设计如下:
Figure BDA0004065084040000111
其中,
Figure BDA0004065084040000112
指数0<r1<1,系数
Figure BDA0004065084040000113
Θ>0为设定的较小正常数;
针对刚柔液耦合航天器面向控制模型(3)-(4),基于非奇异反正切函数面(6),设计如下标称控制器:
Figure BDA0004065084040000114
其中,标称控制器参数0<σ1,0<σ2,0<r2<1为正常数,控制量
Figure BDA0004065084040000115
的奇异性是基于Fillipov意义下的;
2)设计基于积分滑模的自适应补偿控制器
针对刚柔液耦合航天器面向控制模型中的动力学模型(4),设计如下积分滑模面:
Figure BDA0004065084040000116
其中,ω(0)为角速度初值;
由式(9)可得积分滑模面sb的导数为:
Figure BDA0004065084040000117
由式(10)可知,当
Figure BDA0004065084040000118
时,则等效控制为:
ueq=ua-D (11)
将式(11)代入刚柔液耦合航天器面向控制模型中的动力学模型(4)可得:
Figure BDA0004065084040000119
由式(9)-(12)可知,当加入控制器后可以使得积分滑模面收敛,则耦合航天器实现在干扰情况下的姿态控制,因此,以下设计自适应补偿控制器,能够使积分滑模面在加入自适应补偿控制器后在有限时间收敛,自适应补偿控制器的设计如下:
针对刚柔液耦合航天器姿态模型(3)-(4),设计如下控制器:
u=ua+ub (13)
其中,控制器u是在假设1成立的条件下设计的,假设1即刚柔液耦合航天器运行过程中,综合不确定D中柔性振动、液体晃动及外界干扰是有界的,即存在正常数
Figure BDA0004065084040000121
使得
Figure BDA0004065084040000122
自适应补偿控制器设计为:
Figure BDA0004065084040000123
其中,0<r0<1,自适应增益αi(t)为:
Figure BDA0004065084040000124
其中,自适应参数ξi>0,ζi>0,i=0,1,2为正常数,基于假设1,式(8),(13),(14)可知,存在正常数
Figure BDA0004065084040000125
使得
Figure BDA0004065084040000126
步骤4,验证本方法的有效性:首先将刚柔液耦合航天器控制系统在Matlab/Simulink中进行集成设计,然后进行仿真实验,其中仿真过程主要包括刚柔液耦合航天器物理参数设置、控制器参数设置和结果分析,具体如下:
1)刚柔液耦合航天器物理参数设置包括:
刚柔液耦合航天器实际转动惯量及其标称值分别为:
Figure BDA0004065084040000127
刚柔液耦合航天器前三阶振动模态的频率与阻尼分别为:Ω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,建立刚柔液耦合航天器面向控制模型:考虑柔性振动、液体晃动的影响建立模型不确定与外界干扰影响下的刚柔液耦合航天器非线性运动学模型与动力学模型,为进一步实现刚柔液耦合航天器姿态控制提供理论基础;刚柔液耦合航天器姿态运动学与动力学模型表达式为:刚柔液耦合航天器姿态运动学与动力学模型表达式为:
Figure FDA0004065084030000011
Figure FDA0004065084030000012
其中,
Figure FDA0004065084030000013
刚柔液耦合航天器姿态四元数,q0,qv分别为单位四元数的标量及向量部分;ω=[ω1ω2ω3]T为刚柔液耦合航天器角速度;J=J0+ΔJ∈R3×3为刚柔液耦合航天器的转动惯量矩阵;I3为三阶单位矩阵,
Figure FDA0004065084030000014
是斜对角矩阵并满足
Figure FDA0004065084030000015
u∈R3为控制输入力矩,d∈R3为外界干扰力矩;χ与η分别为柔性振动模态值与晃动液体模态值,δf∈R3×3为刚体与柔性振动耦合矩阵,d∈R3为外界干扰力矩,Cf=diag{2ξiΩi,i=1,2,...,N}为柔性附件的阻尼矩阵,
Figure FDA0004065084030000016
为刚度矩阵,Ωi与ξi分别为第i阶振动模态的频率与阻尼,Mη=[ml1 ml1 ml2 ml2]T为晃动液体质量矩阵,mli为第i阶液体晃动模态晃动液体的质量,Cl=[ci1 ci1 ci2 ci2]T与Kl=[kl1 kl1 kl2 kl2]T分别为晃动液体柔性矩阵与晃动液体刚度矩阵,Ml为液体晃动补充力矩,刚液耦合矩阵
Figure FDA0004065084030000021
为:
Figure FDA0004065084030000022
为实现刚柔液耦合航天器综合不确定部分有效估计,上述刚柔液耦合航天器运动学模型与动力学模型可以进一步转化为如下刚柔液耦合航天器面向控制模型:
Figure FDA0004065084030000023
Figure FDA0004065084030000024
其中,D表示刚柔液耦合航天器综合不确定,包括由柔性振动、液体晃动与外界干扰,并且
Figure FDA0004065084030000025
步骤2,设计反正切函数面:基于刚柔液耦合航天器姿态四元数与角速度,设计反正切函数面,实现到达反正切函数面后航天器姿态四元数与角速度快速收敛,反正切函数面的表达式为:
sA= ω+k0arctan(k2qv)r1 (5)
其中,sA=[sA1 sA2 sA3]T,反正切函数面参数k0>0,k2>1.5574,
Figure FDA0004065084030000026
为反正切函数;
步骤3,设计自适应补偿控制器:基于耦合航天器标称模型,设计标称控制器,进一步地考虑柔性振动、液体燃料晃动与外界干扰等综合不确定的影响,设计基于积分滑模的自适应补偿控制器,进行稳定性分析,实现在综合不确定影响下刚柔液耦合航天器快速高精度姿态控制,具体如下两个部分:
1)设计标称控制器
为避免滑模面奇异性问题,基于步骤2中的反正切函数面(5),针对步骤1中的刚柔液耦合航天器面向控制模型(3)-(4),设计如下非奇异反正切函数面:
s=ω+k1γ(qv) (6)
其中,s=[s1 s2 s3]T,非奇异部分γ(qv)=[γ(q1)γ(q2)γ(q3)]T设计如下:
Figure FDA0004065084030000031
其中,
Figure FDA0004065084030000032
指数0<r1<1,系数
Figure FDA0004065084030000033
Θ>0为设定的较小正常数;
针对刚柔液耦合航天器面向控制模型(3)-(4),基于非奇异反正切函数面(6),设计如下标称控制器:
Figure FDA0004065084030000034
其中,标称控制器参数0<σ1,0<σ2,0<r2<1为正常数,控制量
Figure FDA0004065084030000035
的奇异性是基于Fillipov意义下的;
2)设计基于积分滑模的自适应补偿控制器
针对刚柔液耦合航天器面向控制模型中的动力学模型(4),设计如下积分滑模面:
Figure FDA0004065084030000036
其中,ω(0)为角速度初值;
由式(9)可得积分滑模面sb的导数为:
Figure FDA0004065084030000037
由式(10)可知,当
Figure FDA0004065084030000038
时,则等效控制为:
ueq=ua-D (11)
将式(11)代入刚柔液耦合航天器面向控制模型中的动力学模型(4)可得:
Figure FDA0004065084030000041
由式(9)-(12)可知,当加入控制器后可以使得积分滑模面收敛,则耦合航天器实现在干扰情况下的姿态控制,因此,以下设计自适应补偿控制器,能够使积分滑模面在加入自适应补偿控制器后在有限时间收敛,自适应补偿控制器的设计如下:
针对刚柔液耦合航天器姿态模型(3)-(4),设计如下控制器:
u=ua+ub (13)
其中,控制器u是在假设1成立的条件下设计的,假设1即刚柔液耦合航天器运行过程中,综合不确定D中柔性振动、液体晃动及外界干扰是有界的,即存在正常数
Figure FDA0004065084030000042
使得
Figure FDA0004065084030000043
自适应补偿控制器设计为:
Figure FDA0004065084030000044
ρ(t)=α0(t)+α1(t)||ω||+α2(t)||ω||2 (14)
其中,0<r0<1,自适应增益αi(t)为:
Figure FDA0004065084030000045
其中,自适应参数ξi>0,ζi>0,i=0,1,2为正常数,基于假设1,式(8),(13),(14)可知,存在正常数
Figure FDA0004065084030000046
使得
Figure FDA0004065084030000047
步骤4,验证本方法的有效性:首先将刚柔液耦合航天器控制系统在Matlab/Simulink中进行集成设计,然后进行仿真实验,其中仿真过程主要包括刚柔液耦合航天器物理参数设置、控制器参数设置和结果分析。
2.根据权利要求1所述的一种刚柔液耦合航天器高精度姿态控制方法,其特征在于:步骤4中的刚柔液耦合航天器物理参数设置包括:
刚柔液耦合航天器实际转动惯量及其标称值分别为:
Figure FDA0004065084030000051
刚柔液耦合航天器前三阶振动模态的频率与阻尼分别为:Ω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)对比。
CN202310072294.8A 2023-02-07 2023-02-07 一种刚柔液耦合航天器高精度姿态控制方法 Active CN115933725B (zh)

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)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117648000A (zh) * 2024-01-30 2024-03-05 北京航空航天大学 一种挠性充液卫星紧耦合抗干扰姿态控制方法

Citations (6)

* Cited by examiner, † Cited by third party
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 天津大学 大型复杂耦合航天器动力学模型建模方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
Title
张秀云: "面向安全飞行的复杂航天器非线性鲁棒控制方法研究", 《CNKI博士电子期刊》 *
朱婉婉: "复杂航天器柔性振动与姿态控制方法研究", 《万方》 *

Cited By (2)

* Cited by examiner, † Cited by third party
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