低空运行的无人机异构故障自重构控制方法及控制系统与流程

摘要: 本发明属于无人机控制,尤其涉及一种低空运行的无人机异构故障自重构控制方法及控制系统。背景技术:1、目前,无人机动力失效后的容错处理主要依赖以下技术:2、静态控制...
低空运行的无人机异构故障自重构控制方法及控制系统与流程

本发明属于无人机控制,尤其涉及一种低空运行的无人机异构故障自重构控制方法及控制系统。

背景技术:

1、目前,无人机动力失效后的容错处理主要依赖以下技术:

2、静态控制分配(static ca):预先设定好电机的权重,当某个电机失效时,通过离线计算好的矩阵尝试重新分配力矩;

3、被动容错控制(pftc):利用鲁棒控制器(如滑模控制)的厚实增益来掩盖执行器效率的下降;

4、硬件冗余法:采用六旋翼或八旋翼构型,依靠多余的动力单元提供物理缓冲。

5、上述方案存在以下问题:

6、容错边界模糊:传统方案大多假定“只要还有电机转,就能飞”。但在高密度飞行中,如果剩余动力不足以抵御阵风,无人机会发生不可控漂移,威胁航路安全。现有方案缺乏对“剩余控制能力流形”的实时定量评估;

7、四旋翼等构型失效即坠毁:绝大多数现有的自重构算法在面对四旋翼单旋翼失效(丢失25%动力且失去偏航平衡)时,会由于偏航力矩不平衡导致机体剧烈翻滚下坠;

8、切换过程的动力学突变:故障发生到算法介入之间存在“硬切换”过程,容易诱发电机电流瞬时过载(spike),导致电调二次烧毁或电池保护性断电。

技术实现思路

1、本发明的目的在于提供一种低空运行的无人机异构故障自重构控制方法及控制系统,旨在解决上述问题。

2、本发明是这样实现的,一种低空运行的无人机异构故障自重构控制方法,所述方法包括以下步骤:

3、步骤s1:实时获取无人机各执行器的运行数据,通过遥测无人机的电流、转速及机体角加速度异常项,估计各执行器的实时动力效率因子;

4、步骤s2:构建从虚拟控制空间到物理执行器空间的映射矩阵b,当检测到执行器动力效率异常时,通过引入包含动力效率因子的健康因子矩阵,实时更新映射矩阵为故障态物理映射矩阵;

5、步骤s3:基于重构后的映射矩阵,实时计算当前动力系统可提供的控制力矩流形,判断动力系统是否满足全状态受控条件,若满足全状态受控条件,则执行动力均衡分配策略以维持原飞行姿态并执行步骤s5,若不满足全状态受控条件则执行步骤s4;

6、步骤s4:主动切换至降级运行模式,通过放弃部分非核心自由度的控制权,利用剩余动力合力维持机体核心姿态稳定或进入受控自旋下降状态并执行步骤s5;

7、步骤s5:通过引入一阶滤波器平滑故障切换瞬间及矩阵降维过程中的力矩指令突变;

8、步骤s6:输出重构后的电机控制指令并向交管系统同步故障状态及着陆航向。

9、本发明的进一步技术方案是:所述执行器异构故障包括不同规格螺旋桨损坏、电机堵转、电调过热限制及电池瞬时跌落在内的动力系统非对称失效。

10、本发明的进一步技术方案是:步骤s1中,所述动力效率因子,其中表示执行器完全正常,表示执行器完全失效,所述动力效率因子通过结合滑模观测器与电机转速及扭矩映射表的混合观测器实时计算得出。

11、本发明的进一步技术方案是:在步骤s2和s4中,采用加权最小二乘法求解执行器输出矢量,设当前激活的期望力矩向量为,对应的降维或全维映射矩阵为,为防止健康电机瞬间过载,系统求解如下受等式约束的控制分配优化问题:

12、,

13、,

14、该约束优化问题的解析解严格等价求解为:

15、,

16、其中,j为优化目标函数;u为待求解的执行器控制输入向量;为对角控制输入权重矩阵,当某电机受损时,算法将该电机对应的对角线权重调大作为极大的惩罚项,强制将力矩指令在数学解析上精确分配至相邻的健康电机。

17、本发明的进一步技术方案是:在步骤s4中,在检测到单个或多个旋翼完全失效导致航向力矩不可控时,所述动态矩阵降维机制表现为:主动放弃航向角锁死,将标称状态下四维的期望力矩向量降维为三维向量,同步剔除映射矩阵中对应的偏航控制行;通过非对称分配剩余旋翼的推力,迫使机体绕中心z轴旋转,将推力分配与机体自旋产生的陀螺效应相耦合,维持俯仰与横滚角的平稳,实现受控缓降。

18、本发明的进一步技术方案是:受控自旋下降状态中,无人机放弃偏航力矩的控制权,将偏航通道的权重设为零,全力保障总推力以及俯仰、滚转力矩的平衡,使得机体以预设角速度范围在空中自旋,同时维持水平姿态误差在度以内,垂直下降速度控制在以下。

19、本发明的进一步技术方案是:步骤s5具体步骤为:为了防止控制逻辑硬切换引起的电流突刺,在控制力矩输出端引入一阶低通动态面滤波器,其中时间常数取匹配实际电机的物理惯性常数,是虚拟控制面状态变量,为滤波后控制指令的时间导数,为补偿低通滤波带来的系统相位滞后,附加微分前馈补偿,最终输出指令,为微分前馈增益系数,是最终输出至物理电子调速器的安全平滑控制信号。

20、本发明的进一步技术方案是:步骤s3中,根据当前风场强度及载荷重量,实时解算执行器在故障态下的功率冗余度,并向低空交通管理平台发送安全预警及紧急着陆航向需求。

21、本发明的另一目的在于提供一种低空运行的无人机异构故障自重构控制方法的控制系统,包括:

22、健康监测模块:用于实时获取无人机各执行器的运行数据,通过遥测无人机的电流、转速及机体角加速度异常项,估计各执行器的实时动力效率因子;

23、自重构控制分配模块:用于构建从虚拟控制空间到物理执行器空间的映射矩阵,并根据实时更新权重或触发矩阵降维;

24、降级控制逻辑单元:用于实时计算当前控制力矩流形,支持通过动态面滤波平滑实现全受控状态到部分受控状态的无缝切换;

25、应急决策接口:用于输出重构后的平滑指令,与低空高密度运行网络通信,同步故障状态及功率冗余度,执行协同避让动作。

26、本发明的进一步技术方案是:所述系统具备异构适配性,能够自动识别并加载对应四旋翼、六旋翼、八旋翼或倾转旋翼飞行器的动力几何配置方案。

27、本发明的有益效果是:使得传统的四旋翼无人机在单桨全失效的情况下,依然具备90%以上的受控缓降成功率,避免了直接“炸机”造成的地面人员伤亡,通过实时上报“功率冗余度”,云端交管平台可提前判定故障机是否需紧急避让,减少了高密度空域发生二次碰撞的概率。

1.一种低空运行的无人机异构故障自重构控制方法,其特征在于,所述方法包括以下步骤:

2.根据权利要求1所述的低空运行的无人机异构故障自重构控制方法,其特征在于,所述执行器异构故障包括不同规格螺旋桨损坏、电机堵转、电调过热限制及电池瞬时跌落在内的动力系统非对称失效。

3.根据权利要求1所述的低空运行的无人机异构故障自重构控制方法,其特征在于,步骤s1中,所述动力效率因子,其中表示执行器完全正常,表示执行器完全失效,所述动力效率因子通过结合滑模观测器与电机转速及扭矩映射表的混合观测器实时计算得出。

4.根据权利要求1所述的低空运行的无人机异构故障自重构控制方法,其特征在于,在步骤s2和s4中,采用加权最小二乘法求解执行器输出矢量,设当前激活的期望力矩向量为,对应的降维或全维映射矩阵为,为防止健康电机瞬间过载,系统求解如下受等式约束的控制分配优化问题:

5.根据权利要求1所述的低空运行的无人机异构故障自重构控制方法,其特征在于,在步骤s4中,在检测到单个或多个旋翼完全失效导致航向力矩不可控时,所述动态矩阵降维机制表现为:主动放弃航向角锁死,将标称状态下四维的期望力矩向量降维为三维向量,同步剔除映射矩阵中对应的偏航控制行;通过非对称分配剩余旋翼的推力,迫使机体绕中心z轴旋转,将推力分配与机体自旋产生的陀螺效应相耦合,维持俯仰与横滚角的平稳,实现受控缓降。

6.根据权利要求1所述的低空运行的无人机异构故障自重构控制方法,其特征在于,受控自旋下降状态中,无人机放弃偏航力矩的控制权,将偏航通道的权重设为零,全力保障总推力以及俯仰、滚转力矩的平衡,使得机体以预设角速度范围在空中自旋,同时维持水平姿态误差在度以内,垂直下降速度控制在以下。

7.根据权利要求1所述的低空运行的无人机异构故障自重构控制方法,其特征在于,步骤s5具体步骤为:为了防止控制逻辑硬切换引起的电流突刺,在控制力矩输出端引入一阶低通动态面滤波器,其中时间常数取匹配实际电机的物理惯性常数,是虚拟控制面状态变量,为滤波后控制指令的时间导数,为补偿低通滤波带来的系统相位滞后,附加微分前馈补偿,最终输出指令,为微分前馈增益系数,是最终输出至物理电子调速器的安全平滑控制信号。

8.根据权利要求1所述的低空运行的无人机异构故障自重构控制方法,其特征在于,步骤s3中,根据当前风场强度及载荷重量,实时解算执行器在故障态下的功率冗余度,并向低空交通管理平台发送安全预警及紧急着陆航向需求。

9.一种实现权利要求1至8任一项所述低空运行的无人机异构故障自重构控制方法的控制系统,其特征在于,包括:

10.根据权利要求9所述的一种低空运行的无人机异构故障自重构控制方法的控制系统,其特征在于,所述系统具备异构适配性,能够自动识别并加载对应四旋翼、六旋翼、八旋翼或倾转旋翼飞行器的动力几何配置方案。