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

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

Info

Publication number
CN114229039A
CN114229039A CN202111524046.XA CN202111524046A CN114229039A CN 114229039 A CN114229039 A CN 114229039A CN 202111524046 A CN202111524046 A CN 202111524046A CN 114229039 A CN114229039 A CN 114229039A
Authority
CN
China
Prior art keywords
spacecraft
angular velocity
adaptive
attitude
self
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
CN202111524046.XA
Other languages
English (en)
Other versions
CN114229039B (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

Images

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)本发明专利不需要增加额外的结构或者控制元件,所设计的基于前馈控制的命令光滑器可有效地抑制航天器机动过程中柔性附件的振动及液体燃料的晃动,所设计的复合控制策略方法简单可靠,只需要设计一个基频命令光华器就能抑制高于该频率的所有阶模态的振动。
发明内容
针对现有技术存在的问题,本发明提供了一种充液柔性航天器自适应无角速度复合控制方法,尤其涉及一种充液柔性航天器自适应无角速度复合控制方法及系统,旨在解决充液柔性航天器无角速度的控制问题以及液体晃动和柔性附件多模态振动的抑制问题。
本发明是这样实现的,一种充液柔性航天器自适应无角速度复合控制方法,其包括以下步骤:
步骤一,确定经过命令光滑器的前馈指令四元数
Figure BDA0003409275290000031
经过命令光滑器的前馈指令四元数相比于初始指令四元数能够有效降低航天器机动过程中液体晃动以及柔性附件振动的位移响应。
步骤二,确定航天器姿态的误差四元数;航天器姿态的误差四元数用于反馈控制。
步骤三,在航天器姿态参考坐标系下建立航天器姿态运动学模型及动力学模型;通过建立的航天器模型来设计后续的控制器。
步骤四,通过建立的航天器模型设计航天器姿态机动退步控制器τ;
步骤五,在τ的基础上通过建立的航天器模型设计航天器自适应姿态机动退步控制器τ2
步骤六,在τ2的基础上通过建立的航天器模型设计航天器自适应无角速度姿态机动退步控制器τ3
进一步,步骤一中,所述命令光滑器设计为:
Figure BDA0003409275290000032
其中,ωk为待设计的光滑器的系统频率,ζk为待设计的系统阻尼,
Figure BDA0003409275290000033
为系统的阻尼振荡周期,
Figure BDA0003409275290000034
Figure BDA0003409275290000041
为航天器的初始指令四元数,[ε0 εT]T=[ε0ε1 ε2 ε3]T为航天器的实际四元数,经过命令光滑器的前馈指令四元数
Figure BDA0003409275290000042
由以下方法得到:
Figure BDA0003409275290000043
其中,[ε0(0) εT(0)]T代表实际四元数的初始值,*代表卷积运算。
进一步,步骤二中,所述确定航天器姿态的误差四元数,包括:
Figure BDA0003409275290000044
为航天器的误差四元数,则所述误差四元数的定义为:
Figure BDA0003409275290000045
进一步,步骤三中,所述在航天器姿态参考坐标系下建立的航天器姿态运动学模型为:
Figure BDA0003409275290000046
G(ε0,ε)=[-ε,ε0I3×];
其中,ω=[ω1 ω2 ω3]T为航天器角速度,[ε0 εT]T=[ε0 ε1 ε2 ε3]T为航天器的实际四元数,满足约束条件
Figure BDA0003409275290000047
I3为3×3的单位矩阵。
所述航天器动力学模型为:
Figure BDA0003409275290000048
Figure BDA0003409275290000049
Figure BDA00034092752900000410
Figure BDA0003409275290000051
Figure BDA0003409275290000052
Figure BDA0003409275290000053
Figure BDA0003409275290000054
其中,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为三轴施加的控制力矩。
进一步,步骤四中,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应已知的情况下设计航天器的姿态机动退步控制器τ,使得闭环系统渐近稳定,并且闭环系统状态满足
Figure BDA0003409275290000055
所述通过建立的航天器模型设计航天器姿态机动退步控制器τ,包括:
(1)设计退步变量x1、x2
x1=ε,x2=ω-α;
其中,α为中间变量;
(2)设计中间变量α:
考虑Lyapunov方程
Figure BDA0003409275290000056
其中,k1=diag{k11 k12 k13}为一个待设计的正定对角矩阵;
则V1沿系统轨迹对时间的导数为:
Figure BDA0003409275290000057
设计α=-k2x1,k2为一个待设计的正常数,则可见x1≠0,x2=0,
Figure BDA0003409275290000058
根据Lyapunov稳定性原理可知系统渐近稳定;
(3)确定航天器的姿态机动退步控制器τ为:
Figure BDA0003409275290000061
其中,k3=diag{k31 k32 k33}为一个待设计的正定对角矩阵;
(4)考虑Lyapunov方程V2分析系统稳定性:
Figure BDA0003409275290000062
V2沿系统轨迹对时间的导数为:
Figure BDA0003409275290000063
将τ带入得
Figure BDA0003409275290000064
根据Lasalle最大不变集原理,系统内的状态变量最终会收敛到
Figure BDA0003409275290000065
中,证明控制系统的稳定性。
进一步,步骤五中,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计状态变量的自适应更新律,设计航天器的自适应姿态机动退步控制器τ2,使得闭环系统渐近稳定,并且闭环系统状态满足
Figure BDA0003409275290000066
假设液体晃动响应以及柔性附件的振动响应是未知的,设
Figure BDA0003409275290000067
Figure BDA0003409275290000068
分别是ηi、ψi、n、ζ、Td无限接近的估计值;假设
Figure BDA0003409275290000069
Figure BDA00034092752900000610
分别是各状态变量的误差值;所述通过建立的航天器模型设计航天器自适应姿态机动退步控制器τ2,包括:
(1)设计状态变量的自适应更新律,估计真实的状态变量响应:
Figure BDA00034092752900000611
Figure BDA0003409275290000071
Figure BDA0003409275290000072
其中,Γ∈R3×3为待设计的对角正定矩阵;Pi为待设计的对称正定矩阵,由以下公式得到:
Figure BDA0003409275290000073
其中,Qi为任意的待设计的对称正定矩阵;
(2)根据状态变量的自适应更新律,设计航天器的姿态机动自适应退步控制器τ2为:
Figure BDA0003409275290000074
(3)考虑Lyapunov函数V3分析系统的稳定性:
Figure BDA0003409275290000075
V3沿系统轨迹对时间的导数为:
Figure BDA0003409275290000076
根据Lasalle最大不变集原理,系统渐近稳定。
进一步,步骤六中,目标是在角速度信息不可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计辅助观测器代替角速度信息进行反馈,设计航天器的自适应无角速度姿态机动退步控制器τ3,使得闭环系统渐近稳定,并且闭环系统状态满足
Figure BDA0003409275290000077
假设系统的角速度ω是不可用的,所述通过建立的航天器模型设计航天器自适应无角速度姿态机动退步控制器τ3,包括:
(1)设计角速度的辅助观测器:
Figure BDA0003409275290000081
其中,
Figure BDA0003409275290000082
为设计的辅助观测器状态变量,λ为一个待设计的足够小的正数;
(2)用辅助观测器代替角速度进行反馈,确定角速度的代替式:
Figure BDA0003409275290000083
(3)将角速度的代替式带入状态变量的自适应更新律中,重新得到状态变量的自适应更新律:
Figure BDA0003409275290000084
Figure BDA0003409275290000085
Figure BDA0003409275290000086
(4)将角速度的代替式带入航天器的自适应退步控制器τ2中替换角速度ω,得到航天器的自适应无角速度姿态机动退步控制器τ3
Figure BDA0003409275290000087
通过调整设计参数,系统状态在航天器的自适应无角速度姿态机动退步控制器τ3的作用下会收敛到零点的邻域内。
结合上述的所有技术方案,本发明所具备的优点及积极效果为:本发明提供的多体充液柔性航天器自适应无角速度复合控制方法,属于耦合航天器自适应无角速度控制技术领域,尤其涉及一种充液柔性航天器自适应无角速度复合控制方法。本发明针对航天器的高精密姿态机动任务,应用退步控制方法设计了一种充液柔性航天器自适应无角速度复合控制方法,设计了命令光滑器有效地减小了姿态机动时产生的多模态的液体晃动位移响应和柔性附件振动响应,设计了角速度观测器有效地代替角速度信息实现了航天器姿态机动的渐近稳定。本发明所设计的控制器不依赖于航天器的姿态角速度,同时在不需要增加额外的结构及控制元件的情况下抑制柔性附件及液体燃料在航天器机动过程中的残余振动,为航天器的控制提供一种新的思路,具有重要的理论意义及工程实际应用价值。
针对航天器的姿态机动控制及其液体燃料晃动以及柔性附件振动的抑制问题,本发明采用退步控制方法,设计了角速度观测器代替角速度信息进行反馈控制,设计了命令光滑器对航天器在姿态机动过程中的液体晃动以及柔性附件的振动进行前馈抑制控制,解决了充液柔性航天器在角速度信息不可用的情况下的姿态机动的稳定性控制问题,同时有效且显著地削弱了机动过程中液体燃料的晃动位移响应以及柔性附件的振动位移响应。
本发明可有效地解决充液柔性航天器在角速度不可用、系统状态变量未知且受到外部干扰力矩的作用的情况下的姿态机动的稳定性控制问题;本发明可有效且显著地降低多模态的液体燃料晃动响应位移和柔性附件的振动响应位移,减小航天器在姿态机动过程中的抖振;本发明设计的状态变量的自适应更新律能够有效且精准地估计真实状态变量的响应结果;本发明设计的角速度观测器能够有效且准确地模拟到角速度的变化响应。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对本发明实施例中所需要使用的附图做简单的介绍,显而易见地,下面所描述的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的一种充液柔性航天器自适应无角速度复合控制方法流程图。
图2是本发明实施例提供的一种充液柔性航天器自适应无角速度复合控制方法原理图。
图3是本发明实施例提供的前馈指令四元数曲线示意图。
图4是本发明实施例提供的实际四元数曲线示意图。
图5是本发明实施例提供的角速度曲线示意图。
图6是本发明实施例提供的控制力矩曲线示意图。
图7是本发明实施例提供的第一阶液体晃动实际值与估计值的对比曲线图。
图8是本发明实施例提供的第二阶液体晃动实际值与估计值的对比曲线图。
图9是本发明实施例提供的前三阶柔性附件振动的模态坐标的实际值与估计值的对比曲线示意图。
图10是本发明实施例提供的在初始指令四元数和前馈指令四元数的作用下的第一阶液体晃动响应的对比曲线示意图。
图11是本发明实施例提供的在初始指令四元数和前馈指令四元数的作用下的前三阶柔性附件振动模态的模态坐标响应的对比曲线示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
针对现有技术存在的问题,本发明提供了一种充液柔性航天器自适应无角速度复合控制方法,下面结合附图对本发明作详细的描述。
如图1所示,本发明实施例提供的一种充液柔性航天器自适应无角速度复合控制方法包括以下步骤:
S101,确定经过命令光滑器的前馈指令四元数;
S102,确定航天器姿态的误差四元数;
S103,在航天器姿态参考坐标系下建立航天器姿态运动学模型及动力学模型;
S104,通过建立的航天器模型设计航天器姿态机动退步控制器τ;
S105,通过建立的航天器模型设计航天器自适应姿态机动退步控制器τ2
S106,通过建立的航天器模型设计航天器自适应无角速度姿态机动退步控制器τ3
本发明实施例提供的充液柔性航天器自适应无角速度复合控制方法原理图如图2所示。
下面结合具体实施例对本发明的技术方案作进一步描述。
如图2所示,本发明实施例提供的一种充液柔性航天器自适应无角速度复合控制方法包括以下步骤:
步骤S1、确定经过命令光滑器的前馈指令四元数
Figure BDA0003409275290000111
命令光滑器设计为:
Figure BDA0003409275290000112
其中,ωk为待设计的光滑器的系统频率,ζk为待设计的系统阻尼,
Figure BDA0003409275290000113
为系统的阻尼振荡周期,
Figure BDA0003409275290000114
如图2所示,设
Figure BDA0003409275290000115
为航天器的初始指令四元数,[ε0εT]T=[ε0 ε1 ε2 ε3]T为航天器的实际四元数,经过命令光滑器的前馈指令四元数
Figure BDA0003409275290000121
由以下方法得到:
Figure BDA0003409275290000122
其中[ε0(0) εT(0)]T代表实际四元数的初始值,*代表卷积运算。
步骤S2、确定航天器姿态的误差四元数。设
Figure BDA0003409275290000123
为航天器的误差四元数,误差四元数的定义为
Figure BDA0003409275290000124
S3、在航天器姿态参考坐标系下建立航天器姿态运动学模型及动力学模型,所述在航天器姿态参考坐标系下建立的航天器姿态运动学模型为:
Figure BDA0003409275290000125
G(ε0,ε)=[-ε,ε0I3×]
其中,ω=[ω1 ω2 ω3]T为航天器角速度,[ε0 εT]T=[ε0 ε1 ε2 ε3]T为航天器的实际四元数,其满足约束条件
Figure BDA0003409275290000126
航天器动力学模型为:
Figure BDA0003409275290000127
Figure BDA0003409275290000128
Figure BDA0003409275290000129
Figure BDA00034092752900001210
Figure BDA00034092752900001211
Figure BDA00034092752900001212
Figure BDA00034092752900001213
其中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、通过建立的航天器模型设计航天器的姿态机动退步控制器τ,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应已知的情况下设计航天器的姿态机动退步控制器τ,使得闭环系统渐近稳定,并且闭环系统状态满足
Figure BDA0003409275290000131
S5、通过建立的航天器模型设计航天器的自适应姿态机动退步控制器τ2,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计状态变量的自适应更新律,设计航天器的自适应姿态机动退步控制器τ2,使得闭环系统渐近稳定,并且闭环系统状态满足
Figure BDA0003409275290000132
Figure BDA0003409275290000133
S6、通过建立的航天器模型设计航天器的自适应无角速度姿态机动退步控制器τ3,目标是在角速度信息不可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计辅助观测器代替角速度信息进行反馈,设计航天器的自适应无角速度姿态机动退步控制器τ3,使得闭环系统渐近稳定,并且闭环系统状态满足
Figure BDA0003409275290000134
进一步的,所述步骤S2中,命令光滑器设计为:
Figure BDA0003409275290000135
其中,ωk为待设计的光滑器的系统频率,ζk为待设计的系统阻尼,
Figure BDA0003409275290000141
为系统的阻尼振荡周期,
Figure BDA0003409275290000142
Figure BDA0003409275290000143
为航天器的初始指令四元数,经过命令光滑器的前馈指令四元数
Figure BDA0003409275290000144
由以下方法得到:
Figure BDA0003409275290000145
其中[ε0(0) εT(0)]T代表初始的实际四元数,*代表卷积运算。
进一步的,所述步骤S4中,航天器的姿态机动退步控制器τ的设计步骤进一步包含:
S4.1、设计退步变量x1、x2
x1=ε,x2=ω-α
其中α为中间变量;
S4.2、设计中间变量α
考虑Lyapunov方程
Figure BDA0003409275290000146
其中k1=diag{k11 k12 k13}为一个待设计的正定对角矩阵;
则V1沿系统轨迹对时间的导数为:
Figure BDA0003409275290000147
设计α=-k2x1,k2为一个待设计的正常数,则可见x1≠0,x2=0,
Figure BDA0003409275290000148
根据Lyapunov稳定性原理可知系统渐近稳定;
S4.3、确定航天器的姿态机动退步控制器τ为:
Figure BDA0003409275290000149
其中k3=diag{k31 k32 k33}为一个待设计的正定对角矩阵;
S4.4、考虑Lyapunov方程V2分析系统稳定性
Figure BDA0003409275290000151
V2沿系统轨迹对时间的导数为:
Figure BDA0003409275290000152
将τ带入得
Figure BDA0003409275290000153
根据Lasalle最大不变集原理,系统内的状态变量最终会收敛到
Figure BDA0003409275290000154
中,证明了控制系统的稳定性。
进一步的,所属步骤S5中,假设液体晃动响应以及柔性附件的振动响应是未知的,设
Figure BDA0003409275290000155
分别是ηi、ψi、n、ζ、Td无限接近的估计值;假设
Figure BDA0003409275290000156
可见
Figure BDA0003409275290000157
eη、eψ、en、eζ分别是各状态变量的误差值;
所述步骤S5进一步包含:
S5.1、为了估计真实的状态变量响应,设计状态变量的自适应更新律:
Figure BDA0003409275290000158
Figure BDA0003409275290000159
Figure BDA00034092752900001510
其中Γ∈R3×3为待设计的对角正定矩阵;Pi为待设计的对称正定矩阵,由以下公式得到:
Figure BDA00034092752900001511
Qi为任意的待设计的对称正定矩阵;
S5.2、根据状态变量的自适应更新律,设计航天器的姿态机动自适应退步控制器τ2为:
Figure BDA0003409275290000161
S5.3、考虑Lyapunov函数V3分析系统的稳定性:
Figure BDA0003409275290000162
V3沿系统轨迹对时间的导数为:
Figure BDA0003409275290000163
根据Lasalle最大不变集原理,系统渐近稳定。
进一步的,所述步骤S6中,假设系统的角速度ω是不可用的,
所述步骤S6进一步包含:
S6.1、设计角速度的辅助观测器
Figure BDA0003409275290000164
其中
Figure BDA0003409275290000165
为设计的辅助观测器状态变量,λ为一个待设计的足够小的正数;
S6.2、用辅助观测器代替角速度进行反馈,确定角速度的代替式
Figure BDA0003409275290000166
S6.3、将角速度的代替式带入状态变量的自适应更新律中,重新得到状态变量的自适应更新律:
Figure BDA0003409275290000167
Figure BDA0003409275290000171
Figure BDA0003409275290000172
S6.4、将角速度的代替式带入航天器的自适应退步控制器τ2中替换角速度ω,得到航天器的自适应无角速度姿态机动退步控制器τ3
Figure BDA0003409275290000173
通过调整设计参数,系统状态在航天器的自适应无角速度姿态机动退步控制器τ3的作用下会收敛到零点的邻域内。
下面以实际案例仿真说明实施方案的有效性。以某观测卫星作为被控对象,采用本发明的控制方法,验证其有效性。
假设航天器绕欧拉轴
Figure BDA0003409275290000174
进行θ=90°的姿态机动,初始角速度为ω(0)=[0 0 0]T,实际四元数的初始值为ε(0)=[0.7071 0.2626 -0.5252 0.3939]T,初始指令四元数为εc0=1,εc=[0 0 0]T,液体晃动位移以及柔性附件振动位移的初始值均为0。航天器的惯性矩阵为
Figure BDA0003409275290000175
干扰力矩为
Figure BDA0003409275290000176
航天器模型以及控制器内其他参数为:
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},
Figure BDA0003409275290000181
Γ=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 (7)

1.一种充液柔性航天器自适应无角速度复合控制方法,其特征在于,所述充液柔性航天器自适应无角速度复合控制方法包括以下步骤:
步骤一,确定经过命令光滑器的前馈指令四元数
Figure FDA0003409275280000011
步骤二,确定航天器姿态的误差四元数;
步骤三,在航天器姿态参考坐标系下建立航天器姿态运动学模型及动力学模型;
步骤四,通过建立的航天器模型设计航天器姿态机动退步控制器τ;
步骤五,通过建立的航天器模型设计航天器自适应姿态机动退步控制器τ2
步骤六,通过建立的航天器模型设计航天器自适应无角速度姿态机动退步控制器τ3
2.如权利要求1所述的一种充液柔性航天器自适应无角速度复合控制方法,其特征在于,步骤一中,所述命令光滑器设计为:
Figure FDA0003409275280000012
其中,ωk为待设计的光滑器的系统频率,ζk为待设计的系统阻尼,
Figure FDA0003409275280000013
为系统的阻尼振荡周期,
Figure FDA0003409275280000014
Figure FDA0003409275280000015
为航天器的初始指令四元数,[ε0 εT]T=[ε0 ε1 ε2ε3]T为航天器的实际四元数,经过命令光滑器的前馈指令四元数
Figure FDA0003409275280000017
由以下方法得到:
Figure FDA0003409275280000016
其中,[ε0(0) εT(0)]T代表实际四元数的初始值,*代表卷积运算。
3.如权利要求1所述的一种充液柔性航天器自适应无角速度复合控制方法,其特征在于,步骤二中,所述确定航天器姿态的误差四元数,包括:
Figure FDA00034092752800000212
为航天器的误差四元数,则所述误差四元数的定义为:
Figure FDA0003409275280000021
4.如权利要求1所述的一种充液柔性航天器自适应无角速度复合控制方法,其特征在于,步骤三中,所述在航天器姿态参考坐标系下建立的航天器姿态运动学模型为:
Figure FDA0003409275280000022
G(ε0,ε)=[-ε,ε0I3×];
其中,ω=[ω1 ω2 ω3]T为航天器角速度,[ε0 εT]T=[ε0 ε1 ε2 ε3]T为航天器的实际四元数,满足约束条件
Figure FDA0003409275280000023
Figure FDA0003409275280000024
I3为3×3的单位矩阵。
所述航天器动力学模型为:
Figure FDA0003409275280000025
Figure FDA0003409275280000026
Figure FDA0003409275280000027
Figure FDA0003409275280000028
Figure FDA0003409275280000029
Figure FDA00034092752800000210
Figure FDA00034092752800000211
其中,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为三轴施加的控制力矩。
5.如权利要求1所述的一种充液柔性航天器自适应无角速度复合控制方法,其特征在于,步骤四中,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应已知的情况下设计航天器的姿态机动退步控制器τ,使得闭环系统渐近稳定,并且闭环系统状态满足
Figure FDA0003409275280000031
所述通过建立的航天器模型设计航天器姿态机动退步控制器τ,包括:
(1)设计退步变量x1、x2
x1=ε,x2=ω-α;
其中,α为中间变量;
(2)设计中间变量α:
考虑Lyapunov方程
Figure FDA0003409275280000032
其中,k1=diag{k11 k12 k13}为一个待设计的正定对角矩阵;
则V1沿系统轨迹对时间的导数为:
Figure FDA0003409275280000033
设计α=-k2x1,k2为一个待设计的正常数,则可见x1≠0,x2=0,
Figure FDA0003409275280000034
根据Lyapunov稳定性原理可知系统渐近稳定;
(3)设计航天器的姿态机动退步控制器τ为:
Figure FDA0003409275280000035
其中,k3=diag{k31 k32 k33}为一个待设计的正定对角矩阵;
(4)考虑Lyapunov方程V2分析系统稳定性:
Figure FDA0003409275280000041
V2沿系统轨迹对时间的导数为:
Figure FDA0003409275280000042
将τ带入得
Figure FDA0003409275280000043
根据Lasalle最大不变集原理,系统内的状态变量最终会收敛到
Figure FDA0003409275280000044
中,证明控制系统的稳定性。
6.如权利要求1所述的一种充液柔性航天器自适应无角速度复合控制方法,其特征在于,步骤五中,目标是在角速度信息可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计状态变量的自适应更新律,设计航天器的自适应姿态机动退步控制器τ2,使得闭环系统渐近稳定,并且闭环系统状态满足
Figure FDA0003409275280000045
假设液体晃动响应以及柔性附件的振动响应是未知的,设
Figure FDA0003409275280000046
Figure FDA0003409275280000047
分别是ηi、ψi、n、ζ、Td无限接近的估计值;假设
Figure FDA0003409275280000048
Figure FDA0003409275280000049
分别是各状态变量的误差值;所述通过建立的航天器模型设计航天器自适应姿态机动退步控制器τ2,包括:
(1)设计状态变量的自适应更新律,估计真实的状态变量响应:
Figure FDA00034092752800000410
Figure FDA00034092752800000411
Figure FDA00034092752800000412
其中,Γ∈R3×3为待设计的对角正定矩阵;Pi为待设计的对称正定矩阵,由以下公式得到:
Figure FDA0003409275280000051
其中,Qi为任意的待设计的对称正定矩阵;
(2)根据状态变量的自适应更新律,设计航天器的姿态机动自适应退步控制器τ2为:
Figure FDA0003409275280000052
(3)考虑Lyapunov函数V3分析系统的稳定性:
Figure FDA0003409275280000053
V3沿系统轨迹对时间的导数为:
Figure FDA0003409275280000054
根据Lasalle最大不变集原理,系统渐近稳定。
7.如权利要求1所述的一种充液柔性航天器自适应无角速度复合控制方法,其特征在于,步骤六中,目标是在角速度信息不可用、液体晃动响应以及柔性附件的振动响应未知的情况下设计辅助观测器代替角速度信息进行反馈,设计航天器的自适应无角速度姿态机动退步控制器τ3,使得闭环系统渐近稳定,并且闭环系统状态满足
Figure FDA0003409275280000055
假设系统的角速度ω是不可用的,所述通过建立的航天器模型设计航天器自适应无角速度姿态机动退步控制器τ3,包括:
(1)设计角速度的辅助观测器:
Figure FDA0003409275280000061
其中,
Figure FDA0003409275280000062
为设计的辅助观测器状态变量,λ为一个待设计的足够小的正数;
(2)用辅助观测器代替角速度进行反馈,确定角速度的代替式:
Figure FDA0003409275280000063
(3)将角速度的代替式带入状态变量的自适应更新律中,重新得到状态变量的自适应更新律:
Figure FDA0003409275280000064
Figure FDA0003409275280000065
Figure FDA0003409275280000066
(4)将角速度的代替式带入航天器的自适应退步控制器τ2中替换角速度ω,得到航天器的自适应无角速度姿态机动退步控制器τ3
Figure FDA0003409275280000067
通过调整设计参数,系统状态在航天器的自适应无角速度姿态机动退步控制器τ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 true CN114229039A (zh) 2022-03-25
CN114229039B 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)

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 (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
刘军;韩潮;: "挠性航天器大角度机动的振动抑制控制", 系统仿真学报, no. 07 *
朱锐; 郭毓; 王璐; 钟晨星: "充液挠性航天器姿态机动控制的多目标优化", 上海航天(中英文), pages 11 - 17 *
杜卉: "刚柔液耦合复杂航天器的建模与控制", 中国优秀硕士学位论文全文数据库工程科技II辑, no. 6 *
王宏伟;宋晓娟;李长杰;: "充液航天器大角度机动自适应无源控制", 空间科学学报, no. 03 *

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
CN114229039B (zh) 2023-09-15

Similar Documents

Publication Publication Date Title
Sun et al. Fixed-time sliding mode disturbance observer-based nonsmooth backstepping control for hypersonic vehicles
Hiramoto et al. Optimal sensor/actuator placement for active vibration control using explicit solution of algebraic Riccati equation
Hu et al. Model-free prescribed performance control for spacecraft attitude tracking
CN107831655B (zh) 微陀螺仪的分数阶自适应反演模糊滑模控制方法
CN107703742B (zh) 一种柔性航天器传感器故障调节方法
Ding et al. Nonsmooth attitude stabilization of a flexible spacecraft
Khan et al. Control strategies for robotic manipulators
CN108227504B (zh) 微陀螺分数阶自适应模糊神经反演终端滑模控制方法
CN108710296B (zh) 微陀螺仪的分数阶自适应快速终端滑模控制方法
CN114047773B (zh) 一种基于扩张状态观测器的水下集矿机器人反步滑模自适应姿态控制方法
CN108762069B (zh) 刚性航天器姿控系统飞轮故障辨识与调节方法
CN113619814B (zh) 一种交会对接最后逼近段相对姿轨耦合控制方法
CN113859589B (zh) 一种基于模型预测控制与滑模控制的航天器姿态控制方法
CN114229039A (zh) 一种充液柔性航天器自适应无角速度复合控制方法
Zhang et al. Adaptive disturbance observer-based dual-loop integral-type fast terminal sliding mode control for micro spacecraft and its gimbal tracking device
Erdong et al. Robust attitude tracking control of flexible spacecraft for achieving globally asymptotic stability
Zhang et al. Attitude tracking control reconfiguration for space launch vehicle with thrust loss fault
CN115933725B (zh) 一种刚柔液耦合航天器高精度姿态控制方法
Zhang et al. Finite-time attitude optimization maneuver control for coupled spacecraft under attitude measurement errors and actuator faults
CN112305917A (zh) 充液航天器的固定时间终端滑模鲁棒容错控制方法及装置
CN113485396B (zh) 一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法
CN113485394B (zh) 一种高精度固定时间收敛的相对姿态容错跟踪控制方法
Zhang et al. Nonsingular integral sliding mode attitude control for rigid‐flexible coupled spacecraft with high‐inertia rotating appendages
Sun et al. Finite-time integrated target tracking for spacecraft with two-dimensional turntable under performance constraints
Zhang et al. Adaptive nonlinear control for the stabilized platform with disturbance and input saturation

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