无人机编队转向控制方法与流程

摘要: 本发明涉及无人机编队控制,具体涉及一种无人机编队转向控制方法,具体适用于固定翼无人机、复合翼无人机的固定翼飞行阶段以及其他不能原地悬停的飞行器在执行航线任务时的...
无人机编队转向控制方法与流程

本发明涉及无人机编队控制,具体涉及一种无人机编队转向控制方法,具体适用于固定翼无人机、复合翼无人机的固定翼飞行阶段以及其他不能原地悬停的飞行器在执行航线任务时的编队协同转弯控制。

背景技术:

1、随着无人机集群技术在电力巡检、物流配送、农林植保以及侦察打击、物资投送等领域的广泛应用,多机编队协同飞行成为提升任务效率与覆盖能力的关键手段。固定翼无人机因航时长、速度快、载荷能力大,在远程侦察、广域巡航等场景中承担重要角色;然而固定翼无人机无法悬停,转弯过程必须满足最小转弯半径与速度包线约束,其编队协同控制的难度显著高于旋翼无人机。

2、传统固定翼编队转弯控制通常采用以下方式:1)为所有成员发送相同的航点与转弯参数,各成员在队形中的横向偏移不同,若使用相同的转弯策略(相同的圆心或相同的半径),成员实际转弯路径不一致,导致编队在弯道处发生"剪切"或"拉散"现象-外侧成员路径长、内侧成员路径短,队形在转弯过程中发生形变;2)为所有成员设定相同的空速,当各成员转弯半径不同而空速相同时,外侧成员因路径半径更大而角速度更小,转弯相位逐渐落后,编队绕行圆心转动的角位置产生漂移,转弯结束后难以恢复原有队形;3)将纵向偏移与横向偏移同时叠加进航点,编队偏移包含沿航向的纵向偏移与垂直航向的横向偏移。若将两类偏移不加区分地同时加入航点,会改变入弯距离、圆心几何关系与航点切换条件,使转弯控制的几何推导失去一致性;4)基于瞬时航向角或航点距离判断转弯退出,简单比较当前航向与期望航向、或当前距离与目标距离,在大偏移、大转角或航向跨越±π边界时,容易提前退出转弯或持续盘旋无法退出,造成航迹振荡甚至偏离航线。

3、因此,如何在满足固定翼最小转弯半径与速度范围约束的前提下,使具有不同编队偏移的多架固定翼成员在航线折点处保持相对队形,并可靠地完成转弯进入与退出,是本领域亟待解决的技术问题。

技术实现思路

1、鉴于上述问题,提出了本发明以便提供一种克服上述问题或者至少部分地解决上述问题的无人机编队转向控制方法。

2、本发明提供了一种无人机编队转向控制方法,包括如下的步骤:

3、根据航线中当前航段与下一航段的方向确定转弯方向,并根据各编队成员的横向偏移选择位于转弯最内侧的内侧基准成员;

4、根据所述内侧基准成员的偏置航段构造所有成员转弯的共享圆心,并根据各成员与所述内侧基准成员的横向偏移差为各成员分配互不相同的转弯半径,使所有成员的转弯航迹形成以所述共享圆心为中心的同心圆;其中,所述偏置航段是指根据内侧基准成员的横向偏移对原始航段进行横向平移后得到的航段;

5、按照各成员转弯半径与内侧基准半径的比例关系,为各成员生成对应的期望空速,使各成员绕所述共享圆心保持相同的转动角速度;

6、在转弯过程中跟踪各成员相对所述共享圆心的实际扫过角,当该实际扫过角满足合流几何条件时退出转弯,所述合流几何条件是指与当前转向模式对应的退出判据。

7、在一些实施方式中,确定转弯方向之前,所述方法还包括:读取各编队成员的状态数据、队形偏移数据和航线折点数据;所述队形偏移数据包括各成员在编队期望航向方向上的纵向偏移、垂直于编队期望航向方向上的横向偏移及高度偏移。

8、在一些实施方式中,根据各编队成员的横向偏移选择位于转弯最内侧的内侧基准成员,包括:根据当前航段与下一航段的方向计算有符号转角,当该有符号转角大于零时为左转,当该有符号转角小于零时为右转;右转时选择横向偏移最小的成员作为内侧基准成员,左转时选择横向偏移最大的成员作为内侧基准成员;当存在多个成员横向偏移相同时,按照纵向偏移最大者或成员优先级确定唯一的内侧基准成员。

9、在一些实施方式中,根据各编队成员的横向偏移选择位于转弯最内侧的内侧基准成员之后,包括:

10、根据参考空速vref与允许滚转角φlim计算最小转弯半径:,其中g为重力加速度;

11、根据到点判定距离de与转角δψ,当时,进入双航段相切转弯模式,此时计算自适应半径:,此时内侧基准半径为,max表示取最大值函数;

12、当时,进入单航段相切后合流模式,以rmin作为内侧基准半径,采用单切点盘旋后合流的策略。

13、在一些实施方式中,构造所有成员共享的转弯圆心,包括:在双航段相切转弯模式下,将当前航段与下一航段分别向转弯内侧平移内侧基准半径的距离,取两条平移直线的交点作为共享转弯圆心;在单航段相切后合流模式下,在距离航线折点等于到点判定距离的切入点处,沿航段内法线方向移动内侧基准半径的距离,得到共享转弯圆心;其中,所述转弯内侧是指根据转弯方向确定的航线弯曲一侧。

14、在一些实施方式中,根据各成员与所述内侧基准成员的横向偏移差为各成员分配互不相同的转弯半径,包括:按照下式为各成员分配转弯半径:

15、

16、其中ri表示成员i的转弯半径,rinner表示内侧基准半径,yi表示成员i的横向偏移,yinner表示内侧基准成员的横向偏移,|·|表示绝对值运算。

17、在一些实施方式中,为各成员生成对应的期望空速,包括:按照下式为各成员生成期望空速:

18、

19、其中vi表示成员i的期望空速,sat表示限幅函数,vinner表示内侧基准成员的基准速度,ri表示成员i的转弯半径,rinner表示内侧基准半径,vmin表示成员最小飞行速度,vmax表示成员最大飞行速度;当任一外侧成员的期望空速超出最大飞行速度时,降低内侧基准成员的基准速度,使全部成员在速度包线内重新满足相同的转动角速度。

20、在一些实施方式中,在转弯过程中跟踪各成员相对所述共享圆心的实际扫过角,包括:每个控制周期计算各成员相对共享圆心的当前方位角,按照下式累加得到实际扫过角:

21、

22、

23、其中θk表示第k个控制周期成员相对圆心的方位角,θk-1表示第k-1个控制周期成员相对圆心的方位角,δθk表示相邻周期方位角差归一化后的值,wrap表示角度包装函数,用于将角度差归一化至[-π,π]区间,θk表示第k个控制周期累积的实际扫过角,θk-1表示第k-1个控制周期累积的实际扫过角。

24、在一些实施方式中,当该实际扫过角满足合流几何条件时退出转弯,包括:在双航段相切转弯模式下,当实际扫过角的绝对值达到目标航段转角的绝对值时退出转弯;在所述单航段相切后合流模式下,当成员当前圆周切向方向与合流目标方向的夹角小于预设阈值且实际扫过角达到目标扫角的50%以上时退出转弯;当实际扫过角超过目标扫角与预设保护裕量之和时强制退出转弯;其中,所述目标航段转角是指当前航段与下一航段之间的夹角绝对值,所述目标扫角是指成员绕共享圆心需要转过的总角度。

25、在一些实施方式中,所述方法还包括:在退出转弯后,恢复直线飞行,将成员实际相对位置投影到期望航向,利用纵向误差调整空速;其中,所述纵向误差是指成员实际前后位置与期望纵向偏移之间的偏差。

26、与现有技术相比,本发明获得了如下的至少一种的有益效果:

27、保持队形一致性:通过内侧基准成员构造共享圆心、为各成员分配差异化半径,使所有成员沿同心圆航迹转弯,消除队形剪切与拉散现象;通过半径比例调速实现同角速度约束,保证转弯过程中成员角位置稳定,队形不畸变。

28、转弯进入可靠:双航段相切模式与单航段相切后合流模式的自适应选择,使编队在宽范围航线转角下均能平滑进入转弯,同时满足固定翼最小转弯半径约束。

29、转弯退出可靠:基于实际扫过角的退出判据避免瞬时航向比较在±π边界处的错误判定;切线-合流点夹角与最小扫角比例的组合判据、目标扫角加保护裕量的强制退出判据,确保编队在各种转弯几何下均能可靠退出,防止持续盘旋。

30、横纵向控制解耦:横向偏移进入航迹几何、纵向偏移进入速度控制,避免两类偏移相互干扰,使"位置通道负责横向队形、速度通道负责纵向队形"的分工清晰,控制参数调节互不耦合。

31、计算复杂度低、实时性好:全部几何计算为解析公式,无需迭代求解,适合机载嵌入式平台的实时控制(控制周期可达10ms-30ms量级)。

32、可扩展性强:转弯模式、半径、扫角阈值、保护裕量等参数均可由机型参数、实时空速、风场或安全包线动态确定,适配不同机型与任务场景。

33、上述说明仅是本发明技术方案的概述,为了能够更清楚了解本发明的技术手段,而可依照说明书的内容予以实施,并且为了让本发明的上述和其它目的、特征和优点能够更明显易懂,以下特举本发明的具体实施方式。