一种多无人机吊运系统的缆绳张力容错分配方法及系统

摘要: 本发明属于多无人机吊运控制,具体涉及一种多无人机吊运系统的缆绳张力容错分配方法及系统。背景技术:1、多旋翼无人机凭借卓越的垂直起降能力、出色的机动性以及复杂场景...
一种多无人机吊运系统的缆绳张力容错分配方法及系统

本发明属于多无人机吊运控制,具体涉及一种多无人机吊运系统的缆绳张力容错分配方法及系统。

背景技术:

1、多旋翼无人机凭借卓越的垂直起降能力、出色的机动性以及复杂场景下的高度适应性,在侦查监测、空中巡逻、防灾救生、货物运输等军民两用领域得到广泛应用。滑模控制(smc)、两阶段自抗扰控制(adrc)、控制李雅普诺夫函数(clf)以及非线性模型预测控制(nmpc)等鲁棒控制策略成为当前研究的重点方向。文献《一种基于非线性模型预测控制(nmpc)的多无人机吊挂负载全姿态控制方法》,在系统建模中考虑了无人机避障及缆绳张力约束问题。然而,该方法未考虑到无人机推力受限故障场景下的缆绳张力分配问题,无法实现主动容错,导致缆绳张力分配失衡。

技术实现思路

1、本发明的目的是针对现有技术存在的上述问题,提供一种能够实现无人机推力受限故障场景下的缆绳张力容错分配同时满足负载避障要求的多无人机吊运系统的缆绳张力容错分配方法及系统。

2、为实现以上目的,本发明的技术方案如下:

3、第一方面,本发明提供了一种多无人机吊运系统的缆绳张力容错分配方法,所述缆绳张力容错分配方法包括:

4、s1、实时检测所述多无人机吊运系统中的运行状态,基于所述多无人机吊运系统中的运行状态判断当前所述多无人机吊运系统处于推力正常模式还是推力故障模式;

5、s2、若处于所述推力正常模式,则采用零空间缆绳张力分配方法进行缆绳张力分配;若处于所述推力故障模式,则采用引入负载安全约束的缆绳张力分配方法进行缆绳张力分配;

6、所述引入负载安全约束的缆绳张力分配方法包括:以最小化待优化的缆绳实际张力向量与缆绳期望张力向量的偏差为优化目标进行缆绳张力分配,在负载安全约束、无人机最大缆绳张力约束与空间避障约束下求解优化目标得到最优缆绳实际张力向量,根据最优缆绳实际张力向量进行缆绳张力分配;所述负载安全约束是针对多无人机吊运系统面对障碍物构建的二阶cbf约束。

7、所述引入负载安全约束的缆绳张力分配方法具体包括:

8、所述引入负载安全约束的缆绳张力分配方法具体包括:

9、a1、定义期望合力向量,其中表示负载期望合力,表示负载期望合力矩,定义负载坐标系中由所有缆绳期望张力向量组成的行向量,其中为第根缆绳在负载坐标系中的期望张力向量,则有,,其中为第根缆绳在负载坐标系中的悬挂点位置向量,为缆绳数量,所述无人机数量与所述缆绳数量相等;

10、设为的反对称矩阵,则,,其中为3阶单位矩阵;

11、定义为常数满秩矩阵,则,其中为常数满秩矩阵的伪逆矩阵;

12、a2、构建得到优化目标函数表达式为:

13、;

14、上式中,为所有缆绳实际张力组成的列向量;为权重系数;、均为增益系数;为第个障碍物在惯性坐标系中的位置;为松弛项,为用于将负载坐标系中的向量转移到惯性坐标系的旋转矩阵;为松弛项的权重矩阵,,、分别为张力匹配权重以及力矩匹配权重;为负载速度;为标称情况下第架无人机所能提供的最大缆绳张力,,为第架无人机的最大推力;、分别为第架与第架无人机在惯性坐标系中的期望位置;为负载位置;、分别为无人机间的安全距离阈值、无人机与障碍物之间的安全距离阈值;为负载安全避障距离阈值;为第架推力故障无人机所能提供的最大缆绳张力,为第架推力正常无人机所能提供的最大缆绳张力;为第根缆绳的实际张力;表示传感器实测的第根缆绳实际张力方向,;为重力加速度;为第根缆绳的长度;为负载质量;

15、求解上述优化目标函数得到最优缆绳实际张力向量,根据最优缆绳实际张力向量进行缆绳张力分配。

16、所述第架故障无人机所能提供的最大缆绳张力是基于故障折扣系数生成:

17、;

18、上式中,为故障折扣系数,其根据故障无人机的推力故障类型设定,。

19、所述零空间缆绳张力分配方法包括:

20、b1、定义期望合力向量,其中表示负载期望合力,表示负载期望合力矩,定义所有缆绳在负载坐标系中的期望张力向量组成的列向量,其中为第根缆绳在负载坐标系中的期望张力向量,为缆绳数量;则有,,其中为第根缆绳在负载坐标系中的悬挂点位置向量;

21、定义满秩矩阵,其中为3阶单位矩阵,为的反对称矩阵,则有;

22、定义零空间张力向量,其中为满秩矩阵的零空间常数基矩阵,为对应的坐标向量,则有,其中为满秩矩阵的伪逆矩阵,;

23、b2、构建期望推力标量值优化模型,求解该模型得到最优零空间坐标向量,基于最优零空间坐标向量计算得到各无人机的最优缆绳实际张力向量;所述期望推力标量值优化模型的表达式为:

24、;

25、上式中,为的调整量;为标称情况下第架无人机所能提供的最大缆绳张力,,为第架无人机的最大推力;为增益系数;、分别为第架与第架无人机在惯性坐标系中的期望位置;为负载位置;、分别为无人机间的安全距离阈值、无人机与障碍物之间的安全距离阈值,为第个障碍物在惯性坐标系中的位置;为用于将负载坐标系中的向量转移到惯性坐标系的旋转矩阵;为第根缆绳的长度。

26、第二方面,本发明提供了一种多无人机吊运系统的缆绳张力容错分配系统,所述缆绳张力容错分配系统包括:

27、推力状态检测模块,用于实时检测所述多无人机吊运系统中的运行状态,基于所述多无人机吊运系统中的运行状态判断当前所述多无人机吊运系统处于推力正常模式还是推力故障模式;

28、第一缆绳张力分配模块,用于在多无人机吊运系统处于推力正常模式时,采用零空间缆绳张力分配方法进行缆绳张力分配;

29、第二缆绳张力分配模块,用于在多无人机吊运系统处于推力故障模式时,采用引入负载安全约束的缆绳张力分配方法进行缆绳张力分配;所述引入负载安全约束的缆绳张力分配方法包括:以最小化待优化的缆绳实际张力向量与缆绳期望张力向量的偏差为优化目标进行缆绳张力分配,在负载安全约束、无人机最大缆绳张力约束与空间避障约束下求解优化目标得到最优缆绳实际张力向量,根据最优缆绳实际张力向量进行缆绳张力分配;所述负载安全约束是针对多无人机吊运系统面对障碍物构建的二阶cbf约束。

30、所述第二缆绳张力分配模块具体根据以下步骤进行缆绳张力分配:

31、a1、定义期望合力向量,其中表示负载期望合力,表示负载期望合力矩,定义负载坐标系中由所有缆绳期望张力向量组成的行向量,其中为第根缆绳在负载坐标系中的期望张力向量,则有,,其中为第根缆绳在负载坐标系中的悬挂点位置向量,为缆绳数量,所述无人机数量与所述缆绳数量相等;

32、设为的反对称矩阵,则,,其中为3阶单位矩阵;

33、定义为常数满秩矩阵,则,其中为常数满秩矩阵的伪逆矩阵;

34、a2、构建得到优化目标函数表达式为:

35、;

36、上式中,为所有缆绳实际张力组成的列向量;为权重系数;、均为增益系数;为第个障碍物在惯性坐标系中的位置;为松弛项,为用于将负载坐标系中的向量转移到惯性坐标系的旋转矩阵;为松弛项的权重矩阵,,、分别为张力匹配权重以及力矩匹配权重;为负载速度;为标称情况下第架无人机所能提供的最大缆绳张力,,为第架无人机的最大推力;、分别为第架与第架无人机在惯性坐标系中的期望位置;为负载位置;、分别为无人机间的安全距离阈值、无人机与障碍物之间的安全距离阈值;为负载安全避障距离阈值;为第架推力故障无人机所能提供的最大缆绳张力,为第架推力正常无人机所能提供的最大缆绳张力;为第根缆绳的实际张力;表示传感器实测的第根缆绳实际张力方向,;为重力加速度;为第根缆绳的长度;为负载质量;

37、求解上述优化目标函数得到最优缆绳实际张力向量,根据最优缆绳实际张力向量进行缆绳张力分配。

38、所述第二缆绳张力分配模块具体根据以下公式生成第架故障无人机所能提供的最大缆绳张力:

39、;

40、上式中,为故障折扣系数,其根据故障无人机的推力故障类型设定,。

41、所述第一缆绳张力分配模块具体根据以下步骤进行缆绳张力分配:

42、b1、定义期望合力向量,其中表示负载期望合力,表示负载期望合力矩,定义所有缆绳在负载坐标系中的期望张力向量组成的列向量,其中为第根缆绳在负载坐标系中的期望张力向量,为缆绳数量;则有,,其中为第根缆绳在负载坐标系中的悬挂点位置向量;

43、定义满秩矩阵,其中为3阶单位矩阵,为的反对称矩阵,则有;

44、定义零空间张力向量,其中为满秩矩阵的零空间常数基矩阵,为对应的坐标向量,则有,其中为满秩矩阵的伪逆矩阵,;

45、b2、构建期望推力标量值优化模型,求解该模型得到最优零空间坐标向量,基于最优零空间坐标向量计算得到各无人机的最优缆绳实际张力向量;所述期望推力标量值优化模型的表达式为:

46、;

47、上式中,为的调整量;为标称情况下第架无人机所能提供的最大缆绳张力,,为第架无人机的最大推力;为增益系数;、分别为第架与第架无人机在惯性坐标系中的期望位置;为负载位置;、分别为无人机间的安全距离阈值、无人机与障碍物之间的安全距离阈值,为第个障碍物在惯性坐标系中的位置;为用于将负载坐标系中的向量转移到惯性坐标系的旋转矩阵;为第根缆绳的长度。

48、第三方面,本发明提出了一种多无人机吊运系统的缆绳张力容错分配设备,所述缆绳张力容错分配设备包括存储器和处理器;所述存储器用于存储计算机程序代码,并将所述计算机程序代码传输给所述处理器;所述处理器用于根据所述计算机程序代码中的指令执行如前述的缆绳张力容错分配方法。

49、第四方面,本发明提出了一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现前述的缆绳张力容错分配方法。

50、与现有技术相比,本发明的有益效果为:

51、1、本发明所述缆绳张力容错分配方法通过检测推力状态,对于无人机推力受限的典型故障场景,采用引入负载安全约束的缆绳张力分配方法进行缆绳张力分配,该方法以缆绳实际张力向量为优化变量,优化过程在负载安全约束、无人机最大缆绳张力约束与空间避障约束下进行,负载安全约束是针对多无人机吊运系统面对障碍物构建的二阶cbf约束,能够在保障负载与无人机避障安全的前提下实现缆绳张力的容错分配;此外,还在无人机最大缆绳张力约束引入了推力折扣系数,更好的细化故障无人机与正常无人机的差异,以提高最终缆绳张力分配精度。

52、2、本发明所述缆绳张力容错分配方法在正常工况下采用零空间缆绳张力分配方法进行缆绳张力分配,利用零空间张力向量所提供的冗余张力对无人机位置进行调整实现避障。