CN112731962A - 一种多无人系统协同编队控制方法 - Google Patents

Abstract

本发明涉及一种多无人系统协同编队控制方法，首先建立编队无人机质点模型，进行队形内僚机位置和速度计算，再队形跟踪控制率设计和队形自主避障控制率设计。本发明协同编队控制的有益效果：①协同编队控制，可以实现多无人系统的协同控制，编队控制；②协同编队控制，可以为多无人系统侦查打击同一目标提供基础；③协同编队控制，是未来无人作战以及集群作战的技术核心，也是未来军事研究的一个重点，该研究为未来无人机群协同打击敌方目标提供理论支撑和工程实践参考。

Description

一种多无人系统协同编队控制方法

技术领域

本发明属于无人机应用技术领域，涉及无人系统，具体涉及一种多无人系统协同编队控制方法。

背景技术

随着科学技术的发展，无人作战系统在军事领域的应用越来越广泛。多无人系统的协同编队控制是多无人系统的基础与核心。通过多无人系统的系统编队控制可以实现多无人系统的协同控制，集群控制在未来无人作战打击具有非常重要的影响，也是未来无人集群作战的发展方向。根据上级作战任务，在作战行动过程中实时交互处理各无人装备间的协同信息，结合无人装备的作战能力，生成并提供执行任务所需的任务序列、行动轨迹和协同控制指令，无人装备控制系统依据协同控制组件提供的行动轨迹和控制指令进行本地平台控制，实现多无人装备的协同作战。可以通过参数预装或实时更改设定，具备面向各无人装备的运动性能的自适应功能，通过信息输入实现不同性能无人装备的最佳协同状态。因此多无人系统的协同编队控制对未来作战具有重要作用。协同编队控制可以使得多个无人系统侦查打击统一目标，可以变换队形躲避敌方防控识别区，是未来集群作战的关键技术。

发明内容

要解决的技术问题

为了避免现有技术的不足之处，本发明提出一种多无人系统协同编队控制方法。

技术方案

一种多无人系统协同编队控制方法，其特征在于步骤如下：

步骤1：建立编队无人机质点模型

式中：

为速度坐标系下第i个无人机的位置微分，θ_i为第i个弹道倾角，ψ_i为第i个无人机的弹道偏角，n_ix为速度方向过载，n_iy为速度平面内垂直于速度方向的法向过载，n_iz为垂直于速度所在平面上的侧向过载。

为第i个无人机的俯仰角微分，

为航向角微分，L为长机，f_i为僚机；

将速度坐标系转换到地面坐标系转换矩阵：

L'_{速度2地面}为速度坐标系到地面坐标系的转置矩阵，L_{地面2速度}为速度坐标系到地面坐标系；

步骤2：队形内僚机的位置和速度计算

①僚机位置计算

1)依据僚机编号，计算其距离长机的间距；依据队形角度，计算其相对于长机位置[dx；dy；dz]；

2)依据长机速度与地面欧拉角：弹道倾角θ、弹道偏角ψ，将僚机相对位置转换到地面系，再加上长机坐标偏移，得到编队中各点在地面系中的位置；此位置即为各僚机进行制导时需要跟踪的位置指令；

②僚机速度计算

V_f＝V_L+ω×r

僚机的旋转速度ω来自于长机速度方向的旋转，即纵向平面内的弹道倾角速率

与横向平面内的弹道偏角速率

V_L为僚机在队形中的速度，r为僚机在距离长机位置；

步骤3：队形跟踪控制率

队形跟踪位置，速度反馈控制率

其中：c_1i，c_2i为控制器参数，P_i,cmd为第i个僚机的位置指令向量，P_i,real为第i个僚机的实际位置向量，V_i,cmd为第i个僚机的速度指令，V_i,real为第i个僚机的实际速度， a_x1i,a_y1i,a_z1i为第i个僚机在地面坐标系中的加速度指令，通过坐标旋转，将其转换为速度系下的加速度指令；

步骤4：队形自主避障控制率

其中：a_avoid为避障指令，P_i为第i个僚机位置向量，O_i第i障碍物与僚机最近点坐标，l为距离障碍点距离，d为距离障碍点最小距离求，r为势能场参数；

步骤5：以队形跟踪控制率和队形自主避障控制率对多无人机进行协同控制。

有益效果

本发明提出的一种多无人系统协同编队控制方法，首先建立编队无人机质点模型，进行队形内僚机位置和速度计算，再队形跟踪控制率设计和队形自主避障控制率设计。本发明协同编队控制的有益效果：

①协同编队控制，可以实现多无人系统的协同控制，编队控制；

②协同编队控制，可以为多无人系统侦查打击同一目标提供基础；

③协同编队控制，是未来无人作战以及集群作战的技术核心，也是未来军事研究的一个重点，该研究为未来无人机群协同打击敌方目标提供理论支撑和工程实践参考。

附图说明

图1：编队控制系统示意图

图2：编队中各僚机位置示意图

图3：三角形编队示意图

图4：编队指令跟踪情况

图5：各僚机控制指令大小(m/s^2)

具体实施方式

现结合实施例、附图对本发明作进一步描述：

多无人系统协同编队控制系统主要包含两个部分：

(1)队形生成；

(2)队形跟踪。

其中，队形生成模块是根据队形指令、长机飞行状态，生成队形内各僚机相对位置、速度；队形跟踪模块是根据各僚机实际飞行的位置、速度进行控制，使得其飞行状态跟踪上所生成的队形。编队控制系统示意图见图2所示。

协同编队控制系统包含如下几个部分：

①编队无人机质点模型建立；

②队形内僚机位置与速度计算；

③队形跟踪控制器设计；

④编队自主避障控制器设计。

下面分别进行详细叙述具体的实施过程。

步骤1，建立编队无人机质点模型：

无人机采用质点模型，三个控制指令分别为：沿速度方向n_x，速度平面内垂直于速度方向的法向过载n_y，垂直于速度所在平面的侧向过载n_z。

式(1)中，

为速度坐标系下第i个无人机的位置微分，θ_i为第i个弹道倾角，ψ_i为第i个无人机的弹道偏角，n_ix为速度方向过载，n_iy为速度平面内垂直于速度方向的法向过载，n_iz为垂直于速度所在平面上的侧向过载。

为第i个无人机的俯仰角微分，

为航向角微分,L为长机，f_i为僚机。

坐标系转换：

速度坐标系转换到地面坐标系转换矩阵：

L'_{速度2地面}为速度坐标系到地面坐标系的转置矩阵，L_{地面2速度}为速度坐标系到地面坐标系。

步骤2，队形内僚机位置和速度计算

考虑弹载计算机运算能力，队形在变换过程中，各僚机所处的位置编号预设好。编队飞行过程实际上是各僚机在长机的速度坐标系内保持相对静止。

①僚机位置计算

计算步骤：

1)根据僚机编号，计算相对于长机的距离，并根据队形角要求，计算各僚机相对位置[dx；dy；dz]。

2)根据长机速度系与地面系欧拉角，将各僚机相对位置转换到地面系，作为各僚机跟踪指令。

②僚机速度计算

为了在队形跟踪时达到更好的跟踪效果，除了需要令僚机编队对设计队形的位置进行跟踪以外，还需要对设计队形的速度进行跟踪。

队形变换中，根据僚机相对于长机的旋转，可以得到僚机在地面系下的绝对速度V_f。

V_f＝V_L+ω×r (4)

僚机的旋转速度ω主要来自于长机速度方向的旋转，也即纵向平面内的弹道倾角速率

与横向平面内的弹道偏角速率

V_L为僚机在队形中的速度，r为僚机在距离长机位置。

步骤3，队形跟踪控制率设计

队形跟踪控制率采用位置、速度反馈进行设计。

其中，c_1i，c_2i为控制器参数，P_i,cmd为第i个僚机的位置指令向量，P_i,real为第i个僚机的实际位置向量，V_i,cmd为第i个僚机的速度指令，V_i,real为第i个僚机的实际速度， a_x1i,a_y1i,a_z1i为第i个僚机在地面坐标系中的加速度指令，还需要通过坐标旋转，将其转换为速度系下的加速度指令。

队形变换过程中，需要对队形角进行平滑处理，平滑函数采用cos函数过度，过度时间t_r可以自行设定，t_c为开始转换时刻。

例如，从180度(一字型)转换为90度队形角，则可令队形角指令设置如下：

步骤4，队形自主避障控制率设计

若在队形变换过程中，还需要考虑各僚机相对障碍物避障，可在僚机控制器中添加相对障碍物的势能场控制指令：

其中，a_avoid为避障指令，P_i为第i个僚机位置向量，O_i第i障碍物与僚机最近点坐标，l为距离障碍点距离，d为距离障碍点最小距离求，r为势能场参数。

示例

设定7架无人机编队飞行，4号为长机，其余为僚机，僚机与长机保持20米安全距离，长机按照-0.1g横向过载进行持续机动，0-5s队形为一字型，5-15s为一字型向三角形(90°顶角)过度，15-20s为三角形队形。

在图5中，红色圆点为长机，其根据设定指令进行飞行，与红点蓝色连线上的蓝色圆圈为解算得到的队形位置；黑点为实际僚机飞行位置。

实际跟踪过程中，队形变换有一定动态响应过程，但队形跟踪较快，跟踪精度较高，实际跟踪误差最大不超过4米。

在图5中可以看出，各僚机控制指令平缓，指令出现峰值为起始时刻，因人为设定各僚机位置偏差较大，导致初始时刻指令修正较大。

Claims (1)

1.一种多无人系统协同编队控制方法，其特征在于步骤如下：

步骤1：建立编队无人机质点模型

式中：

为速度坐标系下第i个无人机的位置微分，θ_i为第i个弹道倾角，ψ_i为第i个无人机的弹道偏角，n_ix为速度方向过载，n_iy为速度平面内垂直于速度方向的法向过载，n_iz为垂直于速度所在平面上的侧向过载。

为第i个无人机的俯仰角微分，

为航向角微分，L为长机，f_i为僚机；

将速度坐标系转换到地面坐标系转换矩阵：

L'_{速度2地面}为速度坐标系到地面坐标系的转置矩阵，L_{地面2速度}为速度坐标系到地面坐标系；

步骤2：队形内僚机的位置和速度计算

①僚机位置计算

1)依据僚机编号，计算其距离长机的间距；依据队形角度，计算其相对于长机位置[dx；dy；dz]；

2)依据长机速度与地面欧拉角：弹道倾角θ、弹道偏角ψ，将僚机相对位置转换到地面系，再加上长机坐标偏移，得到编队中各点在地面系中的位置；此位置即为各僚机进行制导时需要跟踪的位置指令；

②僚机速度计算

V_f＝V_L+ω×r

僚机的旋转速度ω来自于长机速度方向的旋转，即纵向平面内的弹道倾角速率

与横向平面内的弹道偏角速率

V_L为僚机在队形中的速度，r为僚机在距离长机位置；

步骤3：队形跟踪控制率

队形跟踪位置，速度反馈控制率

其中：c_1i，c_2i为控制器参数，P_i,cmd为第i个僚机的位置指令向量，P_i,real为第i个僚机的实际位置向量，V_i,cmd为第i个僚机的速度指令，V_i,real为第i个僚机的实际速度，a_x1i,a_y1i,a_z1i为第i个僚机在地面坐标系中的加速度指令，通过坐标旋转，将其转换为速度系下的加速度指令；

步骤4：队形自主避障控制率

其中：a_avoid为避障指令，P_i为第i个僚机位置向量，O_i第i障碍物与僚机最近点坐标，l为距离障碍点距离，d为距离障碍点最小距离求，r为势能场参数；

步骤5：以队形跟踪控制率和队形自主避障控制率对多无人机进行协同控制。

Images