CN114229039B - 一种充液柔性航天器自适应无角速度复合控制方法 - Google Patents

一种充液柔性航天器自适应无角速度复合控制方法 Download PDF

Info

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
Application number
CN202111524046.XA
Other languages
English (en)
Other versions
CN114229039A (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.)
Inner Mongolia University of Technology
Original Assignee
Inner Mongolia University of Technology
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 Inner Mongolia University of Technology filed Critical Inner Mongolia University of Technology
Priority to CN202111524046.XA priority Critical patent/CN114229039B/zh
Publication of CN114229039A publication Critical patent/CN114229039A/zh
Application granted granted Critical
Publication of CN114229039B publication Critical patent/CN114229039B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • B64G1/245Attitude 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的作用下会收敛到零点的邻域内。
CN202111524046.XA 2021-12-14 2021-12-14 一种充液柔性航天器自适应无角速度复合控制方法 Active CN114229039B (zh)

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)

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

Citations (16)

* Cited by examiner, † Cited by third party
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)群的挠性航天器姿态稳定控制方法和系统

Patent Citations (16)

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

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