CN105843237A - 一种用于抑制柔性振动的航天器姿态参考指令生成方法 - Google Patents
一种用于抑制柔性振动的航天器姿态参考指令生成方法 Download PDFInfo
- Publication number
- CN105843237A CN105843237A CN201610164330.3A CN201610164330A CN105843237A CN 105843237 A CN105843237 A CN 105843237A CN 201610164330 A CN201610164330 A CN 201610164330A CN 105843237 A CN105843237 A CN 105843237A
- Authority
- CN
- China
- Prior art keywords
- attitude
- spacecraft
- modal
- frequency
- nis
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 48
- 230000033001 locomotion Effects 0.000 claims abstract description 53
- 238000013016 damping Methods 0.000 claims description 42
- 238000013461 design Methods 0.000 claims description 15
- 238000001914 filtration Methods 0.000 claims description 15
- 230000014509 gene expression Effects 0.000 claims description 11
- 230000008859 change Effects 0.000 claims description 5
- 230000002401 inhibitory effect Effects 0.000 claims description 5
- 238000005259 measurement Methods 0.000 abstract description 3
- 239000000306 component Substances 0.000 description 16
- 238000005516 engineering process Methods 0.000 description 12
- 230000015572 biosynthetic process Effects 0.000 description 8
- 238000003786 synthesis reaction Methods 0.000 description 8
- 238000004364 calculation method Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 5
- 239000011159 matrix material Substances 0.000 description 5
- 238000011160 research Methods 0.000 description 5
- 230000008569 process Effects 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000006870 function Effects 0.000 description 3
- 238000007493 shaping process Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 241000282414 Homo sapiens Species 0.000 description 2
- 238000013459 approach Methods 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 238000012938 design process Methods 0.000 description 2
- 230000005764 inhibitory process Effects 0.000 description 2
- 230000001629 suppression Effects 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 239000008358 core component Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000002045 lasting effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种用于抑制柔性振动的航天器姿态参考指令生成方法,采用由一系列脉冲叠加得到的前馈滤波器对航天器期望姿态角进行滤波,生成适用于PD形式姿态闭环负反馈控制的航天器姿态参考指令。其前馈滤波器由姿态运动滤波器和柔性振动滤波器卷积得到,需要根据每个姿态控制任务的要求以及测量或估计得到的姿态控制任务开始时刻的系统初始条件来在线进行有针对性的设计。期望姿态角经滤波器滤波后生成姿态角指令,与实际姿态信息一起输入给控制器,生成控制力矩,完成姿态控制。本发明适用于具有柔性结构体的航天器进行rest‑to‑rest机动、moving‑to‑rest机动或稳定控制的情况,可以实现在系统非零初始条件下完成姿态控制任务,并对不期望的柔性振动进行有效抑制。
Description
技术领域
本发明属于航天器控制技术研究领域,涉及具有固有柔性振动运动的结构体的航天器的姿态控制方法,尤其涉及具有严格的姿态指向精度要求、严格的姿态指向动态特性要求以及严格的结构体柔性运动动态特性要求的航天器的姿态参考指令生成方法。
背景技术
自二十世纪七十年代起,新兴的航天技术开始进入并迅速扩展到人类生活的许多方面,人造地球卫星、空间探测飞船、空间望远镜、载人航天器等多种多样的航天器进入太空,执行通信中继、气象观测、地球环境观测、空间科学探测等多种任务,极大地拓展了人类认识、探索、开发、利用和破坏自然的能力。总体来看,随着航天技术应用的日益广泛,对航天器系统的要求也越来越高。
姿态控制系统是航天器系统的核心组成部分之一,通常归入制导、导航与控制(GNC)分系统之中,主要原因在于姿态控制系统是制导系统与导航系统的执行者或执行者之一。姿态控制系统性能的高低直接影响整个航天器飞行任务的完成质量甚至成败。
具有固有柔性振动运动的航天器的控制是航天器姿态控制技术研究领域的持久热点与难点之一。其主要原因在于大多数航天器都需要大面积太阳电池阵列提供持久能源供应、复杂结构的天线提供通讯能力,这些结构不可避免的将不可忽略的柔性运动引入航天器系统。李果等人2008年在《空间控制技术与应用》上发表的题为《航天器控制若干技术问题的新进展》的论文中指出,具有固有柔性振动运动的航天器的姿态控制问题具有姿态动力学特性甚为复杂、姿态控制指标要求甚高、且要求姿态控制规律和姿态控制系统组成尽可能简单这三大特点。这些特点使得具有固有柔性振动运动的航天器的姿态控制问题至今未能得到很好的解决,需要继续探索能保持较高姿态指向精度和较高姿态稳定度的低阶控制器的设计方法。
解决具有固有柔性振动运动的航天器的姿态控制问题的途径很多。其中一种是直接在姿态控制规律设计时使用考虑了需要抑制的柔性振动运动的航天器姿态运动模型,其结果是姿态控制规律非常复杂且不利于实际应用。另外一种是利用不考虑柔性振动运动的航天器姿态运动模型设计刚体姿态控制规律,同时为需要抑制的柔性振动运动设计控制规律,并在设计过程中考虑或者不考虑上述两个控制规律的相互影响并加以改进。根据第二种解决途径所得结果往往具有较为简单的控制规律,但与第一种解决途径一样通常难以实现预期的控制性能要求。
在上述第二种解决途径中,为需要抑制的柔性振动运动设计控制规律的技术一般称为振动控制技术,并分为被动振动控制技术和主动振动控制技术两大类。由于可以在不改变柔性结构特性的条件下实现振动控制,主动振动控制技术中的一种得到了广泛专注。这种控制技术通过将一个预定控制指令按预定方案分解为两个或多个指令并在按预定方案确定的时刻分别施加到系统中进行控制,减弱了控制作用对系统中柔性振动运动的激励作用。哈尔滨工业大学的刘暾等人于1987年在国际学术会议PISSTA上发表的论文《Onoptimal strategy of maneuver of satellites with flexible appendages》公开了这种技术,并在随后的研究中命名为分力合成(component synthesis)技术。麻省理工学院的Singer等人于1988年9月12日申请、1990年4月10日获得授权的专利号4916635的美国专利《Shaping command inputs to minimize unwanted dynamics》公开了这种技术,并将其称为输入成形(input shaping)技术。因为利用这种技术时需要向控制系统中主动引入时滞环节,所以又可称之为时滞滤波(time delay flitting)技术。据称,输入成形技术已广泛应用于以起重机为代表的多种需要振动控制的产品中。
在具有固有柔性振动运动的航天器的控制系统中应用上述分力合成或称输入成形技术的研究已有许多公开的成果。这些研究大多面向航天器姿态控制性能的提高,特别是姿态控制稳定精度的提高,因此,多数只为航天器系统中需要抑制的柔性模态进行振动控制。特殊地,哈尔滨工业大学的原劲鹏等人于 2005年在《东南大学学报(自然科学版)》上的论文《输入成型在卫星喷气姿态机动控制中的应用》公开了一种为航天器姿态控制的主运动模态设计输入成形的方法;佐治亚理工学院的Huey于2006年在其博士学位论文《Theintelligent combination of input shaping and PID feedback control》中,哈尔滨工业大学的张建英等人于2008年在中国控制会议上发表的论文《分力合成主动振动抑制方法和闭环反馈控制的同时设计》中,分别公开了分力合成控制器/输入成形器与反馈控制联合设计的方法,且后者指出抑制航天器上的柔性振动需要同时为与航天器姿态运动和有关柔性振动运动相关的两个振动设计分力合成控制器。
在航天器的姿态闭环反馈控制中,姿态参考指令作为闭环系统的输入信号,对航天器的姿态指向精度和稳定度有着直接的影响。姿态参考指令的生成方式常见的有路径规划、前馈滤波等方法。其中路径规划方式多基于优化方法,或通过提高姿态路径的平滑性来提高航天器的姿态控制性能,往往对于系统的柔性振动抑制缺少明确的针对性;而前馈滤波方式则多基于系统的模态特性进行设计,属于直接的振动控制手段。因此,当用于对给定的柔性振动进行抑制时,前馈滤波是一种更为有效的姿态指令生成方式。输入成形器即是其中一种常用的前馈滤波方式。
但是需要指出的是,传统的分力合成控制器/输入成形器的设计均要求系统具有零初始条件,所以目前以此为基础的研究多数未考虑施加控制时航天器系统的初始条件,尤其是振动运动的初始条件的影响,而Veciana等人于2013年在《International Journalof Precision Engineering and Manufacturing》发表的论文《Minimizing residualvibrations for non-zero initial states:Application to an emergency stop of acrane》指出振动运动的初始条件严重影响输入成形技术的应用效果。在实际的航天器姿态控制任务中,很多情况下航天器的初始姿态角、初始姿态角速度、初始柔性振动模态坐标等状态量并不为零,并不能满足零初始条件的要求,因此传统的分力合成/输入成形设计方法不再适用。
发明内容
针对上述现有技术存在的不足,本发明针对具有柔性结构体的航天器,提出一种基于前馈滤波的航天器姿态参考指令生成方法,结合姿态闭环负反馈控制,可以适用于非零初始条件下的姿态控制任务,在完成姿态控制任务的同时,对不期望的柔性振动进行抑制。
为了解决上述技术问题,本发明的技术方案为:一种用于抑制柔性振动的航天器姿态参考指令生成方法,该方法适用于具有柔性结构体的航天器进行rest-to-rest机动、moving-to-rest机动或稳定控制的情况。
所述方法要求航天器的姿态控制规律是比例-微分(PD)形式的姿态负反馈控制律或者在给定条件下可视为比例-微分(PD)形式的姿态负反馈控制律;
对由姿态控制任务给定的期望姿态角θd进行前馈滤波,进行以下操作:
步骤1,根据航天器惯量和PD控制器参数确定系统的模态频率及阻尼比,包括姿态运动模态频率ω0、姿态运动模态阻尼比ξ0及若干阶柔性振动模态频率ω1、ω2、……,柔性振动模态阻尼比ξ1、ξ2、……;
步骤2,根据步骤1得到的模态频率及阻尼比、姿态控制任务的期望姿态角θd、测量或计算得到的航天器姿态控制任务开始时刻t0的初始姿态角θ(t0)、初始姿态角速度以及所要抑制的第l阶柔性振动的初始模态坐标ηl(t0)、初始模态坐标导数等信息,设计前馈滤波器NIS=NIS0*NISl,其中NIS0为航天器姿态运动滤波器,NISl为所要抑制的第l阶柔性振动滤波器,*为卷积符号,所述滤波器分别为一系列具有不同幅值Ai、作用在时刻ti的脉冲δ(t-ti)的叠加,以及一系列具有幅值Bj、作用在时刻tj的脉冲δ(t-tj)的叠加,具有如下表达式
其中,脉冲幅值Ai、Bj及脉冲施加时刻ti、tj由下列方程求解得到
其中,
ω0、ξ0、ωd0分别为航天器姿态运动模态的频率、阻尼比及阻尼频率,
ωl、ξl、ωdl分别为第l阶柔性振动模态的频率、阻尼比及阻尼频率,
K0、Kl、H0、Hl均为由模态参数ω0、ξ0、ωd0、ωl、ξl、ωdl,以及PD控制器参数等确定的系数;P0、Pl、Q0、Ql均为由模态参数ω0、ξ0、ωd0、ωl、ξl、ωdl,PD控制器参数以及初始条件θ(t0)、ηl(t0)、等共同确定的参数;
步骤3,以上述前馈滤波器NIS与由姿态控制任务给定的期望姿态角θd的卷积作为航天器姿态参考指令。
本发明的另一种技术方案为:一种用于抑制柔性振动的航天器姿态参考指令生成方法,该方法适用于具有柔性结构体的航天器进行rest-to-rest机动、moving-to-rest机动或稳定控制的情况。
所述方法要求航天器的姿态控制规律是比例-微分(PD)形式的姿态负反馈控制律或者在给定条件下可视为比例-微分(PD)形式的姿态负反馈控制律;
对由姿态控制任务给定的期望姿态角θd与姿态控制任务开始时刻t0的初始姿态角θ(t0)的差值θd-θ(t0)进行前馈滤波,进行以下操作:
步骤1a:根据航天器惯量和PD控制器参数确定系统的模态频率及阻尼比,包括姿态运动模态频率ω0、姿态运动模态阻尼比ξ0及若干阶柔性振动模态频率ω1、ω2、……,柔性振动模态阻尼比ξl、ξ2、……;
步骤2a:根据步骤1a得到的模态频率及阻尼比、姿态控制任务的期望姿态角θd、测量或计算得到的航天器姿态控制任务开始时刻t0的初始姿态角速度以及所要抑制的第l阶柔性振动的初始模态坐标ηl(t0)、初始模态坐标导数等信息,设计前馈滤波器NIS=NIS0*NISl,其中NIS0为航天器姿态运动滤波器,NISl为所要抑制的第l阶柔性振动滤波器,*为卷积符号,所述滤波器分别为一系列具有不同幅值Ai、作用在时刻ti的脉冲δ(t-ti)的叠加,以及一系列具有幅值Bj、作用在时刻tj的脉冲δ(t-tj)的叠加,具有如下表达式
其中,脉冲幅值Ai、Bj及脉冲施加时刻ti、tj由下列方程求解得到
其中,
ω0、ξ0、ωd0分别为航天器姿态运动模态的频率、阻尼比及阻尼频率,
ωl、ξl、ωdl分别为第l阶柔性振动模态的频率、阻尼比及阻尼频率,
K0、Kl、H0、Hl均为由模态参数ω0、ξ0、ωd0、ωl、ξl、ωdl,以及PD控制器参数等确定的系数;
P0、Pl、Q0、Ql均为由模态参数ω0、ξ0、ωd0、ωl、ξl、ωdl,PD控制器参数以及初始条件ηl(t0)、等共同确定的参数;
步骤3a:将由姿态控制任务的姿态角变化量θd-θ(t0)与前馈滤波器NIS进行卷积所得到的姿态角变化指令与初始姿态角θ(t0)相加,作为航天器姿态参考指令。
有益效果
本发明在航天器姿态参考指令前馈滤波器的设计中,充分考虑了控制任务开始时刻航天器姿态角、姿态角速度、振动模态坐标、振动模态坐标导数等多种初始条件的影响,很好地解决了传统分力合成控制器/输入成形器无法适用的非零初始条件下姿态控制问题,可以实现在完成姿态控制任务的同时,对不期望的柔性振动进行有效抑制。
附图说明
图1为本发明所适用的航天器姿态控制系统框图。
图2为采用本发明方法得到的期望姿态角指令曲线。
图3为采用本发明方法得到的航天器实际姿态角曲线。
图4为无前馈滤波下的航天器姿态角速度曲线。
图5为采用传统输入成形器下的航天器姿态角速度曲线。
图6为采用本发明方法得到的航天器姿态角速度曲线。
图7为无前馈滤波下的航天器1阶挠性模态坐标曲线。
图8为采用传统输入成形器下的航天器1阶挠性模态坐标曲线。
图9为采用本发明方法得到的航天器1阶挠性模态坐标曲线。
具体实施方式
下面结合附图与具体实施方式对本发明做进一步的详细描述。
如图1所示,本发明方案在航天器姿态控制回路中所处的位置为其中的虚线框部分,需要结合PD形式的姿态闭环负反馈控制。其中前馈滤波器需要引入姿态控制任务开始时刻的初始条件,包含航天器姿态角、姿态角速度、需要抑制的柔性模态坐标及其导数等,可以通过敏感器测量或估计得到。
为了更清楚地介绍本发明,首先结合带有柔性结构体的航天器姿态控制系统,说明本发明前馈滤波器的设计方法,以及实施步骤,再通过具体的实施例来验证本发明的有效性。
本发明的应用对象为具有柔性结构体的航天器,其动力学方程一般可用如下混合坐标方程描述:
其中,J为航天器的整体惯量,ω为航天器角速度,η=[η1,η2,...,ηm]T为柔性结构体的前m阶模态坐标构成的列阵,F为航天器本体与柔性结构体之间的耦合矩阵,Tc为控制力矩,Td为干扰力矩,Λ=diag[ζ1,ζ2,...,ζm]为柔性结构体的约束模态阻尼比对角阵,Ω=diag[Ω1,Ω2,...,Ωm]为柔性结构体的约束模态频率对角阵。
在姿态角度较小的情况下,忽略非线性耦合项的影响,可将航天器的动力学方程解耦。不考虑干扰力矩时,航天器单轴运动的动力学方程可以简化为如下形式
其中,J为航天器在该轴上的惯量,fl为F中的对应分量,θ为姿态角,Tc为控制力矩在该轴上的分量。
对于一般的开环控制而言,系统的输入量即为Tc,输出量根据控制要求,可以是θ也可以是ηl。在本发明中,使用的是姿态闭环负反馈控制,控制力矩具有如下表达式
或
其中,kp、kd为控制器参数。由于两种控制器在以后部分的计算过程类似,这里只以PD控制为例进行说明。
将控制力矩代入动力学方程中,有
此时,系统的输入量为期望姿态角θd,输出量为θ或ηl。为了有效抑制航天器的柔性振动,需要观察由θd到ηl的系统模型。
在考虑初始条件的情况下,将上述动力学方程进行拉氏变换,消去姿态角的拉氏变换Θ(s)后,可以推出,第l阶柔性模态坐标的拉氏变换Γl(s)具有如下表达式
其中,
可见,除了期望姿态角Θd(s)和初始条件θ(0)、ηl(0)、之外,第l阶柔性模态坐标还会受到其他阶柔性模态的影响。为了简化分析过程,当研究对航天器姿态控制影响比较大的柔性模态时,暂时忽略不同模态之间的相互影响,则模态坐标可以近似表达为
由于每个分项传递函数的分母均为Δl,其为s的4次多项式,可分解为两个二次多项式的乘积,如下
其中,ξ0、ξl、ω0、ωl为根据航天器闭环系统方程,求解系统矩阵特征根,得到的闭环系统模态阻尼比及模态频率。ξ0、ω0为航天器主运动模态,又可称为姿态运动模态;ξl、ωl为第l阶柔性模态。当相对航天器惯量J较小时,ξ0、ω0可以近似表达为
因此,Γl(s)的每个分项传递函数可以进一步分解为两个二阶系统传函,分别对应姿态运动模态和第l阶柔性模态:
其中,各分子项中的系数可由简单的代数运算得到。
gl=[gl1 gl2 gl3 gl4]T,dll1=[dll11 dll12 dll13 dll14]T,dll2=[dll21 dll22 dll23dll24]T
dll3=[dll31 dll32 dll33 dll34]T,dll4=[dll41 dll42 dll43 dll44]T
由此可知,模态坐标Γl(s)的响应中将同时包含姿态运动模态和第l阶柔性模态两种振动形式。若想要有效抑制振动,则需要同时抑制这两种模态下的振动。如此一来,就要考虑在系统初始条件不一定为零的情况下,如何使系统在输入θd下的响应振动为零,即令两种模态振动均为零。
针对这两种模态分别设计前馈滤波器。
对于姿态运动模态,若系统的初始输入为幅值为A0的阶跃信号,经前馈滤波器成形后,可以表达为
拉氏变换形式为
将上式代入式(7),只考虑姿态运动模态部分,进行拉氏反变换后,可以得到第l阶柔性模态坐标响应的姿态运动模态分量
其中,为姿态运动模态的阻尼频率,其余各项的表达式如下
由式(18)可以看出,若要使输入完成后,姿态运动模态分量无振动,必须令其中的振动项在t≥ti时刻振动幅值为0,由此可以推出第l阶柔性模态坐标响应姿态运动模态分量的零振动条件:
通过上式求解出ti、Ai,即可得到航天器的姿态运动滤波器
同理,对于第l阶柔性模态坐标的柔性模态分量,当系统的输入为幅值为B0的阶跃信号时,经前馈滤波器成形后,可以表达为
类似可以推出第l阶柔性模态坐标响应柔性模态分量的零振动条件:
其中,为柔性模态的阻尼频率;其余各项的表达式如下
通过式(25)求解tj、Bj,即可得到航天器的第l阶柔性振动滤波器
将姿态运动滤波器与柔性振动滤波器卷积,即可得到本发明前馈滤波器的完整形式
NIS=NIS0*NISl (30)
如果航天器姿态闭环负反馈部分采用的是微分先行PD控制器,由于其前馈滤波器的设计过程完全类似,只是其中个别系数略有不同,这里不再重复介绍。
上述说明中为表述方便,使用的初始条件为θ(0)、ηl(0)、若姿态控制任务的初始时刻为t0,则用θ(t0)、ηl(t0)、替换即可。
至此,已经完整说明了本发明的基本原理。下面为本发明的具体实施步骤。
步骤1,根据航天器惯量和控制器参数确定系统的模态频率及阻尼比。这里的模态频率及阻尼比可以是由闭环系统动力学方程计算得到的结果,也可以是由测量或估计得到的近似值。
如果采用计算方案,其大致过程如下:
将系统闭环动力学方程(5)改写为矩阵形式
其中,
写成状态方程形式,为
其中,
通过求解系统矩阵A的2m+2个特征根,就可得到闭环系统的模态频率和阻尼比。模态频率和阻尼比与系统的第l对共轭特征根之间有如下关系
其中,最低阶的ω0和ξ0为航天器的姿态运动模态,当相对航天器惯量J较小时,也可以用式(9)来近似。
步骤2,根据姿态控制任务要求,针对想要抑制的第l阶柔性模态,将航天器系统的初始条件、模态参数、控制器参数等相关量代入方程(22)、(23)、(25)、(29)、(30),计算得到前馈滤波器NIS。
当滤波器NIS0和NISl中的脉冲数n=2时,Ai、ti具有如下表达式:
A1=1-A2 (37)
Bj、tj具有如下表达式:
B1=1-B2 (40)
步骤3,将期望姿态角θd与前馈滤波器NIS卷积,生成航天器姿态参考指令,与测量得到的航天器姿态信息一起输入给控制器,生成控制力矩,作用于航天器,完成姿态控制。
特别地,为了可以更好地适用于期望姿态角θd=0的情况,本发明还可以对姿态控制任务的姿态角变化量θd-θ(t0)进行前馈滤波。在这种情况下,前馈滤波器计算过程中所使用的初始姿态角变为θ(t0)-θ(t0)=0,其余初始条件不变(航天器实际的初始姿态角依然为θ(t0),但在前馈滤波器计算过程中需要进行如此操作)。如此一来,可以对上述实施步骤进行如下变换,得到本发明的另一种实施方式:
步骤1a,同步骤1;
步骤2a,将步骤2中的式(22)、(25)变换为以下方程
其中,
其余部分同步骤2;
步骤3a,将由姿态控制任务的姿态角变化量θd-θ(t0)与前馈滤波器NIS进行卷积,得到姿态角变化指令,再与初始姿态角θ(t0)相加,作为航天器姿态参考指令。
下面结合某航天器姿态控制仿真结果对本方案作具体的说明。
实施例
选取某具有一对对称太阳帆板的卫星,假设该卫星采用微分先行PD控制器,整星惯量及PD控制器参数为
帆板的前3阶约束模态频率为0.51Hz、2.41Hz、3.15Hz,阻尼比为0.005。假设该卫星进行三轴稳定控制,初始姿态角、初始姿态角速度、期望姿态角分别为
[φd θd ψd]T=[0 0 0](°)
只考虑对卫星姿控影响较大的第1阶柔性模态,假定初始时刻的第1阶柔性模态坐标及模态坐标导数为
η1(0)=0.01,
其余阶柔性模态的初值均为0。
由步骤1计算得到,航天器闭环系统的三轴姿态运动模态分别为
ω0=[0.6103 0.6096 0.6077](rad/s),ξ0=[0.7064 0.7082 0.9066]
根据步骤2a计算前馈滤波器,设脉冲数n=2,由式(35)~(40)得滤波器
根据步骤3a,生成航天器姿态参考指令,进行整星数值仿真。仿真结果如图2至图9所示。
图2为期望姿态角经前馈滤波器滤波后生成的三轴指令姿态角曲线。实际的卫星姿态角曲线如图3所示,在10s左右三轴姿态角均已回到零值,很好的完成了姿态控制任务。图4~图6为卫星姿态角速度曲线,为了进行对比,分别给出了无前馈滤波,采用传统输入成形器进行前馈滤波,以及采用本发明控制方案的三种结果。可以看出,15s左右的姿态稳定度分别为0.03°/s、0.03°/s、0.005°/s,传统的输入成形方法对姿态稳定度几乎没有显示出改善效果,而应用本发明的控制方法则将姿态稳定度提高了近1个量级。图7~图9为卫星1阶柔性模态坐标曲线,同样给出了无前馈滤波、采用传统输入成形器进行前馈滤波、采用本发明控制方案的三种结果。可以看出,在10s左右,三种情况下的模态坐标最大振幅分别为0.02、0.008、0.002,传统的输入成形方法对柔性模态振动有一定的抑制作用,但效果非常有限,而应用本发明的控制方法则将柔性振动降低了1个量级。
以上结果充分说明,在非零初始条件下,应用本发明提供的航天器姿态参考指令生成方法,可以在实现姿态控制任务的同时,有效地抑制不期望的柔性振动,较传统的姿态控制方法具有更宽的适用性和 明显的优势。
以上所述仅是本发明的优选实施方式,对本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进,或者对其中部分技术特征进行等同替换,这些改进和替换也应视为本发明的保护范围。
Claims (2)
1.一种用于抑制柔性振动的航天器姿态参考指令生成方法,适用于具有柔性结构体的航天器进行姿态rest-to-rest机动、moving-to-rest机动或稳定控制,其特征在于:
航天器的姿态控制规律是比例-微分(PD)形式的姿态负反馈控制律或者在给定条件下可视为比例-微分(PD)形式的姿态负反馈控制律;
对由姿态控制任务给定的期望姿态角θd进行前馈滤波,进行以下操作:
步骤1:根据航天器惯量和PD控制器参数确定系统的模态频率及阻尼比,包括姿态运动模态频率ω0、姿态运动模态阻尼比ξ0及若干阶柔性振动模态频率ω1、ω2、……,柔性振动模态阻尼比ξ、ξ2、……;
步骤2:根据步骤1得到的模态频率及阻尼比、姿态控制任务的期望姿态角θd、测量或计算得到的航天器姿态控制任务开始时刻t0的初始姿态角θ(t0)、初始姿态角速度以及所要抑制的第l阶柔性振动的初始模态坐标ηl(t0)、初始模态坐标导数等信息,设计前馈滤波器NIS=NIS0*NISl,其中NIS0为航天器姿态运动滤波器,NISl为所要抑制的第l阶柔性振动滤波器,*为卷积符号,所述滤波器分别为一系列具有不同幅值Ai、作用在时刻ti的脉冲δ(t-ti)的叠加,以及一系列具有幅值Bj、作用在时刻tj的脉冲δ(t-tj)的叠加,具有如下表达式
其中,脉冲幅值Ai、Bj及脉冲施加时刻ti、tj由下列方程求解得到
其中,
ω0、ξ0、ωd0分别为航天器姿态运动模态的频率、阻尼比及阻尼频率,
ωl、ξl、ωdl分别为第l阶柔性振动模态的频率、阻尼比及阻尼频率,
K0、Kl、H0、Hl均为由模态参数ω0、ξ0、ωd0、ωl、ξl、ωdl,以及PD控制器参数等确定的系数;
P0、Pl、Q0、Ql均为由模态参数ω0、ξ0、ωd0、ωl、ξl、ωdl,PD控制器参数以及初始条件θ(t0)、ηl(t0)、等共同确定的参数;
步骤3:以上述前馈滤波器NIS与由姿态控制任务给定的期望姿态角θd的卷积作为航天器姿态参考指令。
2.一种用于抑制柔性振动的航天器姿态参考指令生成方法,适用于具有柔性结构体的航天器进行姿态rest-to-rest机动、moving-to-rest机动或稳定控制,其特征在于:
航天器的姿态控制规律是比例-微分(PD)形式的姿态负反馈控制律或者在给定条件下可视为比例-微 分(PD)形式的姿态负反馈控制律;
对由姿态控制任务给定的期望姿态角θd与姿态控制任务开始时刻t0的初始姿态角θ(t0)的差值θd-θ(t0)进行前馈滤波,进行以下操作:
步骤1a:根据航天器惯量和PD控制器参数确定系统的模态频率及阻尼比,包括姿态运动模态频率ω0、姿态运动模态阻尼比ξ0及若干阶柔性振动模态频率ω1、ω2、……,柔性振动模态阻尼比ξ1、ξ2、……;
步骤2a:根据步骤1a得到的模态频率及阻尼比、姿态控制任务的期望姿态角θd、测量或计算得到的航天器姿态控制任务开始时刻t0的初始姿态角速度以及所要抑制的第l阶柔性振动的初始模态坐标ηl(t0)、初始模态坐标导数等信息,设计前馈滤波器NIS=NIS0*NISl,其中NIS0为航天器姿态运动滤波器,NISl为所要抑制的第l阶柔性振动滤波器,*为卷积符号,所述滤波器分别为一系列具有不同幅值Ai、作用在时刻ti的脉冲δ(t-ti)的叠加,以及一系列具有幅值Bj、作用在时刻tj的脉冲δ(t-tj)的叠加,具有如下表达式
其中,脉冲幅值Ai、Bj及脉冲施加时刻ti、tj由下列方程求解得到
其中,
ω0、ξ0、ωd0分别为航天器姿态运动模态的频率、阻尼比及阻尼频率,
ωl、ξl、ωdl分别为第l阶柔性振动模态的频率、阻尼比及阻尼频率,
K0、Kl、H0、Hl均为由模态参数ω0、ξ0、ωd0、ωl、ξl、ωdl,以及PD控制器参数等确定的系数;
P0、Pl、Q0、Ql均为由模态参数ω0、ξ0、ωd0、ωl、ξl、ωdl,PD控制器参数以及初始条件ηl(t0)、等共同确定的参数;
步骤3a:将由姿态控制任务的姿态角变化量θd-θ(t0)与前馈滤波器NIS进行卷积所得到的姿态角变化指令与初始姿态角θ(t0)相加,作为航天器姿态参考指令。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610164330.3A CN105843237B (zh) | 2016-03-22 | 2016-03-22 | 一种用于抑制柔性振动的航天器姿态参考指令生成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610164330.3A CN105843237B (zh) | 2016-03-22 | 2016-03-22 | 一种用于抑制柔性振动的航天器姿态参考指令生成方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105843237A true CN105843237A (zh) | 2016-08-10 |
CN105843237B CN105843237B (zh) | 2017-07-04 |
Family
ID=56587693
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610164330.3A Expired - Fee Related CN105843237B (zh) | 2016-03-22 | 2016-03-22 | 一种用于抑制柔性振动的航天器姿态参考指令生成方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105843237B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444815A (zh) * | 2016-11-07 | 2017-02-22 | 上海航天控制技术研究所 | 一种单轴机动航天器的输入成型控制方法 |
CN107515612A (zh) * | 2017-10-20 | 2017-12-26 | 湖北航天技术研究院总体设计所 | 基于侧喷流控制的弹性振动抑制方法 |
CN107738273A (zh) * | 2017-10-16 | 2018-02-27 | 华南理工大学 | 一种基于输入整形器的机器人关节末端残余振动抑制方法 |
CN107756448A (zh) * | 2017-10-16 | 2018-03-06 | 华南理工大学 | 一种柔性关节‑柔性臂系统残余振动抑制的测试装置及方法 |
CN110209052A (zh) * | 2019-06-03 | 2019-09-06 | 北京控制工程研究所 | 一种面向挠性航天器模态参数在轨辨识激励信号设计方法 |
CN110550238A (zh) * | 2019-10-16 | 2019-12-10 | 中山大学 | 一种挠性卫星的闭环分力合成主动振动抑制方法 |
CN110799309A (zh) * | 2017-07-13 | 2020-02-14 | 优傲机器人公司 | 具有配置相关动力学的系统的振动控制 |
CN113119076A (zh) * | 2021-04-27 | 2021-07-16 | 华中科技大学 | 一种三自由度并联机构的姿态闭环反馈控制方法和系统 |
CN114215357A (zh) * | 2021-11-11 | 2022-03-22 | 浙江大学 | 基于输入整形与时滞补偿相结合的泵车臂架末端抑振方法 |
CN114229039A (zh) * | 2021-12-14 | 2022-03-25 | 内蒙古工业大学 | 一种充液柔性航天器自适应无角速度复合控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101833337A (zh) * | 2010-06-09 | 2010-09-15 | 哈尔滨工业大学 | 一种带柔性附件航天器的姿态机动同时抑制振动的方法 |
CN103076807A (zh) * | 2012-12-27 | 2013-05-01 | 北京航空航天大学 | 一种欠驱动柔性航天器姿态稳定的控制方法 |
-
2016
- 2016-03-22 CN CN201610164330.3A patent/CN105843237B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101833337A (zh) * | 2010-06-09 | 2010-09-15 | 哈尔滨工业大学 | 一种带柔性附件航天器的姿态机动同时抑制振动的方法 |
CN103076807A (zh) * | 2012-12-27 | 2013-05-01 | 北京航空航天大学 | 一种欠驱动柔性航天器姿态稳定的控制方法 |
Non-Patent Citations (3)
Title |
---|
孔宪仁: "基于输入成形的柔性航天器振动闭环抑制方法", 《振动与冲击》 * |
张国琪: "柔性航天器快速机动的自适应控制方法", 《空间控制技术与应用》 * |
齐乃明: "航天器喷气姿态机动分力合成抑制模态选取准则", 《宇航学报》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444815B (zh) * | 2016-11-07 | 2019-01-22 | 上海航天控制技术研究所 | 一种单轴机动航天器的输入成型控制方法 |
CN106444815A (zh) * | 2016-11-07 | 2017-02-22 | 上海航天控制技术研究所 | 一种单轴机动航天器的输入成型控制方法 |
CN110799309A (zh) * | 2017-07-13 | 2020-02-14 | 优傲机器人公司 | 具有配置相关动力学的系统的振动控制 |
CN110799309B (zh) * | 2017-07-13 | 2023-03-28 | 优傲机器人公司 | 具有配置相关动力学的系统的振动控制 |
CN107756448B (zh) * | 2017-10-16 | 2023-11-07 | 华南理工大学 | 一种柔性关节-柔性臂系统残余振动抑制的测试装置及方法 |
CN107738273A (zh) * | 2017-10-16 | 2018-02-27 | 华南理工大学 | 一种基于输入整形器的机器人关节末端残余振动抑制方法 |
CN107756448A (zh) * | 2017-10-16 | 2018-03-06 | 华南理工大学 | 一种柔性关节‑柔性臂系统残余振动抑制的测试装置及方法 |
CN107515612B (zh) * | 2017-10-20 | 2021-03-02 | 湖北航天技术研究院总体设计所 | 基于侧喷流控制的弹性振动抑制方法 |
CN107515612A (zh) * | 2017-10-20 | 2017-12-26 | 湖北航天技术研究院总体设计所 | 基于侧喷流控制的弹性振动抑制方法 |
CN110209052A (zh) * | 2019-06-03 | 2019-09-06 | 北京控制工程研究所 | 一种面向挠性航天器模态参数在轨辨识激励信号设计方法 |
CN110550238A (zh) * | 2019-10-16 | 2019-12-10 | 中山大学 | 一种挠性卫星的闭环分力合成主动振动抑制方法 |
CN113119076A (zh) * | 2021-04-27 | 2021-07-16 | 华中科技大学 | 一种三自由度并联机构的姿态闭环反馈控制方法和系统 |
CN113119076B (zh) * | 2021-04-27 | 2022-04-01 | 华中科技大学 | 一种三自由度并联机构的姿态闭环反馈控制方法和系统 |
CN114215357A (zh) * | 2021-11-11 | 2022-03-22 | 浙江大学 | 基于输入整形与时滞补偿相结合的泵车臂架末端抑振方法 |
CN114229039A (zh) * | 2021-12-14 | 2022-03-25 | 内蒙古工业大学 | 一种充液柔性航天器自适应无角速度复合控制方法 |
CN114229039B (zh) * | 2021-12-14 | 2023-09-15 | 内蒙古工业大学 | 一种充液柔性航天器自适应无角速度复合控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105843237B (zh) | 2017-07-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105843237B (zh) | 一种用于抑制柔性振动的航天器姿态参考指令生成方法 | |
Sigthorsson et al. | Robust linear output feedback control of an airbreathing hypersonic vehicle | |
Groves et al. | Reference command tracking for a linearized model of an air-breathing hypersonic vehicle | |
Gadewadikar et al. | H-infinity static output-feedback control for rotorcraft | |
CN106054884B (zh) | 基于神经网络的l1自适应船舶动力定位双环控制系统 | |
Banerjee et al. | Vibration reduction for flexible spacecraft following momentum dumping with/without slewing | |
Xia et al. | Robust adaptive super-twisting sliding mode formation controller for homing of multi-underactuated AUV recovery system with uncertainties | |
Jia et al. | Vibration control of gyroelastic spacecraft using input shaping and angular momentum devices | |
Mathavaraj et al. | Robust control of a reusable launch vehicle in reentry phase using model following neuro-adaptive design | |
Hu | Robust integral variable structure controller and pulse-width pulse-frequency modulated input shaper design for flexible spacecraft with mismatched uncertainty/disturbance | |
Sun et al. | Disturbance observer-based saturated fixed-time pose tracking for feature points of two rigid bodies | |
Kuznetsov et al. | Stability and hidden oscillations analysis of the spacecraft attitude control system using reaction wheels | |
CN113485396A (zh) | 一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法 | |
Andrievsky et al. | Hidden nonlinear oscillations in controlled aircraft with saturated inputs | |
Mooij | Model reference adaptive guidance for re-entry trajectory tracking | |
Godard et al. | Fault-tolerant stabilization of a tethered satellite system using offset control | |
Kamath et al. | Vision Augmented 3 DoF Quadrotor Control using a Non-singular Fast-terminal Sliding Mode Modified Super-twisting Controller | |
Chen et al. | L 1 adaptive controller design for hypersonic formation flight | |
Adami et al. | Control of a flexible, hypersonic scramjet vehicle using a differential algebraic approach | |
Wang et al. | Coupling Attitude Control for Flexible Spacecraft with Rotating Structure | |
Raj et al. | Robust higher-order sliding mode control systems for roll-coupled maneuvers of aircraft using output feedback | |
Mooij et al. | Stability analysis of an adaptive guidance and control system applied to a winged re-entry vehicle | |
Mooij et al. | Model verification of a satellite with large flexible appendages for control system design | |
Ton | Robust tracking control of a quadrotor in the presence of uncertainty and non-vanishing disturbance | |
Ton et al. | Robust tracking control of a quadrotor with time-varying gain in the presence of uncertainty and disturbances |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170704 |