CN114371610B - 多矢量螺旋桨组合浮空器故障诊断和容错控制***及方法 - Google Patents
多矢量螺旋桨组合浮空器故障诊断和容错控制***及方法 Download PDFInfo
- Publication number
- CN114371610B CN114371610B CN202111431505.XA CN202111431505A CN114371610B CN 114371610 B CN114371610 B CN 114371610B CN 202111431505 A CN202111431505 A CN 202111431505A CN 114371610 B CN114371610 B CN 114371610B
- Authority
- CN
- China
- Prior art keywords
- fault
- aerostat
- control
- module
- vector
- 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
- 238000003745 diagnosis Methods 0.000 title claims abstract description 17
- 238000000034 method Methods 0.000 title claims description 14
- 238000005259 measurement Methods 0.000 claims abstract description 25
- 230000001133 acceleration Effects 0.000 claims abstract description 14
- 238000006243 chemical reaction Methods 0.000 claims abstract description 7
- 239000011159 matrix material Substances 0.000 claims description 21
- 238000013178 mathematical model Methods 0.000 claims description 8
- 230000005484 gravity Effects 0.000 claims description 3
- 230000001172 regenerating effect Effects 0.000 claims 1
- 238000013461 design Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 238000013507 mapping Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B9/00—Safety arrangements
- G05B9/02—Safety arrangements electric
- G05B9/03—Safety arrangements electric with multiple-channel loop, i.e. redundant control systems
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种多矢量螺旋桨组合浮空器故障诊断和容错控制***,包括状态测量模块,用于测量在地理坐标系下浮空器的当前位置信息和偏航角信息;目标跟踪控制器用于接收在地理坐标系下浮空器的当前位置信息和偏航角信息,将其与设定轨迹作比较产生误差信息,以误差信息作为输入,利用PID控制器,生成跟踪加速度信息;状态转换模块用于接收地理坐标系下的跟踪加速度信息,并生成机体坐标系下的跟踪控制力;故障识别与估计模块用于识别浮空器出现故障时矢量推力偏移,生成故障控制力;控制分配模块控制分配模块用于接收跟踪控制力和故障控制力重新分配给浮空器的间接控制力;矢量推力模块跟据间接控制力生成每个螺旋桨的推力及矢量转角。
Description
技术领域
本发明属于自动控制的技术领域,具体涉及一种多矢量螺旋桨组合浮空器故障诊断和容错控制***及方法。
背景技术
多矢量螺旋桨组合浮空器在其周围配置四个矢量螺旋桨,能够长期驻空,其水平各向阻力系数相同,可以实现横向运动。由于长期高空作业,在强风扰、高辐射、昼夜温差大的环境中,***出现故障的可能性很大,不能及时手动修复。因此,自动容错控制***的设计很重要。
一个矢量螺旋桨具有两个独立的控制变量:矢量推力和矢量转角,四个螺旋桨组合共有八个控制变量,为执行器冗余配置,可以实现浮空器独立的位置和姿态控制,然而矢量推力代表力的大小,矢量转角代表力的方向,两者互相耦合产生了有方向的力。到目前为止,还没有研究公开讨论基于矢量螺旋桨故障识别的多螺旋桨组合浮空器的容错控制问题。
发明内容
本发明提供了一种多矢量螺旋桨组合浮空器故障诊断和容错控制***及方法,通过建立线性的故障诊断容错模块,计算复杂的非线性时变故障力,简化了***的复杂度,提高了故障辨识的精度,故障容错跟踪效果好,并能够适应执行器不同故障类型的切换,适用范围广。
本发明可通过以下技术方案实现:
一种多矢量螺旋桨组合浮空器故障诊断和容错控制***,包括状态测量模块,所述状态测量模块与浮空器本体相连,还与目标跟踪控制器相连,所述目标跟踪控制器通过状态转换模块与控制分配模块相连,所述控制分配模块通过矢量推力模块与故障识别与估计模块相连,所述故障识别与估计模块与浮空器本体相连,还反馈连接到控制分配模块;
所述状态测量模块用于测量在地理坐标系下浮空器的当前位置信息和偏航角信息;
所述目标跟踪控制器用于接收在地理坐标系下浮空器的当前位置信息和偏航角信息,将其与设定轨迹作比较产生误差信息,以所述误差信息作为输入,利用PID控制器,生成跟踪加速度信息;
所述状态转换模块用于接收地理坐标系下的跟踪加速度信息,并生成机体坐标系下的跟踪控制力;
所述故障识别与估计模块用于识别浮空器出现故障时矢量推力偏移,生成故障控制力;
所述控制分配模块控制分配模块用于接收跟踪控制力和故障控制力重新分配给浮空器的间接控制力;
所述矢量推力模块跟据间接控制力生成每个螺旋桨的推力及矢量转角作用于故障识别与估计模块和浮空器本体***。
进一步,所述故障识别与估计模块包括与控制分配模块相连的无故障控制***、故障控制***,所述无故障控制***、故障控制***均与故障识别观测器相连,所述故障识别观测器、故障测量模块与故障力生成模块相连,所述故障力生成模块还反馈连接到控制分配模块,所述故障测量模块还与浮空器本身、故障力生成模块相连;
所述无故障控制***用于依据目标跟踪控制器,获取浮空器无故障时的状态变量;
所述故障控制***用于获取浮空器故障状态下的状态变量;
所述故障识别观测器用于根据浮空器无故障状态下的状态变量、故障状态下的状态变量,辨识出推力偏移;
所述故障力生成模块用于根据推力偏移以及故障测量模块得到的浮空器故障状态下的矢量转角偏移,生成故障控制力。
进一步,所述无故障控制***的数学模型设置为其中,X=[u v w r]T为无故障时浮空器在机体坐标系下的状态变量,[u v w]T为线性速度,r为偏航角速度,/>为质量矩阵,m为浮空器的质量,m11,m22,m33和m66为浮空器的附加质量,Iz为浮空器的偏航转动惯量,FGB为重力、浮力,FA为气动力,FI为哥氏力,FT为实际作用的矢量螺旋桨的推力;
所述故障控制***的数学模型设置为其中,Xr为浮空器故障时在机体坐标系下的状态变量,/>为无故障直接控制力,/>为故障直接控制力,
所述故障识别观测器的数学模型设置为其中,表示间接控制分配矩阵,Rp表示螺旋桨位置到浮空器体积中心的距离;
所述故障力生成模块的数学模型设置为其中,S=[Sf,Sμ]
μ1,μ2,μ3,μ4,f1,f2,f3,f4分别表示各个螺旋桨的矢量角和推力,表示故障测量模块测量得到的浮空器故障状态下的矢量转角偏移。
一种基于上文所述的多矢量螺旋桨组合浮空器故障诊断和容错控制***的控制方法,根据浮空器故障时的状态变量以及在目标跟踪***中无故障时的状态变量,计算故障时的推力偏移,再结合可测量的故障时的矢量转角偏移,计算故障控制力,将所述故障控制力补偿到目标跟踪***生成的跟踪控制力,重新分配虚拟控制力,获得浮空器中各个螺旋桨的控制量,控制浮空器重新到达理想位置。
进一步,其特征在于:利用如下方程式,计算故障控制力,
其中,X=[u v w r]T为浮空器无故障时在机体坐标系下的状态变量,[u vw]T为线性速度,r为偏航角速度,Xr为浮空器故障时在机体坐标系下的状态变量,为质量矩阵,m为浮空器的质量,m11,m22,m33和m66为浮空器的附加质量,/>表示故障测量模块测量得到的浮空器故障状态下的矢量角偏移,S=[Sf,Sμ],
μ1,μ2,μ3,μ4,f1,f2,f3,f4分别表示各个螺旋桨的矢量转角和推力,表示间接控制分配矩阵,Rp表示螺旋桨位置到浮空器体积中心的距离。
本发明有益的技术效果在于:
考虑到冗余执行器配置,建立了多矢量螺旋桨的线性耦合故障模型,从而实现了多执行器的多类故障的容错控制;通过间接控制分配矩阵,把空间控制力转换到矢量推力平面内,得到常数的间接控制系数矩阵,使计算伪逆时一直有解,增加了控制器的可靠性;依据实际使用情况,选择矢量转角偏差作为测量量,获得的自由故障变量,将推力偏移作为识别量,假设浮空器本体的状态加速度是可测量的,通过故障识别观测器确定的独立故障变量;为了实现精确辨识,选择缓慢变化的推力偏移作为辨识变量,提高故障辨识的精度;通过线性故障模型计算复杂的非线性时变故障力,简化了***的复杂度。仿真结果表明,该方法能够准确的识别推力偏移故障的大小,故障容错跟踪效果好,并能够适应执行器不同故障类型的切换。
附图说明
图1是本发明的浮空器在机体坐标系下的结构示意图;
图2是本发明的推力局部分解和向机体坐标系的映射;
图3是本发明的容错控制***的总体结构框图;
图4是本发明的容错控制***状态跟踪结果;
图5是本发明的实际输出矢量推力和矢量推力偏移设置;
图6是本发明的实际输出矢量转角和矢量转角偏移设置;
图7是本发明的矢量转角的理论值和辨识值,其中△f1,△f2,△f3,和△f4是执行器故障的理论值;d1,d2,d3和d4是执行器故障的识别值;
图8是本发明的故障力的理论值和估计值,其中△fx,△fy,△fz和△fψ为故障直接控制力的理论值;D1,D2,D3和D4是故障直接控制力的估计值。
具体实施方式
下面结合附图及较佳实施例详细说明本发明的具体实施方式。
如图3所示,本发明提供了一种多矢量螺旋桨组合浮空器故障诊断和容错控制***,包括状态测量模块,该状态测量模块与浮空器本体相连,还与目标跟踪控制器相连,该目标跟踪控制器通过状态转换模块与控制分配模块相连,该控制分配模块通过矢量推力模块与故障识别与估计模块相连,该故障识别与估计模块与浮空器本体相连,还反馈连接到控制分配模块;该状态测量模块用于测量在地理坐标系下浮空器的当前位置信息和偏航角信息;该目标跟踪控制器用于接收在地理坐标系下浮空器的当前位置信息和偏航角信息,将其与设定轨迹作比较产生误差信息,以所述误差信息作为输入,利用PID控制器,生成跟踪加速度信息;该状态转换模块用于接收地理坐标系下的跟踪加速度信息,并生成机体坐标系下的跟踪控制力;该故障识别与估计模块用于识别浮空器出现故障时矢量推力偏移,生成故障控制力;该控制分配模块控制分配模块用于接收跟踪控制力和故障控制力重新分配给浮空器的间接控制力;该矢量推力模块跟据间接控制力生成每个螺旋桨的推力及矢量转角作用于故障识别与估计模块和浮空器本体***。考虑到冗余执行器配置,建立了多矢量螺旋桨的故障诊断容错模型,通过以浮空器出现故障时执行器的矢量转角偏移和推力偏移为变量,生成故障控制力,然后将其补偿到依据目标跟踪控制器的目标跟踪控制***产生的跟踪控制力,重新计算分配给每个螺旋桨所需的推力及其对应的矢量转角,从而使浮空器重新到达理想位置,由于执行器故障时的推力偏移是恒定或者缓慢变化的,因此故障诊断容错模型为线性模型,降低了整个***的复杂度,提高了故障辨识的精度,故障容错跟踪效果好,并能够适应执行器不同故障类型的切换,适用范围广。
该故障识别与估计模块包括与控制分配模块相连的无故障控制***、故障控制***,该无故障控制***、故障控制***均与故障识别观测器相连,该故障识别观测器、故障测量模块与故障力生成模块相连,该故障力生成模块还反馈连接到控制分配模块,该故障测量模块还与浮空器本身、故障力生成模块相连;该无故障控制***用于依据目标跟踪控制器,获取无故障状态下的状态变量;该故障控制***用于获取浮空器故障状态下的状态变量;该故障识别观测器用于根据无故障状态下的状态变量、浮空器故障状态下的状态变量,辨识出推力偏移;该故障力生成模块用于根据推力偏移以及故障测量模块得到的浮空器故障状态下的矢量转角偏移,生成故障控制力。具体如下:
1、建立无故障控制***
考虑回转对称浮空器的特点以及计算方便,假定地理坐标系为[X、Y、Z],机体坐标系为[x、y、z],其原点为机体的体积中心,对应的x轴、y轴、z轴上的速度为[u、v、w]。
如图1所示,该浮空器具体为带有四个矢量螺旋桨的椭圆外形飞艇,四个矢量螺旋桨对称分布于浮空器的直径处,其高度由浮力控制,不考虑其姿态运动,则浮空器的动力学模型为
其中,X=[u v w r]T为浮空器无故障时在机体坐标系下的状态变量,[u v w]T为线性速度,r为偏航角速度,为浮空器无故障时在机体坐标系下的状态变量的一阶导数,为质量矩阵,m为浮空器的质量,m11,m22,m33和m66为浮空器的附加质量,Iz为浮空器的偏航转动惯量,方程右边FGB为重力、浮力,FA为气动力,FI为哥氏力,FT为实际作用的矢量螺旋桨的推力。由于浮空器的吊舱和负载置于舱下,在一定程度上提高了***的稳定性,因此,在本发明的研究中,假设浮空器的横滚和俯仰偏移足够小,且可以忽略不计。
矢量螺旋桨的局部坐标系建立在矢量旋转平面中,在该平面中,螺旋桨可绕轴偏转,范围为[-180°,180°],每个螺旋桨的矢量转角用μi(i=1,2,3,4)表示,产生的推力用fi(i=1,2,3,4)表示,如图2所示。在矢量旋转平面中,推力可分解为两个正交力,即水平fiH和垂直分量fiV:
该浮空器有四个矢量螺旋桨,有八个控制变量,称为间接控制力fHV:fHV=[f1H f2Hf3H f4H f1V f2V f3V f4V]T,这样就可以将偏航和位置控制通过把间接控制力fHV映射到机体坐标系下,其无故障时候螺旋桨对浮空器的直接控制力如下
其中,表示间接控制分配矩阵,Rp表示从螺旋桨位置到浮空去体积中心的距离,这里T设计为常数矩阵,在后续的控制器设计中很重要。
2、建立故障控制***
其中,Xr为故障下***的状态变量,为无故障直接控制力,/>为故障时直接力,故障包括矢量推力偏移和矢量转角偏移。该模型建立了多矢量螺旋桨的耦合故障模型,基于此实现了多执行器的多类故障的容错控制。
此时矢量螺旋桨的故障可分为推力偏移和矢量转角偏移,分别导致矢量推力和矢量转角的固定初始偏移。当推力和矢量角偏移同时发生时候,故障就会引起间接控制力的改变
这里代表矢量螺旋桨i产生的故障间接控制力。
依据矢量螺旋桨推力模型,则有
其中,Δfi=[△f1 △f2 △f3 △f4],Δμi=[△μ1 △μ2 △μ3 △μ4]。定义S=[Sf,Sμ],则
3、建立故障观测识别器
该故障识别观测器是假设飞行器的实际状态加速度是可以测量的。
结合有无故障的动力学模型推导出执行器故障的理论表达:
这里Δfi和Δμi分别是矢量螺旋桨i的故障推力偏移和故障转角偏移。给定冗余致动器配置,分配矩阵T的维数为4╳8,因此故障模型为欠定方程,理论上有无数的解。为了获得唯一的故障解决方案,需要设计四个独立变量和四个自由变量,并且自由变量由传感器测量确定,则自变量具有唯一的解决方案。考虑到矢量螺旋桨,矢量转角偏差可以比推力偏差更精确地测量,因此矢量角偏差被设计为可测量的自由变量,而矢量推力偏移做为独立变量,进行识别。使用以下滤波器根据以下参数估计推力故障偏移大小
这里d代表推力故障偏移大小,与浮空器的无故障模型输出的理论加速度和故障***测量的实际加速度/>有关系,/>和/>分别代表估计的推力故障偏移大小和估计的推力故障偏移的微分,这里P是对角线系数矩阵,每一项为正。定义/>有
Hurwitz条件满足估计误差趋近于零。因此有
这里即为估计出的推力故障偏移大小。
故障识别观测器设计的是直接选择执行器故障Δfi作为识别变量,而不是合成后的故障力,这是因为故障力在跟踪中是非线性时变的,源于故障力系数矩阵是矢量转角的三角函数,在跟踪过程中变化迅速,因此难以准确识别。然而,在实际情况下,执行器故障(推力偏移)是恒定的或缓慢的时变的,因此可以通过线性故障观测器准确识别。
4、建立故障控制力模块
该故障控制力D的计算如下:
这里为矢量转角偏移,通过传感器测量获得,而/>为利用故障识别观测器估计出的推力故障偏移大小。该模块可以通过线性故障模型计算出复杂的非线性故障力,简化了控制器设计的复杂成度。
5、目标跟踪控制器设计
设定当前状态为P(x,y,z,ψ),目标状态为Pc(xc,yc,zc,ψc),通过PID控制器计算跟踪加速度具体如下
而偏航角度可以设定为ψc=atan2(yc-y,xc-x)或者定值。
6、建立状态测量模块
该状态测量单元用于获得在地理参考坐标系下浮空器的位置和偏航角为η=[x yz ψ]T,则在地面参考系下浮空器的状态和机体坐标系下状态关系为
其中变换矩阵
7、建立状态转换模块
该状态转换模块用于把跟踪控制器计算得到的跟踪加速度转到机体坐标系下,计算跟踪控制力
8、控制分配模块
直接控制力FT包括跟踪控制力和故障控制力
FT=U+D
动态逆实现间接控制力fHV的计算
fHV=pinv(T)FT,
这里pinv(T)是伪逆T.控制矩阵的选择T在求逆的过程很重要,为了避免奇异,这里T为常数矩阵,其逆也是常数,所以总会有解。
9、建立矢量推力模块
依据矢量推力模型,执行器的输出变量可以计算
μi=atan2(fiH,-fiV)
通过推力和转角的控制获得跟踪控制力FT,进而实现目标跟踪。
本发明还提供了一种基于上文所述的多矢量螺旋桨组合浮空器故障诊断和容错控制***的控制方法,根据浮空器故障时的状态变量以及在目标跟踪***中理论状态的状态变量,计算故障时的推力偏移,再结合故障时的矢量转角偏移,计算故障控制力,将所述故障控制力补偿到目标跟踪***生成的跟踪控制力,重新分配虚拟控制力,获得浮空器中各个螺旋桨的控制量,控制浮空器重新到达理想位置。
具体地,利用如下方程式,计算故障控制力,
其中,X=[u v w r]T为浮空器无故障时在机体坐标系下的状态变量,[u v w]T为线性速度,r为偏航角速度,为浮空器无故障时在机体坐标系下的状态变量的一阶导数,Xr为浮空器故障时在机体坐标系下的状态变量,/>为浮空器故障时在机体坐标系下的状态变量的一阶导数,/>为质量矩阵,m为浮空器的质量,m11,m22,m33和m66为浮空器的附加质量,/>表示故障测量模块测量得到的浮空器故障状态下的矢量转角偏移,S=[Sf,Sμ],
μ1,μ2,μ3,μ4,f1,f2,f3,f4分别表示各个螺旋桨的矢量转角和推力,表示间接控制分配矩阵,Rp表示螺旋桨位置到浮空器体积中心的距离。
对本发明的控制法进行仿真验证
初始状态P(0,0,0,0),跟踪目标状态Pc(-20,-10,30,0).故障设置如下
故障识别观测器参数
P=diag(p1,p2,p3,p4)=diag(0.1,0.1,0.1,0.1),
跟踪控制器参数
kp=diag(kpu,kpv,kpw,kpr)=diag(0.1,0.1,0.05,1)
ki=diag(kiu,kiv,kiw,kir)=diag(0.0,0.0,0.0,0.05)
kd=diag(kiu,kiv,kiw,kir)=diag(1,1,1,2)
图4显示了50秒和100秒故障阶跃变化时的跟踪结果。当执行器故障切换为50秒和100秒时,偏航角明显振荡,在位置跟踪中抑制故障影响的同时,高度跟踪显示高度跟踪的轻微波动。
图5和6显示跟踪和执行器故障的控制输出,图7和8显示了执行器故障识别和故障力估计,从中可以看出,随着执行器故障切换变化,故障识别在切换时刻有一个过渡过程,稳定值和理论值与图7所示一致。基于模型的输出故障力估计有效跟踪时变故障力,如图8所示。
虽然以上描述了本发明的具体实施方式,但是本领域的技术人员应当理解,这些仅是举例说明,在不背离本发明的原理和实质的前提下,可以对这些实施方式做出多种变更或修改,因此,本发明的保护范围由所附权利要求书限定。
Claims (5)
1.一种多矢量螺旋桨组合浮空器故障诊断和容错控制***,其特征在于:包括状态测量模块,所述状态测量模块与浮空器本体相连,还与目标跟踪控制器相连,所述目标跟踪控制器通过状态转换模块与控制分配模块相连,所述控制分配模块通过矢量推力模块与故障识别与估计模块相连,所述故障识别与估计模块与浮空器本体相连,还反馈连接到控制分配模块;
所述状态测量模块用于测量在地理坐标系下浮空器的当前位置信息和偏航角信息;
所述目标跟踪控制器用于接收在地理坐标系下浮空器的当前位置信息和偏航角信息,将其与设定轨迹作比较产生误差信息,以所述误差信息作为输入,利用PID控制器,生成跟踪加速度信息;
所述状态转换模块用于接收地理坐标系下的跟踪加速度信息,并生成机体坐标系下的跟踪控制力;
所述故障识别与估计模块用于识别浮空器出现故障时矢量推力偏移,生成故障控制力;
所述控制分配模块用于接收跟踪控制力和故障控制力,重新生成分配给浮空器的间接控制力;
所述矢量推力模块根据间接控制力生成每个螺旋桨的推力及矢量转角作用于故障识别与估计模块和浮空器本体***。
2.根据权利要求1所述的多矢量螺旋桨组合浮空器故障诊断和容错控制***,其特征在于:所述故障识别与估计模块包括与控制分配模块相连的无故障控制***、故障控制***,所述无故障控制***、故障控制***均与故障识别观测器相连,所述故障识别观测器、故障测量模块与故障力生成模块相连,所述故障力生成模块还反馈连接到控制分配模块,所述故障测量模块还与浮空器本身、故障力生成模块相连;
所述无故障控制***用于依据目标跟踪控制器,获取***无故障时状态变量;
所述故障控制***用于获取浮空器故障状态下的状态变量;
所述故障识别观测器用于根据浮空器无故障下的状态变量、故障状态下的状态变量,辨识出推力偏移;
所述故障力生成模块用于根据推力偏移以及故障测量模块得到的浮空器故障状态下的矢量转角偏移,生成故障控制力。
3.根据权利要求2所述的多矢量螺旋桨组合浮空器故障诊断和容错控制***,其特征在于:所述无故障控制***的数学模型设置为其中,X=[u v w r]T为浮空器无故障时在机体坐标系下的状态变量,[u v w]T为线性速度,r为偏航角速度,为质量矩阵,m为浮空器的质量,m11,m22,m33和m66为浮空器的附加质量,Iz为浮空器的偏航转动惯量,FGB为重力、浮力,FA为气动力,FI为哥氏力,FT为实际作用的矢量螺旋桨的推力;
所述故障控制***的数学模型设置为其中,Xr为浮空器故障时在机体坐标系下的状态变量,/>为无故障直接控制力,/>为故障直接控制力,
所述故障识别观测器的数学模型设置为
其中,表示间接控制分配矩阵,Rp表示螺旋桨位置到浮空器体积中心的距离;
所述故障力生成模块的数学模型设置为其中,S=[Sf,Sμ]
μ1,μ2,μ3,μ4分别表示各个螺旋桨的矢量角,f1,f2,f3,f4分别表示各个螺旋桨的推力,表示故障测量模块测量得到的浮空器故障状态下的矢量转角偏移。
4.一种基于权利要求1所述的多矢量螺旋桨组合浮空器故障诊断和容错控制***的控制方法,其特征在于:根据浮空器故障时的状态变量以及在目标跟踪***中无故障时的状态变量,计算故障时的推力偏移,再结合可测量的故障时的矢量转角偏移,计算故障控制力,将所述故障控制力补偿到目标跟踪***生成的跟踪控制力,重新分配虚拟控制力,获得浮空器中各个螺旋桨的控制量,控制浮空器重新到达理想位置。
5.根据权利要求4所述的多矢量螺旋桨组合浮空器故障诊断和容错控制***的控制方法,其特征在于:利用如下方程式,计算故障控制力,
其中,X=[u v w r]T为浮空器无故障时在机体坐标系下的状态变量,[u v w]T为线性速度,r为偏航角速度,Xr为浮空器故障时在机体坐标系下的状态变量,为质量矩阵,m为浮空器的质量,m11,m22,m33和m66为浮空器的附加质量,/>表示故障测量模块测量得到的浮空器故障状态下的矢量角偏移,S=[Sf,Sμ],
μ1,μ2,μ3,μ4分别表示各个螺旋桨的矢量转角,f1,f2,f3,f4分别表示各个螺旋桨的推力,表示间接控制分配矩阵,Rp表示螺旋桨位置到浮空器体积中心的距离。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111431505.XA CN114371610B (zh) | 2021-11-29 | 2021-11-29 | 多矢量螺旋桨组合浮空器故障诊断和容错控制***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111431505.XA CN114371610B (zh) | 2021-11-29 | 2021-11-29 | 多矢量螺旋桨组合浮空器故障诊断和容错控制***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114371610A CN114371610A (zh) | 2022-04-19 |
CN114371610B true CN114371610B (zh) | 2023-08-08 |
Family
ID=81140699
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111431505.XA Active CN114371610B (zh) | 2021-11-29 | 2021-11-29 | 多矢量螺旋桨组合浮空器故障诊断和容错控制***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114371610B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1364870A1 (en) * | 2002-05-20 | 2003-11-26 | Kawasaki Jukogyo Kabushiki Kaisha | Method and device for allocating thrust to air or water craft |
EP1901153A1 (en) * | 2006-09-12 | 2008-03-19 | OFFIS e.V. | Control system for unmanned 4-rotor-helicopter |
CA2845344A1 (en) * | 2013-03-15 | 2014-09-15 | Exelis Inc. | Reduction of altitude error using forecasted atmospheric pressure data |
CN104216417A (zh) * | 2014-09-22 | 2014-12-17 | 北京航空航天大学 | 一种基于四矢量螺旋桨的平流层飞艇的动态控制分配方法 |
CN104765312A (zh) * | 2015-03-09 | 2015-07-08 | 上海交通大学 | 飞行器可重构控制***实现方法 |
CN105094144A (zh) * | 2015-09-02 | 2015-11-25 | 北京天航华创科技股份有限公司 | 一种无人飞艇自适应抗风路径跟踪控制方法 |
CN105473442A (zh) * | 2013-06-09 | 2016-04-06 | 瑞士苏黎世联邦理工学院 | 遭遇影响效应器的故障的多旋翼器的受控飞行 |
CN105700542A (zh) * | 2016-03-30 | 2016-06-22 | 北京航空航天大学 | 一种基于矢量场制导和最小二乘法的平流层飞艇控制分配方法 |
CN106933237A (zh) * | 2017-02-28 | 2017-07-07 | 北京天恒长鹰科技股份有限公司 | 一种平流层飞艇的被动容错控制方法 |
CN110244754A (zh) * | 2019-06-28 | 2019-09-17 | 上海工程技术大学 | 一种用于平流层浮空器定点驻空的控制***及方法 |
-
2021
- 2021-11-29 CN CN202111431505.XA patent/CN114371610B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1364870A1 (en) * | 2002-05-20 | 2003-11-26 | Kawasaki Jukogyo Kabushiki Kaisha | Method and device for allocating thrust to air or water craft |
EP1901153A1 (en) * | 2006-09-12 | 2008-03-19 | OFFIS e.V. | Control system for unmanned 4-rotor-helicopter |
CA2845344A1 (en) * | 2013-03-15 | 2014-09-15 | Exelis Inc. | Reduction of altitude error using forecasted atmospheric pressure data |
CN105473442A (zh) * | 2013-06-09 | 2016-04-06 | 瑞士苏黎世联邦理工学院 | 遭遇影响效应器的故障的多旋翼器的受控飞行 |
CN104216417A (zh) * | 2014-09-22 | 2014-12-17 | 北京航空航天大学 | 一种基于四矢量螺旋桨的平流层飞艇的动态控制分配方法 |
CN104765312A (zh) * | 2015-03-09 | 2015-07-08 | 上海交通大学 | 飞行器可重构控制***实现方法 |
CN105094144A (zh) * | 2015-09-02 | 2015-11-25 | 北京天航华创科技股份有限公司 | 一种无人飞艇自适应抗风路径跟踪控制方法 |
CN105700542A (zh) * | 2016-03-30 | 2016-06-22 | 北京航空航天大学 | 一种基于矢量场制导和最小二乘法的平流层飞艇控制分配方法 |
CN106933237A (zh) * | 2017-02-28 | 2017-07-07 | 北京天恒长鹰科技股份有限公司 | 一种平流层飞艇的被动容错控制方法 |
CN110244754A (zh) * | 2019-06-28 | 2019-09-17 | 上海工程技术大学 | 一种用于平流层浮空器定点驻空的控制***及方法 |
Non-Patent Citations (1)
Title |
---|
梁宽宽等."基于自适应滑模的多螺旋桨浮空器容错控制".《工程科学学报》.2020,第42卷(第3期),372-380页. * |
Also Published As
Publication number | Publication date |
---|---|
CN114371610A (zh) | 2022-04-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106873611B (zh) | 一种多通道线性自抗扰控制器的设计方法 | |
Li et al. | Fault-tolerant attitude stabilization incorporating closed-loop control allocation under actuator failure | |
CN107272639B (zh) | 刚性航天器反作用飞轮故障的检测、估计及其调节方法 | |
CN105607472B (zh) | 非线性二元机翼的自适应反演滑模控制方法及装置 | |
CN101481019B (zh) | 一种用于卫星姿态控制***的传感器容错观测方法 | |
CN110347170B (zh) | 可重复使用运载器再入段鲁棒容错制导控制***及工作方法 | |
CN111880410B (zh) | 一种针对电机故障的四旋翼无人机容错控制方法 | |
Freddi et al. | Actuator fault detection system for a mini-quadrotor | |
CN115629547B (zh) | 一种面向舵面故障的飞机机载容错控制方法及*** | |
CN109696090B (zh) | 一种针对运载火箭\导弹的在线单发推力辨识方法 | |
CN111142550A (zh) | 民用飞机辅助驾驶控制方法、***及飞行品质评估方法 | |
CN109683480A (zh) | 考虑执行器故障的非线性机械***类固定时间控制方法 | |
CN115877717A (zh) | 一种基于自抗扰控制的飞行器容错控制结构与控制方法 | |
CN114371610B (zh) | 多矢量螺旋桨组合浮空器故障诊断和容错控制***及方法 | |
Zhang et al. | Fault-tolerant control for quadrotor UAV via backstepping approach | |
CN112631245B (zh) | 一种基于扩展状态观测器的飞机机电作动***故障检测方法 | |
Li et al. | A synthesized design of adaptive and sliding-mode observer-based incipient fault detection for a quadrotor | |
Lu et al. | Adaptive closed-loop control allocation-based fault tolerant flight control for an overactuated aircraft | |
CN114924485A (zh) | 一种过驱动水下机器人动力定位自适应容错控制架构及方法 | |
CN114035543B (zh) | 一种飞机受损状态下的自修复控制方法 | |
CN115685761A (zh) | 挠性航天器预设性能姿态控制方法、计算机设备和存储介质 | |
CN115328185A (zh) | 一种飞行器非线性非定常气动载荷修正*** | |
Kowalski et al. | Force fight compensation for redundant electro-mechanical flight control actuators | |
CN116736692A (zh) | 一种具有延迟状态约束的四旋翼无人机滑模容错控制方法 | |
CN113859588A (zh) | 一种航天器姿态/故障/干扰协同观测与容错抗干扰控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |