1.一种具有抗干扰能力的四旋翼无人机容错编队控制方法,其特征在于,所述方法包括以下步骤:S100:在三维空间中建立一个由多个四旋翼无人机组成的无人机集群系统,并为每个无人机建立平移动力学、旋转动力学、电机动力学和执行器故障模型,进而建立四旋翼集群完整的动力学模型,完整的动力学模型的控制目标是设计推力和转矩使每个四旋翼无人机满足预设条件;
S200:设计标称编队控制器,根据平移动力学和执行器故障模型将存在偏差故障的平移动力学模型进行改写,并结合高阶滑模观测器估计和补偿执行器偏差故障和外界时变扰动,设计位置环的鲁棒控制器,进而得到每个四旋翼无人机的静推力,实现各四旋翼无人机对虚拟领航者的轨迹跟踪;
当执行器故障模型中故障为混合故障,即执行器既存在部分失效故障也存在偏差故障时, 结合平移动力学,将存在偏差故障的平移动力学模型改写为:(11)
式中,为恒定的重力加速度,是常数向量,表示无人机受到的总推力,表示无人集群系统中四旋翼无人机的编号,是集总扰动,包括执行器偏差故障的影响和外部时变扰动,为每个四旋翼无人机平动动力学的外界扰动,其中,分别是各四旋翼无人机在x轴,y轴和z轴方向上受到的扰动,包括空气阻力,时变风扰和其他未建模的部分;
S300:解耦位置环和姿态环得到各四旋翼无人机的期望姿态,为标称系统设计姿态控制器,根据旋转动力学和执行器故障模型将存在偏差故障的旋转动力学模型进行改写,并结合高阶滑模观测器解决执行器偏差故障和外部时变扰动对姿态环的影响,设计姿态环的鲁棒控制器,从而实现各四旋翼无人机的姿态稳定;
当执行器故障模型中故障为混合故障,即执行器既存在部分失效故障也存在偏差故障时,结合旋转动力学,将存在执行器偏差故障的旋转动力学模型改写成:(20)
式中,是惯性矩阵,其中,分别是各四旋翼无人机绕机体坐标系x轴、y轴和z轴的转动惯量, 表示力矩,其中,分别是各四旋翼无人机在x轴,y轴和z轴方向上的力矩,表示机体坐标系下的角速度,其中,是各四旋翼无人机俯仰角速度、翻滚角速度和偏航角速度,是一种扰动,其中是执行器偏差的第二维至第四维数据, 表示姿态子系统遭受到的扰动,包括未建模部分和外部风扰,其中,分别是各四旋翼无人机在俯仰,翻滚和偏航时受到的扰动;
S400:根据完整动力学模型、位置环的鲁棒控制器和姿态环的鲁棒控制器,改写完整动力学模型,基于牛顿修正法计算执行器故障后各旋翼的升力系数实现在线故障诊断,根据故障后的控制效能矩阵计算每个电机的转速,实现执行器故障后的四旋翼无人机安全可靠编队控制;
其中,根据完整动力学模型,位置环的鲁棒控制器和姿态环的鲁棒控制器,将完整动力学模型改写成:(23)
式中,,其中是每个电机的升力失效系数,是无人集群中各四旋翼无人机的状态,,,其中,其中,表示每个四旋翼无人机的质量,是正弦算子,是余弦算子,是每个电机的转速,是各四旋翼无人机1,2,3,4号电机的转速,是控制效能矩阵,是集总扰动项。
2.根据权利要求1所述的方法,其特征在于,建立惯性坐标系I和机体坐标系B,S100包括:S110:根据牛顿第二定律,各四旋翼子系统的平移动力学方程为:(1)
式中,表示无人集群系统中四旋翼无人机的编号,和分别表示惯性坐标系I下每个四旋翼无人机的位置和线速度,其中,分别是各四旋翼无人机在x轴,y轴和z轴方向的位置,分别是各四旋翼无人机在x轴,y轴和z轴方向的速度,是由欧拉角定义的旋转矩阵,表示由机体坐标到世界坐标的转换,为恒定的重力加速度,是常数向量,表示每个四旋翼无人机的质量,是机体坐标系下的力,表示无人机受到的总推力,为每个四旋翼无人机平动动力学的外界扰动,其中,分别是各四旋翼无人机在x轴,y轴和z轴方向上受到的扰动,包括空气阻力,时变风扰和其他未建模的部分;
S120:根据欧拉方程,姿态子系统的旋转动力学方程写成:(2)
式中,是欧拉角,其中分别是各四旋翼无人机的俯仰角、翻滚角和偏航角,表示机体坐标系下的角速度,其中,是各四旋翼无人机俯仰角速度、翻滚角速度和偏航角速度,是惯性矩阵,其中,分别是各四旋翼无人机绕机体坐标系x轴、y轴和z轴的转动惯量,表示力矩,其中,分别是各四旋翼无人机在x轴,y轴和z轴方向上的力矩,表示姿态子系统遭受到的扰动,包括未建模部分和外部风扰,其中,分别是各四旋翼无人机在俯仰,翻滚和偏航时受到的扰动;
S130:根据四旋翼无人机的四个旋翼产生的升力、滚转力矩、俯仰力矩和偏航力矩与电机转速之间的关系,每个四旋翼无人机的控制输入建模也即电机动力学方程为:(3)
式中,是控制输入向量,是每个电机的转速,其中,是各四旋翼无人机1,2,3,4号电机的转速,是控制效能矩阵,其具体形式为:(4)
式中,是各无人机每个电机的升力系数,是各无人机的反力矩系数,是升阻比系数;
S140: 建立执行器故障模型为:
(5)
式中,,其中是每个电机的升力失效系数;表示理想情况下标称系统的控制输入,是未知的执行器偏差故障;
结合式(3)和式(5),执行器故障模型重写成:(6)
S150: 结合平移动力学(1),旋转动力学(2),电机动力学(3)和执行器故障模型(6),四旋翼集群完整的动力学模型表示成:(7)
式中,是无人集群中各四旋翼无人机的状态,,其中,其中,是正弦算子,是余弦算子,。
3.根据权利要求2所述的方法,其特征在于,公式(5)中,根据和取不同的值,执行器故障分为以下几种类型:(1)、当且时,是执行器部分失效故障,也叫做乘性故障;
(2)、当且时,是执行器偏差故障,也叫做加性故障;
(3)、当且时,执行器既存在部分失效故障也存在偏差故障,称为混合故障;
(4)、当且时,执行器不存在故障。
4.根据权利要求3所述的方法,其特征在于,S100中预设条件具体为:(8)
式中,是四旋翼无人机的编号,与无人机相邻,是第个无人机的位置,表示无人机和之间的相对位置,决定所需的编队模式,是虚拟领航者的时变轨迹,是的一阶微分,表示虚拟领航者的时变速度也即编队队形的参考线速度。
5.根据权利要求4所述的方法,其特征在于,S200包括:S210:根据二阶系统的一致性控制协议设计标称编队控制器实现理想状态下的平移运动,控制器形式为:(9)
式中,和是正常数控制参数矩阵,其中,分别是x轴、y轴和z轴方向上的位置控制参数,分别是x轴、y轴和z轴方向上的速度控制参数,和分别是和的一阶微分,是的二阶微分,是能与第个四旋翼无人机发生相互作用的无人机动态邻域集,是第个四旋翼无人机与虚拟领航者之间的通信拓扑值,如果四旋翼无人机与领航者能通信则的值为1,否则为0,是邻接矩阵中的元素,的值由下式给出:(10)
S220:设计高阶滑模观测器估计和补偿集总扰动,其具体形式为:(12)
式中,是各四旋翼的位置估计误差,和分别是各四旋翼速度和集总扰动的估计值,是辅助参数保证二阶可导,是正常数;
S230:设计位置环的鲁棒控制器为:
(13)
式中,是低通滤波器,其中是滤波器的截止频率;
S240:位置环的完整控制器为:
(14)
S250:每个四旋翼无人机的静推力输入如下:(15)
式中是向量的第三维数据。
6.根据权利要求5所述的方法,其特征在于,S300包括:S310:解耦位置子系统和姿态子系统,选择任意的偏航角,期望的翻滚角和俯仰角可以由下式获得:(16)
式中,和分别是控制器的第一维和第二维数据;
S320:定义每个四旋翼无人机的参考姿态为:(17)
姿态误差设计为:
(18)
式中,分别是俯仰角、翻滚角和偏航角误差;
S330:为姿态子系统设计理想情况下的标称姿态控制器实现各四旋翼的姿态稳定,姿态控制器具体形式为:(19)
式中,和分别是正常数控制增益矩阵,其中,分别是俯仰角、翻滚角和偏航角的姿态控制参数,分别是俯仰角速度、翻滚角速度和偏航角速度控制参数;
S340:设计高阶滑模观测器估计和补偿集总扰动,其形式为:(21)
式中,是姿态的估计误差,和分别是角速度和集总扰动的估计值,是辅助参数,保证能二阶可微,均为正常数;
S350:姿态环的鲁棒控制器设计为:
(22)
式中,是低通滤波器,其中是滤波器截止频率。
7.根据权利要求6所述的方法,其特征在于,S400包括:S410:通过实时信息在线估计各无人机的升力系数,对执行器故障进行诊断,动力学(23)重写成:(24)
式中,的具体形式如下:
(25)
S420:定义目标函数如下:
(26)
关于的一阶和二阶导分别为:
(27)
式中,是迭代次数;
S430:判断是否成立,其中是允许误差,如果成立,则停止计算,如果不成立,则令梯度方向为:(28)
式中,,其中是适当的正常数,其作用是为了保证是正定的;因此,梯度方向的具体形式为:(29)
S440:从出发,沿方向作一维搜索找到相应的学习步长使下降最快,一维搜素的方式为:(30)
S450:令,并迭代公式(27)-(30)直到,得到相应的值,从而可以得到每个转子执行器部分失效故障时的升力系数,由此可以得到执行器部分失效后的控制效能分配矩阵为矩阵,最终,每个四旋翼飞行器的每个电机的期望转速为:(31)。