CN114229039B - 一种充液柔性航天器自适应无角速度复合控制方法 - Google Patents
一种充液柔性航天器自适应无角速度复合控制方法 Download PDFInfo
- Publication number
- CN114229039B CN114229039B CN202111524046.XA CN202111524046A CN114229039B CN 114229039 B CN114229039 B CN 114229039B CN 202111524046 A CN202111524046 A CN 202111524046A CN 114229039 B CN114229039 B CN 114229039B
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- angular velocity
- adaptive
- attitude
- designed
- 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.)
- Active
Links
- 239000007788 liquid Substances 0.000 title claims abstract description 76
- 238000000034 method Methods 0.000 title claims abstract description 54
- 239000002131 composite material Substances 0.000 title claims description 17
- 230000004044 response Effects 0.000 claims description 53
- 239000011159 matrix material Substances 0.000 claims description 41
- 238000013461 design Methods 0.000 claims description 39
- 230000003044 adaptive effect Effects 0.000 claims description 32
- 238000006073 displacement reaction Methods 0.000 claims description 19
- 230000009471 action Effects 0.000 claims description 11
- 238000013016 damping Methods 0.000 claims description 10
- 230000008878 coupling Effects 0.000 claims description 7
- 238000010168 coupling process Methods 0.000 claims description 7
- 238000005859 coupling reaction Methods 0.000 claims description 7
- 230000010355 oscillation Effects 0.000 claims description 5
- 239000000446 fuel Substances 0.000 abstract description 9
- 230000008569 process Effects 0.000 abstract description 9
- 150000001875 compounds Chemical class 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 7
- 230000007547 defect Effects 0.000 description 3
- 230000005764 inhibitory process Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000001629 suppression Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000000465 moulding Methods 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
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/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
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明属于航天器控制技术领域,公开了一种充液柔性航天器自适应无角速度复合控制方法,所述充液柔性航天器自适应无角速度复合控制方法包括:确定经过命令光滑器的前馈指令四元数;确定航天器姿态的误差四元数;在航天器姿态参考坐标系下建立航天器姿态运动学模型及动力学模型;通过建立的航天器模型设计了一种自适应无角速度反馈的姿态机动退步控制器。本发明采用退步控制方法,设计姿态角速度观测器代替角速度信息进行反馈控制,设计命令光滑器对航天器在姿态机动过程中的液体晃动以及柔性附件的振动进行控制,从而使多体航天器完成姿态机动控制的同时抑制航天器中液体燃料的晃动以及柔性附件的振动。
Description
技术领域
本发明属于航天器控制技术领域,尤其涉及一种充液柔性航天器自适应无角速度复合控制方法。
背景技术
目前,航天器姿态控制方法是航天器姿态控制系统的研究重点,随着航天技术的蓬勃发展,航天器携带的液体燃料相对于航天器总质量的比重相应增加,同时所携带的挠性附件也越来越大,对航天器的姿态控制以及稳定性造成了较大影响,在航天器的姿态机动过程中液体燃料的晃动和挠性附件的振动很有可能产生系统共振导致控制系统失效,甚至影响高精度的姿态机动任务,导致任务失败。因此在设计控制系统时,为尽量减小液体燃料晃动以及挠性附件振动对刚体航天器的耦合影响,提高航天器的稳定性,耦合航天器的控制系统在保证姿态稳定的前提下,如何尽量减小姿态机动时引起的液体晃动响应以及挠性附件的振动响应已经成为了一个重要课题。另一方面,传统的反馈控制方法需要系统的角速度信息进行反馈控制,但是在一些极端情况下系统的角速度信息很难测量准确或有效利用,如传感器故障等情况,此时就需要考虑设计无角速度反馈的姿态控制方法。
近年来,国内外众多学者提出了多种液体晃动和柔性附件振动的抑制方法以及无角速度测量的控制方法,如宋晓娟、岳宝增等采用输入成型理论对液体晃动进行抑制,设计的前馈控制器有效地减小了姿态机动时前两阶液体燃料晃动模态的位移响应;Subbarao和Akella采用一个一阶的角速度滤波器结合PD控制方法对航天器进行姿态控制;Gennaro采用无源理论设计了无角速度测量的控制方法等。但是一方面,多数控制方法只针对低阶模态进行晃动以及振动抑制,难以抑制无穷模态的晃动以及振动响应,尤其对于高阶模态,控制系统难以设计;另一方面,无角速度的控制系统设计也较为复杂。
通过上述分析,现有技术存在的问题及缺陷为:
(1)传统的反馈控制方法需要系统的角速度信息进行反馈控制,但是在一些极端情况下系统的角速度信息很难测量准确或有效利用,如传感器故障等情况,此时就需要考虑设计无角速度反馈的姿态控制方法。
(2)现有的多数控制方法只针对低阶模态进行晃动以及振动抑制,难以抑制无穷模态的晃动以及振动响应,尤其对于高阶模态,控制系统难以设计。
(3)现有的无角速度的控制系统设计较为复杂。
解决以上问题及缺陷的难度为:
(1)设计无角速度测量的控制系统的主要难点在于姿态观测器或者是角速度观测器的设计,且设计的观测器是简便的、占用星载计算机内存较小的;
(2)姿态机动时引起的液体晃动以及柔性附件振动的抑制的主要难点在于设计的控制器需要能够抑制无穷阶模态的晃动以及振动,且不在机体上额外增加控制元件。
解决以上问题及缺陷的意义为:
(1)航天器姿态机动控制过程中,角速度信息并不总是能够测量到的,如角速度测量元件发生故障,或角速度信息音噪声影响其精度,本发明专利能够有效地加大航天器控制系统的鲁棒性,在角速度信息不可用时也可有效完成规定的姿态机动任务;同时进一步增加系统姿态机动时的稳定性,减少系统整体震荡。
(2)本发明专利不需要增加额外的结构或者控制元件,所设计的基于前馈控制的命令光滑器可有效地抑制航天器机动过程中柔性附件的振动及液体燃料的晃动,所设计的复合控制策略方法简单可靠,只需要设计一个基频命令光华器就能抑制高于该频率的所有阶模态的振动。
发明内容
针对现有技术存在的问题,本发明提供了一种充液柔性航天器自适应无角速度复合控制方法,尤其涉及一种充液柔性航天器自适应无角速度复合控制方法及系统,旨在解决充液柔性航天器无角速度的控制问题以及液体晃动和柔性附件多模态振动的抑制问题。
本发明是这样实现的,一种充液柔性航天器自适应无角速度复合控制方法,其包括以下步骤:
步骤一,确定经过命令光滑器的前馈指令四元数经过命令光滑器的前馈指令四元数相比于初始指令四元数能够有效降低航天器机动过程中液体晃动以及柔性附件振动的位移响应。
步骤二,确定航天器姿态的误差四元数;航天器姿态的误差四元数用于反馈控制。
步骤三,在航天器姿态参考坐标系下建立航天器姿态运动学模型及动力学模型;通过建立的航天器模型来设计后续的控制器。
步骤四,通过建立的航天器模型设计航天器姿态机动退步控制器τ;
步骤五,在τ的基础上通过建立的航天器模型设计航天器自适应姿态机动退步控制器τ2;
步骤六,在τ2的基础上通过建立的航天器模型设计航天器自适应无角速度姿态机动退步控制器τ3。
进一步,步骤一中,所述命令光滑器设计为:
其中,ωk为待设计的光滑器的系统频率,ζk为待设计的系统阻尼,为系统的阻尼振荡周期,/>
设为航天器的初始指令四元数,[ε0εT]T=[ε0 ε1 ε2 ε3]T为航天器的实际四元数,经过命令光滑器的前馈指令四元数由以下方法得到:
其中,[ε0(0) εT(0)]T代表实际四元数的初始值,*代表卷积运算。
进一步,步骤二中,所述确定航天器姿态的误差四元数,包括:
设为航天器的误差四元数,则所述误差四元数的定义为:
进一步,步骤三中,所述在航天器姿态参考坐标系下建立的航天器姿态运动学模型为:
G(ε0,ε)=[-ε,ε0I3-ε×];
其中,ω=[ω1 ω2 ω3]T为航天器角速度,[ε0 εT]T=[ε0 ε1 ε2 ε3]T为航天器的实际四元数,满足约束条件I3为3×3的单位矩阵。
所述航天器动力学模型为:
其中,Jmb∈R3×3是正定对称的转动惯量矩阵,Td∈R3是系统受到的集总干扰,δi∈R3 ×3(i=1,2)是第i阶液体晃动对刚体航天器的耦合矩阵,F∈R3×3是柔性附件振动对刚体航天器的耦合矩阵,Ci∈R3×3、Ki∈R3×3(i=1,2)分别为第i阶液体晃动的阻尼矩阵与刚度矩阵,C3∈R3×3、K3∈R3×3分别为柔性附件振动的阻尼矩阵与刚度矩阵,ηi∈R3(i=1,2)为第i阶液体晃动的晃动位移,n∈R3为柔性附件的振动模态坐标,ψi、ζ为中间变量,τ∈R3为三轴施加的控制力矩。
进一步,步骤四中,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应已知的情况下设计航天器的姿态机动退步控制器τ,使得闭环系统渐近稳定,并且闭环系统状态满足
所述通过建立的航天器模型设计航天器姿态机动退步控制器τ,包括:
(1)设计退步变量x1、x2:
x1=ε,x2=ω-α;
其中,α为中间变量;
(2)设计中间变量α:
考虑Lyapunov方程
其中,k1=diag{k11 k12 k13}为一个待设计的正定对角矩阵;
则V1沿系统轨迹对时间的导数为:
设计α=-k2x1,k2为一个待设计的正常数,则可见x1≠0,x2=0,根据Lyapunov稳定性原理可知系统渐近稳定;
(3)确定航天器的姿态机动退步控制器τ为:
其中,k3=diag{k31 k32 k33}为一个待设计的正定对角矩阵;
(4)考虑Lyapunov方程V2分析系统稳定性:
设
V2沿系统轨迹对时间的导数为:
将τ带入得根据Lasalle最大不变集原理,系统内的状态变量最终会收敛到/>中,证明控制系统的稳定性。
进一步,步骤五中,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计状态变量的自适应更新律,设计航天器的自适应姿态机动退步控制器τ2,使得闭环系统渐近稳定,并且闭环系统状态满足
假设液体晃动响应以及柔性附件的振动响应是未知的,设 分别是ηi、ψi、n、ζ、Td无限接近的估计值;假设/> 分别是各状态变量的误差值;所述通过建立的航天器模型设计航天器自适应姿态机动退步控制器τ2,包括:
(1)设计状态变量的自适应更新律,估计真实的状态变量响应:
其中,Γ∈R3×3为待设计的对角正定矩阵;Pi为待设计的对称正定矩阵,由以下公式得到:
其中,Qi为任意的待设计的对称正定矩阵;
(2)根据状态变量的自适应更新律,设计航天器的姿态机动自适应退步控制器τ2为:
(3)考虑Lyapunov函数V3分析系统的稳定性:
V3沿系统轨迹对时间的导数为:
根据Lasalle最大不变集原理,系统渐近稳定。
进一步,步骤六中,目标是在角速度信息不可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计辅助观测器代替角速度信息进行反馈,设计航天器的自适应无角速度姿态机动退步控制器τ3,使得闭环系统渐近稳定,并且闭环系统状态满足
假设系统的角速度ω是不可用的,所述通过建立的航天器模型设计航天器自适应无角速度姿态机动退步控制器τ3,包括:
(1)设计角速度的辅助观测器:
其中,为设计的辅助观测器状态变量,λ为一个待设计的足够小的正数;
(2)用辅助观测器代替角速度进行反馈,确定角速度的代替式:
(3)将角速度的代替式带入状态变量的自适应更新律中,重新得到状态变量的自适应更新律:
(4)将角速度的代替式带入航天器的自适应退步控制器τ2中替换角速度ω,得到航天器的自适应无角速度姿态机动退步控制器τ3:
通过调整设计参数,系统状态在航天器的自适应无角速度姿态机动退步控制器τ3的作用下会收敛到零点的邻域内。
结合上述的所有技术方案,本发明所具备的优点及积极效果为:本发明提供的多体充液柔性航天器自适应无角速度复合控制方法,属于耦合航天器自适应无角速度控制技术领域,尤其涉及一种充液柔性航天器自适应无角速度复合控制方法。本发明针对航天器的高精密姿态机动任务,应用退步控制方法设计了一种充液柔性航天器自适应无角速度复合控制方法,设计了命令光滑器有效地减小了姿态机动时产生的多模态的液体晃动位移响应和柔性附件振动响应,设计了角速度观测器有效地代替角速度信息实现了航天器姿态机动的渐近稳定。本发明所设计的控制器不依赖于航天器的姿态角速度,同时在不需要增加额外的结构及控制元件的情况下抑制柔性附件及液体燃料在航天器机动过程中的残余振动,为航天器的控制提供一种新的思路,具有重要的理论意义及工程实际应用价值。
针对航天器的姿态机动控制及其液体燃料晃动以及柔性附件振动的抑制问题,本发明采用退步控制方法,设计了角速度观测器代替角速度信息进行反馈控制,设计了命令光滑器对航天器在姿态机动过程中的液体晃动以及柔性附件的振动进行前馈抑制控制,解决了充液柔性航天器在角速度信息不可用的情况下的姿态机动的稳定性控制问题,同时有效且显著地削弱了机动过程中液体燃料的晃动位移响应以及柔性附件的振动位移响应。
本发明可有效地解决充液柔性航天器在角速度不可用、系统状态变量未知且受到外部干扰力矩的作用的情况下的姿态机动的稳定性控制问题;本发明可有效且显著地降低多模态的液体燃料晃动响应位移和柔性附件的振动响应位移,减小航天器在姿态机动过程中的抖振;本发明设计的状态变量的自适应更新律能够有效且精准地估计真实状态变量的响应结果;本发明设计的角速度观测器能够有效且准确地模拟到角速度的变化响应。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对本发明实施例中所需要使用的附图做简单的介绍,显而易见地,下面所描述的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的一种充液柔性航天器自适应无角速度复合控制方法流程图。
图2是本发明实施例提供的一种充液柔性航天器自适应无角速度复合控制方法原理图。
图3是本发明实施例提供的前馈指令四元数曲线示意图。
图4是本发明实施例提供的实际四元数曲线示意图。
图5是本发明实施例提供的角速度曲线示意图。
图6是本发明实施例提供的控制力矩曲线示意图。
图7是本发明实施例提供的第一阶液体晃动实际值与估计值的对比曲线图。
图8是本发明实施例提供的第二阶液体晃动实际值与估计值的对比曲线图。
图9是本发明实施例提供的前三阶柔性附件振动的模态坐标的实际值与估计值的对比曲线示意图。
图10是本发明实施例提供的在初始指令四元数和前馈指令四元数的作用下的第一阶液体晃动响应的对比曲线示意图。
图11是本发明实施例提供的在初始指令四元数和前馈指令四元数的作用下的前三阶柔性附件振动模态的模态坐标响应的对比曲线示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
针对现有技术存在的问题,本发明提供了一种充液柔性航天器自适应无角速度复合控制方法,下面结合附图对本发明作详细的描述。
如图1所示,本发明实施例提供的一种充液柔性航天器自适应无角速度复合控制方法包括以下步骤:
S101,确定经过命令光滑器的前馈指令四元数;
S102,确定航天器姿态的误差四元数;
S103,在航天器姿态参考坐标系下建立航天器姿态运动学模型及动力学模型;
S104,通过建立的航天器模型设计航天器姿态机动退步控制器τ;
S105,通过建立的航天器模型设计航天器自适应姿态机动退步控制器τ2;
S106,通过建立的航天器模型设计航天器自适应无角速度姿态机动退步控制器τ3。
本发明实施例提供的充液柔性航天器自适应无角速度复合控制方法原理图如图2所示。
下面结合具体实施例对本发明的技术方案作进一步描述。
如图2所示,本发明实施例提供的一种充液柔性航天器自适应无角速度复合控制方法包括以下步骤:
步骤S1、确定经过命令光滑器的前馈指令四元数
命令光滑器设计为:
其中,ωk为待设计的光滑器的系统频率,ζk为待设计的系统阻尼,为系统的阻尼振荡周期,/>
如图2所示,设为航天器的初始指令四元数,[ε0εT]T=[ε0 ε1 ε2 ε3]T为航天器的实际四元数,经过命令光滑器的前馈指令四元数由以下方法得到:
其中[ε0(0) εT(0)]T代表实际四元数的初始值,*代表卷积运算。
步骤S2、确定航天器姿态的误差四元数。设为航天器的误差四元数,误差四元数的定义为
S3、在航天器姿态参考坐标系下建立航天器姿态运动学模型及动力学模型,所述在航天器姿态参考坐标系下建立的航天器姿态运动学模型为:
G(ε0,ε)=[-ε,ε0I3-ε×]
其中,ω=[ω1 ω2 ω3]T为航天器角速度,[ε0 εT]T=[ε0 ε1 ε2 ε3]T为航天器的实际四元数,其满足约束条件
航天器动力学模型为:
其中Jmb∈R3×3是正定对称的转动惯量矩阵,Td∈R3是系统受到的集总干扰,δi∈R3 ×3(i=1,2)是第i阶液体晃动对刚体航天器的耦合矩阵,F∈R3×3是柔性附件振动对刚体航天器的耦合矩阵,Ci∈R3×3、Ki∈R3×3(i=1,2)分别为第i阶液体晃动的阻尼矩阵与刚度矩阵,C3∈R3×3、K3∈R3×3分别为柔性附件振动的阻尼矩阵与刚度矩阵,ηi∈R3(i=1,2)为第i阶液体晃动的晃动位移,n∈R3为柔性附件的振动模态坐标,ψi、ζ为中间变量,τ∈R3为三轴施加的控制力矩。
S4、通过建立的航天器模型设计航天器的姿态机动退步控制器τ,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应已知的情况下设计航天器的姿态机动退步控制器τ,使得闭环系统渐近稳定,并且闭环系统状态满足
S5、通过建立的航天器模型设计航天器的自适应姿态机动退步控制器τ2,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计状态变量的自适应更新律,设计航天器的自适应姿态机动退步控制器τ2,使得闭环系统渐近稳定,并且闭环系统状态满足
S6、通过建立的航天器模型设计航天器的自适应无角速度姿态机动退步控制器τ3,目标是在角速度信息不可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计辅助观测器代替角速度信息进行反馈,设计航天器的自适应无角速度姿态机动退步控制器τ3,使得闭环系统渐近稳定,并且闭环系统状态满足
进一步的,所述步骤S2中,命令光滑器设计为:
其中,ωk为待设计的光滑器的系统频率,ζk为待设计的系统阻尼,为系统的阻尼振荡周期,/>
设为航天器的初始指令四元数,经过命令光滑器的前馈指令四元数/>由以下方法得到:
其中[ε0(0) εT(0)]T代表初始的实际四元数,*代表卷积运算。
进一步的,所述步骤S4中,航天器的姿态机动退步控制器τ的设计步骤进一步包含:
S4.1、设计退步变量x1、x2
x1=ε,x2=ω-α
其中α为中间变量;
S4.2、设计中间变量α
考虑Lyapunov方程
其中k1=diag{k11 k12 k13}为一个待设计的正定对角矩阵;
则V1沿系统轨迹对时间的导数为:
设计α=-k2x1,k2为一个待设计的正常数,则可见x1≠0,x2=0,根据Lyapunov稳定性原理可知系统渐近稳定;
S4.3、确定航天器的姿态机动退步控制器τ为:
其中k3=diag{k31 k32 k33}为一个待设计的正定对角矩阵;
S4.4、考虑Lyapunov方程V2分析系统稳定性
设
V2沿系统轨迹对时间的导数为:
将τ带入得根据Lasalle最大不变集原理,系统内的状态变量最终会收敛到/>中,证明了控制系统的稳定性。
进一步的,所属步骤S5中,假设液体晃动响应以及柔性附件的振动响应是未知的,设分别是ηi、ψi、n、ζ、Td无限接近的估计值;假设可见/>eη、eψ、en、eζ分别是各状态变量的误差值;
所述步骤S5进一步包含:
S5.1、为了估计真实的状态变量响应,设计状态变量的自适应更新律:
其中Γ∈R3×3为待设计的对角正定矩阵;Pi为待设计的对称正定矩阵,由以下公式得到:
Qi为任意的待设计的对称正定矩阵;
S5.2、根据状态变量的自适应更新律,设计航天器的姿态机动自适应退步控制器τ2为:
S5.3、考虑Lyapunov函数V3分析系统的稳定性:
V3沿系统轨迹对时间的导数为:
根据Lasalle最大不变集原理,系统渐近稳定。
进一步的,所述步骤S6中,假设系统的角速度ω是不可用的,
所述步骤S6进一步包含:
S6.1、设计角速度的辅助观测器
其中为设计的辅助观测器状态变量,λ为一个待设计的足够小的正数;
S6.2、用辅助观测器代替角速度进行反馈,确定角速度的代替式
S6.3、将角速度的代替式带入状态变量的自适应更新律中,重新得到状态变量的自适应更新律:
S6.4、将角速度的代替式带入航天器的自适应退步控制器τ2中替换角速度ω,得到航天器的自适应无角速度姿态机动退步控制器τ3:
通过调整设计参数,系统状态在航天器的自适应无角速度姿态机动退步控制器τ3的作用下会收敛到零点的邻域内。
下面以实际案例仿真说明实施方案的有效性。以某观测卫星作为被控对象,采用本发明的控制方法,验证其有效性。
假设航天器绕欧拉轴进行θ=90°的姿态机动,初始角速度为ω(0)=[0 0 0]T,实际四元数的初始值为ε(0)=[0.7071 0.2626 -0.5252 0.3939]T,初始指令四元数为εc0=1,εc=[0 0 0]T,液体晃动位移以及柔性附件振动位移的初始值均为0。航天器的惯性矩阵为/>干扰力矩为/>
航天器模型以及控制器内其他参数为:
mf0=50.92kg,mf1=20kg,mf2=0.8kg,C1=diag{0.1667,0.1667,0.1667},C2=diag{0.2963,0.2963,0.2963},C3=diag{0.004,0.005,0.0064},K1=diag{0.138,0.138,0.138},K2=diag{11.3594,11.3594,11.3594},K3=diag{0.74,1.1,1.8733},Γ=0.01Ι3,Ι3为3×3的单位矩阵,k1=diag{250,200,750},k2=0.001,k3=diag{90,90,150},λ=0.01,[χ0 χT]T的初始值为[0 0 0 0],ωk=0.15,ζk=0.1,由Qi得到的Pi矩阵为:P1=diag{500,500,1,100,100,1},P2=diag{500,500,1,500,100,1},P3=diag{200,250,1000,200,250,1000}。
仿真结果如图3至11所示。其中,图3经过命令光滑器的前馈指令四元数曲线;图4至图6为基于航天器的自适应无角速度姿态机动退步控制器τ3的航天器实际四元数、角速度、控制力矩的时间响应曲线;图7和图8分别为第一阶和第二阶液体晃动在X轴方向(ηi1)和Y轴方向(ηi2)的位移响应曲线(i=1,2),其中实线为实际的位移响应,虚线为状态变量的自适应更新律估计的位移响应;图9为前三阶柔性附件振动模态的模态坐标(q1(t),q2(t),q3(t))响应曲线,同样实线为实际的模态坐标响应,虚线为状态变量的自适应更新律估计的模态坐标响应;图10为在初始指令四元数和前馈指令四元数的作用下的第一阶液体晃动在X方向和Y方向的位移响应的对比曲线,其中实线为在初始指令四元数作用下的结果,虚线为在前馈指令四元数作用下的结果;图11为在初始指令四元数和前馈指令四元数的作用下的前三阶柔性附件振动模态的模态坐标响应的对比曲线,其中实线为在初始指令四元数作用下的结果,虚线为在前馈指令四元数作用下的结果。从图中可以看出,控制器能有效实现航天器姿态机动的稳定,且有效抑制液体晃动以及柔性附件振动的位移响应,提出的航天器的状态变量的自适应更新律能够有效估计液体晃动以及柔性附件振动的状态变量的响应,提出的角速度观测器能有效代替角速度进行反馈实现系统稳定。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,都应涵盖在本发明的保护范围之内。
Claims (1)
1.一种充液柔性航天器自适应无角速度复合控制方法,其特征在于,所述充液柔性航天器自适应无角速度复合控制方法包括以下步骤:
步骤一,确定经过命令光滑器的前馈指令四元数
步骤二,确定航天器姿态的误差四元数;
步骤三,在航天器姿态参考坐标系下建立航天器姿态运动学模型及动力学模型;
步骤四,通过建立的航天器模型设计航天器姿态机动退步控制器τ1;
步骤五,通过建立的航天器模型设计航天器自适应姿态机动退步控制器τ2;
步骤六,通过建立的航天器模型设计航天器自适应无角速度姿态机动退步控制器τ3;
步骤一中,所述命令光滑器设计为:
其中,u(t)为平滑命令函数,t为时间,ωk为待设计的光滑器的系统频率,ζk为待设计的系统阻尼,为系统的阻尼振荡周期,/>
设为航天器的初始指令四元数,[ε0 εT]T=[ε0 ε1 ε2 ε3]T为航天器的实际四元数,经过命令光滑器的前馈指令四元数/>由以下方法得到:
其中,[ε0(0) εT(0)]T代表实际四元数的初始值,*代表卷积运算;
步骤二中,所述确定航天器姿态的误差四元数,包括:
设为航天器的误差四元数,则所述误差四元数的定义为:
步骤三中,所述在航天器姿态参考坐标系下建立的航天器姿态运动学模型为:
G(ε0,ε)=[-ε,ε0I3-ε×];
其中,ω=[ω1 ω2 ω3]T为航天器角速度,[ε0 εT]T=[ε0 ε1 ε2 ε3]T为航天器的实际四元数,为[ε0 εT]T的一阶时间导数,满足约束条件/> I3为3×3的单位矩阵;
所述航天器动力学模型为:
其中,Jmb∈R3×3是正定对称的转动惯量矩阵,ω=[ω1 ω2 ω3]T为航天器姿态角速度,Td∈R3是系统受到的集总干扰,δi∈R3×3(i=1,2)是第i阶液体晃动对刚体航天器的耦合矩阵,F∈R3×3是柔性附件振动对刚体航天器的耦合矩阵,Ci∈R3×3、Ki∈R3×3(i=1,2)分别为第i阶液体晃动的阻尼矩阵与刚度矩阵,C3∈R3×3、K3∈R3×3分别为柔性附件振动的阻尼矩阵与刚度矩阵,mfi(i=1,2)为第i阶液体晃动的晃动质量,mf1、mf2分别为液体一阶晃动质量和液体二阶晃动质量,ηi∈R3(i=1,2)为第i阶液体晃动的晃动位移,η1为第一阶液体晃动位移,η2为第二阶液体晃动位移,ψi(i=1,2)为液体晃动方程中间变量,ψ1对应一阶液体晃动,ψ2对应二阶液体晃动,n∈R3为柔性附件的振动模态坐标,ζ为柔性附件振动方程中间变量,τ′∈R3为三轴施加的控制力矩;
步骤四中,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应已知的情况下设计航天器的姿态机动退步控制器τ1,使得闭环系统渐近稳定,并且闭环系统状态满足
所述通过建立的航天器模型设计航天器姿态机动退步控制器τ1,包括:
(1)设计退步变量x1、x2:
x1=ε,x2=ω-α;
其中,α为中间变量;
(2)设计中间变量α:
考虑Lyapunov方程
其中,k1=diag{k11 k12 k13}为一个待设计的正定对角矩阵;
则V1沿系统轨迹对时间的导数为:
设计α=-k2x1,k2为一个待设计的正常数,则可见x1≠0,x2=0,根据Lyapunov稳定性原理可知系统渐近稳定;
(3)设计航天器的姿态机动退步控制器τ1为:
其中,为退步法中待设计中间变量α的一阶时间导数,k3=diag{k31 k32 k33}为一个待设计的正定对角矩阵;
(4)考虑Lyapunov方程V2分析系统稳定性:
设
V2沿系统轨迹对时间的导数为:
将τ′带入得根据Lasalle最大不变集原理,系统内的状态变量最终会收敛到/>中,证明控制系统的稳定性;
步骤五中,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计状态变量的自适应更新律,设计航天器的自适应姿态机动退步控制器τ2,使得闭环系统渐近稳定,并且闭环系统状态满足
假设液体晃动响应以及柔性附件的振动响应是未知的,设 分别是ηi、ψi、n、ζ、Td无限接近的估计值;假设/> 分别是各状态变量的误差值;所述通过建立的航天器模型设计航天器自适应姿态机动退步控制器τ2,包括:
(1)设计状态变量的自适应更新律,估计真实的状态变量响应:
其中,Γ∈R3×3为待设计的对角正定矩阵;Pi(i=1,2)为待设计的对称正定矩阵,由以下公式得到:
其中,Qi(i=1,2)为任意的待设计的对称正定矩阵;
(2)根据状态变量的自适应更新律,设计航天器的姿态机动自适应退步控制器τ2为:
(3)考虑Lyapunov函数V3分析系统的稳定性:
V3沿系统轨迹对时间的导数为:
根据Lasalle最大不变集原理,系统渐近稳定;
步骤六中,目标是在角速度信息不可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计辅助观测器代替角速度信息进行反馈,设计航天器的自适应无角速度姿态机动退步控制器τ3,使得闭环系统渐近稳定,并且闭环系统状态满足
假设系统的角速度ω是不可用的,所述通过建立的航天器模型设计航天器自适应无角速度姿态机动退步控制器τ3,包括:
(1)设计角速度的辅助观测器:
其中,为设计的辅助观测器状态变量,λ为一个待设计的足够小的正数;
(2)用辅助观测器代替角速度进行反馈,确定角速度的代替式:
(3)将角速度的代替式带入状态变量的自适应更新律中,重新得到状态变量的自适应更新律:
(4)将角速度的代替式带入航天器的自适应退步控制器τ2中替换角速度ω,得到航天器的自适应无角速度姿态机动退步控制器τ3:
通过调整设计参数,系统状态在航天器的自适应无角速度姿态机动退步控制器τ3的作用下会收敛到零点的邻域内。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111524046.XA CN114229039B (zh) | 2021-12-14 | 2021-12-14 | 一种充液柔性航天器自适应无角速度复合控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111524046.XA CN114229039B (zh) | 2021-12-14 | 2021-12-14 | 一种充液柔性航天器自适应无角速度复合控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114229039A CN114229039A (zh) | 2022-03-25 |
CN114229039B true CN114229039B (zh) | 2023-09-15 |
Family
ID=80755584
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111524046.XA Active CN114229039B (zh) | 2021-12-14 | 2021-12-14 | 一种充液柔性航天器自适应无角速度复合控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114229039B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117648000B (zh) * | 2024-01-30 | 2024-04-09 | 北京航空航天大学 | 一种挠性充液卫星紧耦合抗干扰姿态控制方法 |
Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0046151A1 (de) * | 1980-08-19 | 1982-02-24 | Messerschmitt-Bölkow-Blohm Gesellschaft mit beschränkter Haftung | Vorrichtung zur Lagestabilisierung von elastischen Fahrzeugen |
US6339734B1 (en) * | 2000-02-22 | 2002-01-15 | Hughes Electronics Corporation | Method and apparatus for reducing spacecraft instrument induced jitter via multifrequency cancellation |
JP2004299541A (ja) * | 2003-03-31 | 2004-10-28 | Japan Space Forum | 宇宙機搭載ペイロードの振動・姿勢制御装置 |
JP2007302142A (ja) * | 2006-05-12 | 2007-11-22 | Nec Toshiba Space Systems Ltd | 柔軟構造物用姿勢マヌーバ時における姿勢制御データ生成方法、及びそれを適用した姿勢制御装置 |
CN101833337A (zh) * | 2010-06-09 | 2010-09-15 | 哈尔滨工业大学 | 一种带柔性附件航天器的姿态机动同时抑制振动的方法 |
CN103792945A (zh) * | 2014-01-26 | 2014-05-14 | 南京航空航天大学 | 一种充液航天器系统的姿态控制和燃料晃动抑制方法 |
CN105843237A (zh) * | 2016-03-22 | 2016-08-10 | 北京航空航天大学 | 一种用于抑制柔性振动的航天器姿态参考指令生成方法 |
US9694918B1 (en) * | 2016-05-26 | 2017-07-04 | Beihang University | Method for disturbance compensation based on sliding mode disturbance observer for spacecraft with large flexible appendage |
CN108536164A (zh) * | 2018-03-23 | 2018-09-14 | 哈尔滨工业大学深圳研究生院 | 挠性航天器无角速度测量的姿态控制方法 |
CN108958275A (zh) * | 2018-06-25 | 2018-12-07 | 南京理工大学 | 一种刚柔液耦合系统姿态控制器和机动路径联合优化方法 |
CN108958274A (zh) * | 2018-06-25 | 2018-12-07 | 南京理工大学 | 一种基于pso的刚柔液耦合系统姿态机动路径规划方法 |
CN110083171A (zh) * | 2019-04-30 | 2019-08-02 | 哈尔滨工业大学(深圳) | 挠性航天器的动态滑模姿态跟踪控制的方法及系统 |
CN110758774A (zh) * | 2019-10-25 | 2020-02-07 | 中国科学院数学与系统科学研究院 | 带有挠性附件和液体晃动航天器的自抗扰姿态控制方法 |
CN111498147A (zh) * | 2020-04-03 | 2020-08-07 | 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) | 挠性航天器的有限时间分段滑模姿态跟踪控制算法 |
CN112305917A (zh) * | 2020-11-04 | 2021-02-02 | 内蒙古工业大学 | 充液航天器的固定时间终端滑模鲁棒容错控制方法及装置 |
CN113306747A (zh) * | 2021-04-27 | 2021-08-27 | 上海卫星工程研究所 | 基于so(3)群的挠性航天器姿态稳定控制方法和系统 |
-
2021
- 2021-12-14 CN CN202111524046.XA patent/CN114229039B/zh active Active
Patent Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0046151A1 (de) * | 1980-08-19 | 1982-02-24 | Messerschmitt-Bölkow-Blohm Gesellschaft mit beschränkter Haftung | Vorrichtung zur Lagestabilisierung von elastischen Fahrzeugen |
US6339734B1 (en) * | 2000-02-22 | 2002-01-15 | Hughes Electronics Corporation | Method and apparatus for reducing spacecraft instrument induced jitter via multifrequency cancellation |
JP2004299541A (ja) * | 2003-03-31 | 2004-10-28 | Japan Space Forum | 宇宙機搭載ペイロードの振動・姿勢制御装置 |
JP2007302142A (ja) * | 2006-05-12 | 2007-11-22 | Nec Toshiba Space Systems Ltd | 柔軟構造物用姿勢マヌーバ時における姿勢制御データ生成方法、及びそれを適用した姿勢制御装置 |
CN101833337A (zh) * | 2010-06-09 | 2010-09-15 | 哈尔滨工业大学 | 一种带柔性附件航天器的姿态机动同时抑制振动的方法 |
CN103792945A (zh) * | 2014-01-26 | 2014-05-14 | 南京航空航天大学 | 一种充液航天器系统的姿态控制和燃料晃动抑制方法 |
CN105843237A (zh) * | 2016-03-22 | 2016-08-10 | 北京航空航天大学 | 一种用于抑制柔性振动的航天器姿态参考指令生成方法 |
US9694918B1 (en) * | 2016-05-26 | 2017-07-04 | Beihang University | Method for disturbance compensation based on sliding mode disturbance observer for spacecraft with large flexible appendage |
CN108536164A (zh) * | 2018-03-23 | 2018-09-14 | 哈尔滨工业大学深圳研究生院 | 挠性航天器无角速度测量的姿态控制方法 |
CN108958275A (zh) * | 2018-06-25 | 2018-12-07 | 南京理工大学 | 一种刚柔液耦合系统姿态控制器和机动路径联合优化方法 |
CN108958274A (zh) * | 2018-06-25 | 2018-12-07 | 南京理工大学 | 一种基于pso的刚柔液耦合系统姿态机动路径规划方法 |
CN110083171A (zh) * | 2019-04-30 | 2019-08-02 | 哈尔滨工业大学(深圳) | 挠性航天器的动态滑模姿态跟踪控制的方法及系统 |
CN110758774A (zh) * | 2019-10-25 | 2020-02-07 | 中国科学院数学与系统科学研究院 | 带有挠性附件和液体晃动航天器的自抗扰姿态控制方法 |
CN111498147A (zh) * | 2020-04-03 | 2020-08-07 | 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) | 挠性航天器的有限时间分段滑模姿态跟踪控制算法 |
CN112305917A (zh) * | 2020-11-04 | 2021-02-02 | 内蒙古工业大学 | 充液航天器的固定时间终端滑模鲁棒容错控制方法及装置 |
CN113306747A (zh) * | 2021-04-27 | 2021-08-27 | 上海卫星工程研究所 | 基于so(3)群的挠性航天器姿态稳定控制方法和系统 |
Non-Patent Citations (4)
Title |
---|
充液航天器大角度机动自适应无源控制;王宏伟;宋晓娟;李长杰;;空间科学学报(03);全文 * |
刚柔液耦合复杂航天器的建模与控制;杜卉;中国优秀硕士学位论文全文数据库工程科技II辑(第6期);全文 * |
挠性航天器大角度机动的振动抑制控制;刘军;韩潮;;系统仿真学报(07);全文 * |
朱锐 ; 郭毓 ; 王璐 ; 钟晨星.充液挠性航天器姿态机动控制的多目标优化.上海航天(中英文).2020,第11-17页. * |
Also Published As
Publication number | Publication date |
---|---|
CN114229039A (zh) | 2022-03-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Shao et al. | Neural adaptive control for MEMS gyroscope with full-state constraints and quantized input | |
Sun et al. | Fixed-time sliding mode disturbance observer-based nonsmooth backstepping control for hypersonic vehicles | |
Hu et al. | Model-free prescribed performance control for spacecraft attitude tracking | |
Ulrich et al. | Modeling and direct adaptive control of a flexible-joint manipulator | |
Ding et al. | Nonsmooth attitude stabilization of a flexible spacecraft | |
CN111596545B (zh) | 一种多输入多输出机械系统自适应容错预设性能控制方法 | |
CN107831655B (zh) | 微陀螺仪的分数阶自适应反演模糊滑模控制方法 | |
Cambera et al. | Input-state feedback linearization control of a single-link flexible robot arm moving under gravity and joint friction | |
CN108227504B (zh) | 微陀螺分数阶自适应模糊神经反演终端滑模控制方法 | |
CN108710296B (zh) | 微陀螺仪的分数阶自适应快速终端滑模控制方法 | |
Khan et al. | Control strategies for robotic manipulators | |
CN108762069B (zh) | 刚性航天器姿控系统飞轮故障辨识与调节方法 | |
Chen et al. | Nonlinear fault-tolerant control for hypersonic flight vehicle with multi-sensor faults | |
CN114229039B (zh) | 一种充液柔性航天器自适应无角速度复合控制方法 | |
Huang et al. | Output feedback control of underactuated spacecraft hovering in circular orbit with radial or in-track controller failure | |
Yang et al. | Study on the sliding mode fault tolerant predictive control based on multi agent particle swarm optimization | |
Hou et al. | Composite finite-time straight-line path-following control of an underactuated surface vessel | |
Kim et al. | Adaptive tracking control of flexible‐joint manipulators without overparametrization | |
Hu | Neural network‐based adaptive attitude tracking control for flexible spacecraft with unknown high‐frequency gain | |
CN112305917A (zh) | 充液航天器的固定时间终端滑模鲁棒容错控制方法及装置 | |
Cheong et al. | Linear PID composite controller and its tuning for flexible link robots | |
Zhang et al. | Nonsingular integral sliding mode attitude control for rigid‐flexible coupled spacecraft with high‐inertia rotating appendages | |
CN113485394B (zh) | 一种高精度固定时间收敛的相对姿态容错跟踪控制方法 | |
Choudhary et al. | Arbitrary time attitude stabilization and tracking of rigid body on SO (3) | |
Suoliang et al. | Finite-time robust control for inertially stabilized platform based on terminal sliding mode |
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 |