面向长航时大尺度柔性载荷吊运任务的异构无人机群控制方法
本发明涉及无人机协同运输与任务规划,尤其是涉及一种面向长航时大尺度柔性载荷吊运任务的异构无人机群控制方法。
背景技术:
1、随着无人机平台、集群通信、低空自主导航和多机协同控制技术的发展,多无人机协同吊运逐渐应用于复杂地形物资输送、野外应急保障、消防供水、临时能源补给和工程管线布设等任务。与地面车辆、有人直升机或固定吊装设备相比,无人机群能够越过山地、峡谷、河流、林地、塌方道路和临时障碍,在缺少道路或地面通行条件受限的区域快速形成空中运输能力。对于输油软管、消防水带、柔性输送管线、长条形工程构件等大尺度柔性载荷,空中吊运还需要兼顾长距离运输、持续悬停、末端对接、载荷稳定和安全回收等要求,任务复杂度明显高于普通刚性外载荷运输。
2、现有单机吊运方法多面向小型刚性载荷或短时间吊挂任务,通常将载荷视为质点、刚体或单一吊挂摆体,通过位置跟踪、吊挂角反馈和消摆控制实现基本运输。在长航时大尺度柔性载荷场景中,单架无人机不仅难以提供足够的载荷能力和航时裕度,也难以通过单一挂点约束载荷主体的弯曲、扭转和下垂。当柔性载荷的末端需要与油罐接口、消防喷射点、临时管线接口或工程连接点进行精确对接时,单机吊运方式更难同时满足载荷主体稳定和末端位姿精调要求。
3、现有多无人机吊运研究通常采用同质无人机群,利用多点悬挂分担载荷重量并保持编队构型。该类方法在刚性平台、规则载荷或短距离运输场景下具有一定可行性,但对于长航时任务和大尺度柔性载荷仍存在不足。若全部采用大载荷油动平台,能够提供较高载重和较长航时,却往往机动响应较慢、末端微调精度不足;若全部采用多旋翼电动平台,则机动灵活但载重能力和续航能力有限,难以支撑长距离、大载荷、持续作业任务。因此,单一机型或同质编队难以兼顾主吊承载、长航时续航和末端高精度控制。
4、大尺度柔性载荷的动力学特性也明显不同于常规刚体载荷。柔性载荷在多个吊点牵引下会发生整体下垂、局部弯曲、扭转变形和横向振动,其形变状态与吊点受力、无人机相对位置、飞行加速度、风场扰动和载荷自身材料特性相互耦合。对于输油软管、消防水带等含流体载荷,内部流体速度变化、压力波动、启停冲击和弯曲段流固耦合还会形成时变动载扰动,使载荷等效质量、阻尼、刚度和末端位姿随任务阶段动态变化。若仅将柔性载荷简化为刚体或简单摆体,难以准确描述载荷形变、内部流体动载和无人机吊挂受力之间的耦合关系。
5、在轨迹规划方面,现有无人机群规划方法多以路径长度、避障距离、单机能耗或队形保持为主要目标,较少将载荷形变、吊点受力变化、末端对接误差、异构机型能力差异和长航时能量衰减统一纳入规划过程。长航时任务中,主吊平台和精调平台的能量类型、消耗速率和可用推力裕度并不相同;主吊机型通常关注燃料剩余和载荷承载效率,精调机型则更易受到电池电量、机动频率和末端误差修正强度影响。若规划阶段不考虑能量裕度、返航预留、群体能量均衡和风险等级,可能导致任务后段出现单机能量不足、队形不可维持或无法安全返航的问题。
6、在控制方面,传统pid控制、常规自适应控制或单一滑模控制方法难以充分适应异构无人机群和大尺度柔性载荷的耦合特性。主吊机型需要在较大吊挂力和能量效率约束下保持载荷主体稳定,精调机型需要在较小载荷能力和高机动响应条件下实现末端位姿快速收敛,两类机型的控制目标、动力学特性、执行裕度和扰动敏感性均不相同。若采用统一控制律或仅根据编队误差分配控制输入,容易出现主吊响应迟滞、精调过度补偿、载荷局部变形放大或末端对接误差难以收敛等问题。
7、此外,复杂地形下的长航时吊运任务往往伴随风场变化、障碍物接近、通信链路波动、定位误差累积和载荷参数漂移。现有方法通常将规划、控制和安全评估分开处理,缺少能够依据实时能量状态、载荷形变、吊点受力、末端位姿误差和环境风险自动调整的闭环机制。当出现突发阵风、载荷形变超限、障碍距离不足、通信质量下降、主吊能量不足或精调机型推力裕度不足时,如果不能及时执行局部轨迹修正、全局轨迹重构、异构队形调整、安全悬停、缓降或回收处置,将直接影响任务连续性和作业安全。
8、中国专利申请公开号cn122237587a提供了面向长航时大尺度柔性载荷吊运任务的异构无人机群任务规划方法,采用异构无人机群任务规划方法,通过离散化建模载荷结构,构建吊挂候选节点集,结合无人机能力评估和任务需求,建立吊挂节点与无人机的匹配代价模型和张力分配模型,生成协同航迹规划,并进行能量预测与接力规划,构建在线调整与重规划机制。然而,其本质上是一种侧重规划与接力调度的方案,聚焦于近竖直姿态约束和吊挂节点-无人机匹配,但并未揭示如何构建耦合动力学模型,也未给出基于该模型进行实时状态估计并据此生成对载荷主体稳定和末端精密作业进行差异化鲁棒控制的闭环手段,导致其在应对复杂动态扰动和全过程精密稳定控制方面存在不足。
9、因此,需要一种面向长航时大尺度柔性载荷吊运任务的异构无人机群轨迹规划与鲁棒控制方法,以适应复杂地形下长距离、长航时和高安全要求的柔性载荷空中作业。
技术实现思路
1、本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种面向长航时大尺度柔性载荷吊运任务的异构无人机群控制方法,以解决或部分解决在载荷大范围形变、内部流体动载、外界扰动和能量持续衰减的耦合影响下,难以实现从起吊、巡航、避障到末端精密作业全过程的安全稳定控制的问题。
2、本发明的目的可以通过以下技术方案来实现:
3、本发明的一个方面,提供了一种面向长航时大尺度柔性载荷吊运任务的异构无人机群控制方法,所述异构无人机群包括用于承载和牵引柔性载荷主体的主吊机型,以及用于载荷末端位姿微调和局部扰动抵消的精调机型,所述异构无人机群控制方法包括如下步骤:
4、构建将主吊机型、精调机型、吊挂机构、大尺度柔性载荷、内部流体动载和外界扰动作为统一耦合系统的动力学模型;
5、获取无人机群状态、载荷传感器信息及环境信息,并基于所述动力学模型在线估计柔性载荷形变、内部动载、末端位姿及环境扰动,在传感器信息短时不可用时利用所述动力学模型预测维持状态连续;
6、根据任务阶段和估计结果动态生成安全约束;
7、在所述安全约束下进行分层协同轨迹规划,生成主吊机型参考轨迹、精调机型参考轨迹和载荷参考轨迹;
8、根据所述参考轨迹和估计结果,生成针对主吊机型和精调机型的差异化控制指令,其中,主吊机型控制指令以载荷主体稳定、吊点受力均衡和能量衰减补偿为目标,精调机型控制指令以末端位姿误差收敛和局部扰动抑制为目标,并对系统扰动和模型不确定性进行补偿;
9、计算融合能量裕度、载荷安全裕度、障碍接近风险和末端作业风险的综合风险指标,根据所述综合风险指标执行在线重规划,当风险超过预设阈值时调整轨迹、控制参数或切换至安全处置模式。
10、作为优选的技术方案,构建所述统一耦合系统的动力学模型的过程包括如下步骤:
11、建立异构无人机群吊运系统的协同控制状态描述,获取并统一主吊机型状态、精调机型状态、柔性载荷状态、吊挂受力、环境扰动和能量状态信息;
12、构建大尺度柔性载荷的结构-流体-吊挂耦合动力学模型,将柔性载荷沿长度方向划分为多个可变形单元,建立包含结构惯性、弹性恢复、阻尼、内部流体动载和吊点牵引力的载荷动力学方程;
13、将主吊机型的吊点牵引映射为载荷主体受力,将精调机型的末端调姿作用映射为端部位姿修正力或修正力矩,使载荷形变、内部流体动载、吊点牵引力及外界风扰在同一动力学方程中耦合。
14、作为优选的技术方案,所述在线估计柔性载荷形变、内部动载、末端位姿及环境扰动的过程包括如下步骤:
15、根据任务阶段对不同来源的传感器信息赋予不同权重,起吊阶段提高吊点受力和载荷形变权重,巡航阶段提高风场扰动和能量状态权重,对接阶段提高末端视觉或激光定位权重;
16、当视觉、流速或通信数据短时不可用时,利用所述动力学模型及历史状态进行预测补偿,维持状态估计连续。
17、作为优选的技术方案,所述安全约束至少包括载荷最大形变约束、吊点受力约束、能量返航预留约束和末端作业误差约束,且各项约束阈值随任务阶段动态更新:
18、起吊阶段限制吊点受力变化率和载荷离地姿态;
19、巡航阶段提高能量续航和载荷最大形变约束权重;避障阶段提高障碍安全距离约束;
20、对接阶段限制末端位姿误差和末端接近速度;
21、回收阶段加入返航预留能量条件。
22、作为优选的技术方案,所述分层协同轨迹规划包括全局层、阶段层和局部层:
23、全局层确定跨区域运输通道和关键任务节点;
24、阶段层根据当前任务阶段改变优化权重,起吊阶段提高吊点受力平衡权重,巡航阶段提高能量效率权重,避障阶段提高障碍安全距离权重,对接阶段提高末端位姿精度权重;
25、局部层根据实时扰动、载荷形变和能量状态对短时间窗口内的速度、曲率和队形进行平滑修正,并且主吊轨迹侧重载荷主体稳定和能量效率,精调轨迹侧重末端位姿误差收敛和局部扰动抵消。
26、作为优选的技术方案,所述差异化控制指令的生成过程包括如下步骤:
27、主吊机型控制律根据载荷主体形变、吊点受力均衡和当前能量裕度生成稳定承载控制输入;
28、精调机型控制律根据末端位姿误差、局部载荷扰动和相对构型误差生成快速微调控制输入,所述控制指令中包括基于扰动观测器的补偿项、基于流体和风场预测的前馈补偿项、终端滑模鲁棒项,以及根据无人机能量衰减程度进行修正的控制增益。
29、作为优选的技术方案,所述差异化控制指令中还包括协同耦合项,当载荷形变增大时,优先限制主吊机型轨迹曲率和加速度;当末端位姿误差增大时,提高精调机型的末端校正权重;当无人机能量裕度下降时,降低高能耗机动并在多架主吊机型之间进行能量均衡分配。
30、作为优选的技术方案,计算综合风险指标,执行在线重规划的过程包括如下步骤:
31、由能量风险、载荷形变风险、吊点受力风险、障碍接近风险和末端对接风险加权求和得到综合风险指标,并设置预警阈值和紧急阈值,根据所述综合风险指标将系统状态划分为正常、预警和紧急状态,当处于预警状态时保持全局通道并调整局部速度、队形和控制参数,当处于紧急状态时触发运输通道重选或进入安全悬停与缓降回收处置;
32、通过滞回区间和状态保持时间实现在线重规划的触发;
33、触发在线重规划时,若风险主要来自能量不足,则优先降低速度并调整主吊与精调之间的载荷分担,若风险主要来自载荷形变超限,则优先降低加速度和曲率,若风险主要来自障碍接近,则执行局部绕障。
34、作为优选的技术方案,所述任务阶段包括起吊、巡航、避障、对接、落放和回收阶段,在起吊阶段执行预张紧、离地确认和构型校正以形成稳定吊运构型,在巡航阶段控制主吊机型沿载荷参考轨迹保持稳定并限制能耗,在避障阶段基于载荷全长空间包络调整飞行路径,在末端对接或落放阶段由精调机型执行末端位姿微调,并在满足安全条件后完成连接确认和回收,
35、其中,起吊阶段中,依次经历预张紧、离地确认、低高度悬停和构型校正阶段:
36、在预张紧阶段确认各吊点连接有效并消除松弛;
37、在离地确认阶段判断载荷是否发生非预期弯折或局部拖拽;
38、在低高度悬停阶段估计初始形变和内部流体动载;
39、在构型校正阶段调整主吊间距和精调末端位置;
40、仅在吊点受力分布满足有效承载条件且载荷形变未超过阈值时,才切换至巡航阶段。
41、作为优选的技术方案,在末端对接或落放完成后,仍保持短时监测,确认末端连接状态、载荷残余形变、吊点受力释放过程和无人机剩余能量满足安全退出条件;无人机回收阶段根据剩余能量和环境风险选择返航、就近降落或待命悬停模式,并记录任务过程中的能量消耗、载荷形变峰值和重规划次数,用于后续同类任务的参数调整。
42、本发明的另一个方面,提供了一种电子设备,包括一个或多个处理器、存储器和被存储在存储器中的一个或多个程序,所述一个或多个程序包括用于执行前述面向长航时大尺度柔性载荷吊运任务的异构无人机群控制方法的指令。
43、与现有技术相比,本发明至少具有以下有益效果之一:
44、(1)兼顾大载荷承载、长航时续航与末端高精度作业:本发明中异构无人机群包括用于承载和牵引柔性载荷主体的主吊机型,以及用于载荷末端位姿微调和局部扰动抵消的精调机型,通过二元异构分工,利用主吊机型长航时大载荷能力保障主体运输和能量效率、利用精调机型高机动性保障末端精密作业,避免了同构平台在能力上的顾此失彼。
45、(2)真实反映结构-流体-吊挂整体动力学行为:针对大尺度柔性载荷结构变形、内部流体动载与吊挂受力相互耦合导致模型不准、控制失稳的问题,本发明构建将主吊机型、精调机型、吊挂机构、大尺度柔性载荷、内部流体动载和外界扰动作为统一耦合系统的动力学模型,其中将柔性载荷离散为多个可变形单元,使载荷形变、吊点受力、内部流体动载和无人机运动状态在同一状态空间内耦合,将主吊机型的吊点牵引映射为载荷主体受力,将精调机型的末端调姿作用映射为端部位姿修正力或修正力矩,真实反映结构-流体-吊挂整体动力学行为,为后续控制提供了精确一致的对象模型。
46、(3)避免因局部传感器异常引起的控制跳变:本发明基于耦合动力学模型在线估计柔性载荷形变、内部动载、末端位姿及环境扰动,在传感器信息短时不可用时利用模型预测维持状态连续,根据任务阶段对不同传感器赋予不同权重,在不同测量条件下均能获得连续、可靠状态输入。
47、(4)保障长航时全过程的实时安全裕度:针对固定安全阈值无法适应长航时飞行中能量持续衰减和阶段风险动态变化的难题,本发明根据任务阶段和估计结果动态生成安全约束集合,其中,安全约束集合至少包括载荷最大形变约束、吊点受力约束、能量返航预留约束和末端作业误差约束,在起吊、巡航、避障、对接等不同阶段动态收紧关键安全边界、同时释放非关键约束,从而保障长航时全过程的实时安全裕度。
48、(5)兼顾全局可达、阶段最优和局部抗扰平滑:本发明在安全约束下进行分层协同轨迹规划,生成主吊机型参考轨迹、精调机型参考轨迹和载荷参考轨迹,规划包括全局运输通道生成、基于任务阶段调整优化权重,以及基于实时状态对局部轨迹进行平滑修正,达到了在长距离运输中保证全局可返航、在具体作业段保证目标收敛、在强扰动段保证载荷低振动和吊点受力平滑的三层协同效果。
49、(6)克服载荷主体稳定与末端精度相互干扰:针对异构机型功能定位不同却采用同质化控制律,导致载荷主体稳定与末端精度相互干扰的问题,本发明生成针对主吊机型和精调机型的差异化控制指令,其中,主吊机型控制指令以载荷主体稳定、吊点受力均衡和能量衰减补偿为目标,精调机型控制指令以末端位姿误差收敛和局部扰动抑制为目标,并对系统扰动和模型不确定性进行补偿,并引入协同耦合项,使得主吊机型维持大尺度载荷平稳低能耗飞行、精调机型快速抑制末端偏差,并通过协同耦合项避免相互抵触的差异化控制。
50、(7)实现综合最优处置决策:针对长航时飞行中能量不足、载荷形变超限、障碍接近等多维风险交叉累积,传统单阈值判别难以做出综合最优处置决策的问题,本发明通过计算融合能量裕度、载荷安全裕度、障碍接近风险和末端作业风险的综合风险指标,根据综合风险指标执行在线重规划,当风险超过预设阈值时调整轨迹、控制参数或切换至安全处置模式,从多风险交叉角度进行全局安全权衡,能够根据主导风险来源自动选择降速、绕障或安全缓降等最适宜的处置策略,避免单一指标引发的过度保守或危险操作。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com