一种分布式固定翼无人机预设性能容错编队控制方法
本发明涉及无人机协同控制与编队飞行,具体为一种分布式固定翼无人机预设性能容错编队控制方法。
背景技术:
1、随着无人机集群在灾害救援、军事侦察、环境监测及物流运输等领域的广泛应用,编队控制技术逐渐成为无人机集群研究的核心问题。现有的编队控制方法主要包括基于位移信息、基于距离信息以及基于方位信息的控制框架。基于位移信息的控制方法通常需要每架无人机获取全局统一的参考坐标或绝对位置,这通常依赖卫星导航系统或高精度定位设备。然而,受限于信号环境,特别是在复杂或信号受限的环境下,这种方法的应用会受到很大限制。基于距离信息的控制方法在一定程度上减少了对定位的依赖,但在编队平移或缩放机动过程中,距离约束无法保持编队形状的不变性,容易导致队形结构退化。因此,基于距离信息的控制方法在复杂机动的应用中存在局限性。
2、相比之下,基于方位信息的编队控制方法仅需要相邻无人机的相对方位信息进行数据交互,而不依赖于全局参考坐标,这使得基于方位信息的控制方法在资源受限和环境复杂的任务场景中,尤其在无法使用卫星导航或高精度定位设备的环境下,具有较大的优势,尽管如此,现有的基于方位信息的编队控制方法仍存在显著的不足,一方面,许多研究基于理想化的一阶或线性模型设计控制律,忽略了固定翼无人机本身的非完整、欠驱动动力学特性,这导致了理论结果在实际系统中难以直接应用,另一方面,现有方法大多数只能实现误差的渐近收敛或有限时间收敛,无法对误差在收敛过程中的瞬态和稳态行为进行有效约束,无法满足工程需求中的安全性和性能可预见性要求。
3、此外,当无人机的执行机构发生乘性或加性故障,或出现推力饱和、系统参数摄动以及外部环境扰动等情况时,传统控制器往往缺乏有效的容错补偿机制,可能导致无人机偏离期望轨迹,甚至破坏整个编队的稳定性。
技术实现思路
1、针对现有技术的不足,本发明提供了一种分布式固定翼无人机预设性能容错编队控制方法,解决了上述背景技术中提出的问题。
2、为实现以上目的,本发明通过以下技术方案予以实现:一种分布式固定翼无人机预设性能容错编队控制方法,包括以下步骤:
3、s1.系统建模与问题描述:建立固定翼无人机的非完整动力学模型,考虑执行器故障、推力饱和、环境扰动等不确定因素,统一为团簇不确定量;
4、s2.不确定量观测器设计:针对引入的团簇不确定量,建立规定时间观测器,采用时间缩放函数建立不确定量估计的更新律,确保在规定时间内实现精确估计;
5、s3.层级式误差变换:设置位置误差并在此基础上设置位置速度复合误差,在位置误差与位置速度复合误差上施加控制约束,通过单调递减的性能函数控制位置误差轨迹,确保误差始终处于预设的性能边界内;
6、s4.基于方位约束的容错控制律设计:通过局部投影矩阵,将误差信号投影到方位约束子空间内,从而滤除无效的控制输入,结合误差构建控制律,并通过误差反馈和前馈补偿,确保无人机编队稳定性。
7、优选的,还包括:
8、s5.稳定性分析与参数条件证明:通过李雅普诺夫方法对系统的闭环稳定性进行严格证明,给出控制增益的取值条件,确保编队在外部扰动和执行器故障下依然能够稳定运行。
9、优选的,所述固定翼无人机的非完整动力学模型包括每架无人机的运动学与动力学方程,描述无人机的飞行路径角、航向角、质量、阻力、环境干扰以及控制输入。
10、优选的,所述团簇不确定量集中表征了包括执行器乘性故障、加性偏置、推力饱和误差、参数摄动以及外部扰动的综合影响。
11、优选的,所述s1中具体包括:
12、s101.建立固定翼无人机的动力学模型,每架无人机建模为刚体,其运动由惯性坐标系和机体坐标系共同描述,第i架无人机的运动学与动力学方程如下所示:
13、
14、其中,pi=[xi,yi,zi]t表示位置向量,vi表示空速,γi和ψi分别为飞行路径角和航向角,为实际质量,di为阻力,dei为环境干扰,ui,li和μi分别为推力、升力和滚转角控制输入;
15、s102.设置编队拓扑结构为领导者—第一跟随者,其余跟随者通过方位信息与局部邻居建立感知,利用局部方位信息构造正交投影矩阵。
16、优选的,所述拓扑结构中,第一跟随者仅感知领导者,而其他跟随者感知编号较小的邻居,并确保方位约束之间不共线,且所有方位约束均符合中心到尺度的几何描述方式。
17、优选的,所述规定时间观测器通过引入时间缩放函数与动态增益项,确保在有限时间内系统误差收敛。
18、优选的,所述控制律通过误差反馈补偿项与前馈补偿项相结合,确保编队在执行复杂机动时的稳定性和容错性,不依赖于全局坐标系,仅依赖局部邻居方位信息。
19、优选的,所述规定时间观测器的更新律为:
20、
21、其中,α1i,α2i>0,β1i,β2i>4为观测器设计增益。
22、本发明提供了一种分布式固定翼无人机预设性能容错编队控制方法。具备以下有益效果:
23、1、本发明通过仅依赖相邻无人机的方位信息,本发明避免了对全局参考坐标和高精度定位系统的依赖,使得控制方法能够在资源受限、环境复杂的任务场景中稳定工作。同时,采用规定时间观测器有效补偿了执行器故障、推力饱和、环境扰动和参数不确定性,显著提高了系统的容错性和鲁棒性。
24、2、本发明采用分层式规定性能误差变换,能够严格约束位置误差和位置-速度复合误差的瞬态和稳态行为,使得误差轨迹始终保持在预设的性能边界内。这种性能约束确保了无人机编队在动态飞行过程中误差的精确控制,提高了系统的安全性和任务可靠性。
25、3、本发明控制律通过局部方位信息的使用,显著降低了计算复杂度,同时,控制参数条件易于检验,为大规模无人机集群的应用提供了可行性。该方法的分布式设计使得其在多个无人机集群中均能稳定工作,具有良好的扩展性和广泛的工程应用前景。
1.一种分布式固定翼无人机预设性能容错编队控制方法,其特征在于:包括以下步骤:
2.根据权利要求1所述的一种分布式固定翼无人机预设性能容错编队控制方法,其特征在于:还包括:
3.根据权利要求1所述的一种分布式固定翼无人机预设性能容错编队控制方法,其特征在于:所述固定翼无人机的非完整动力学模型包括每架无人机的运动学与动力学方程,描述无人机的飞行路径角、航向角、质量、阻力、环境干扰以及控制输入。
4.根据权利要求1所述的一种分布式固定翼无人机预设性能容错编队控制方法,其特征在于:所述团簇不确定量集中表征了包括执行器乘性故障、加性偏置、推力饱和误差、参数摄动以及外部扰动的综合影响。
5.根据权利要求1所述的一种分布式固定翼无人机预设性能容错编队控制方法,其特征在于:所述s1中具体包括:
6.根据权利要求5所述的一种分布式固定翼无人机预设性能容错编队控制方法,其特征在于:所述拓扑结构中,第一跟随者仅感知领导者,而其他跟随者感知编号较小的邻居,并确保方位约束之间不共线,且所有方位约束均符合中心到尺度的几何描述方式。
7.根据权利要求1所述的一种分布式固定翼无人机预设性能容错编队控制方法,其特征在于:所述规定时间观测器通过引入时间缩放函数与动态增益项,确保在有限时间内系统误差收敛。
8.根据权利要求1所述的一种分布式固定翼无人机预设性能容错编队控制方法,其特征在于:所述控制律通过误差反馈与前馈补偿相结合,确保编队在执行复杂机动时的稳定性和容错性,不依赖于全局坐标系,仅依赖局部邻居方位信息。
9.根据权利要求1所述的一种分布式固定翼无人机预设性能容错编队控制方法,其特征在于:所述规定时间观测器的更新律为:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com