一种预设性能事件触发的空地异构协同控制方法及系统
本发明涉及无人系统协同控制,特别是涉及一种预设性能事件触发的空地异构协同控制方法及系统。
背景技术:
1、空地异构无人系统通常由至少一个无人地面车辆和至少一个无人飞行器组成。无人地面车辆能够承担持续运行、载荷运输和近地交互任务,无人飞行器具有越障、俯视感知和快速机动能力,二者在巡检、搜救、灾害评估、应急通信、仓储搬运及复杂环境测绘等任务中具有明显的互补性。如何实现空中平台与地面平台安全、稳定的协同运动,是此类系统走向工程应用的关键问题。
2、现有空地协同控制方法通常按照平台类别分别建立运动学或动力学模型,再通过领航跟随、虚拟结构或一致性算法实现编队保持;在需要避障时,往往在编队控制器外部叠加人工势场、局部规划器或切换逻辑。然而,无人地面车辆受到非完整约束,无人飞行器则具有欠驱动和气动阻尼等特性,不同平台的误差坐标、控制输入和稳定性分析难以统一,导致控制结构和参数需要针对不同平台重复设计,工程实现复杂度较高。
3、在通信资源受限的场景中,按照固定频率向各个执行单元发送控制指令会产生大量重复数据传输;当控制输入发生饱和、无线链路存在丢包或时延、环境中存在风扰和地面侧滑时,简单的周期控制可能导致编队误差放大或产生持续振荡。事件触发控制虽然能够减少不必要的指令更新,但采用单一触发阈值的事件触发策略难以兼顾各控制通道的不同变化速度,通信资源的利用仍然不够充分。
4、此外,单独叠加编队吸引项和障碍排斥项可能出现向量相互抵消的局部平衡点,导致无人平台在障碍物附近停滞或反复摆动,存在安全风险;传统控制方法通常只给出渐近收敛结论,未对过渡过程中的误差包络进行预先限定,也未同时处理未知扰动、执行器饱和和事件触发保持误差对闭环性能的影响。上述问题降低了复杂环境下空地协同控制的安全性、可复现性和通信利用率。
5、因此,需要一种能够将空中平台和地面平台统一到同一任务层模型中,将编队保持与障碍规避融合为连续引导场,并在未知扰动、输入饱和和有限通信条件下同时保证误差性能、闭环有界和非芝诺触发的协同控制技术。
技术实现思路
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、通过分量式事件触发机制,仅在某一控制通道的保持误差达到对应触发阈值时更新该通道的控制指令,其余通道保持上一触发时刻的控制指令,在保证闭环控制性能的同时,减少了不必要的控制指令更新,降低了通信量和控制器重复计算次数。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com