【技术实现步骤摘要】
本专利技术涉及多智能体协同控制领域，尤其涉及一种同步实现无人机集群定位与仿射编队跟踪控制的方法及装置。
技术介绍
1、为实现无人机集群的多智能体协同控制，需要使用分布式协同控制算法，目前存在众多不同类型的分布式协同控制算法。根据测量信息的不同，分布式控制算法可分为基于位置、基于位移、基于距离以及基于方位等的控制算法，其中基于方位测量的编队控制方法主要依赖于方位测量信息，不仅能够实现较好的控制效果，且信息获取的成本低廉、实现简单。
2、但是现有技术中基于方位测量信息的协同控制算法，通常需要假设期望的编队是无穷小方位刚性的，即只允许编队进行无穷小方位机动(包括平移运动和缩放运动)以保证智能体之间的方位保持恒定，从而保证可以基于方位信息唯一地确定编队构型，而这大大限制了多智能体系统的机动形式，难以满足复杂多变的任务要求。此外，多数协同控制算法只适用于线性系统，例如一阶积分系统和二阶积分系统，难以直接拓展到固定翼无人机集群中。完整的固定翼无人机运动与动力学特性可以由十二维状态耦合的非线性方程描述，这太过于复杂而难以用于协同控制策略设计。常见的固定翼无人机简化模型为二维独轮车模型，它假设无人机飞行高度恒定，从而将无人机的三维机动转化为二维运动；然而，定高假设与无人机的真实运动形式有较大差距，会提高协同算法实际应用的难度。
3、综上，针对传统固定翼无人机集群的协同编队控制，一方面，传统基于方位的协同控制算法仅能够实现无人机集群固定构型的控制，无人机集群的机动形式受限，在缺乏位置信息时，无法同时实现固定翼无人机集群的定
技术实现思路
1、本专利技术要解决的技术问题就在于：针对现有技术存在的技术问题，本专利技术提供一种实现简单、成本低且控制灵活、机动形式多样、可扩展性强的同步实现无人机集群定位与仿射编队跟踪控制的方法及装置，能够在不完全依赖全局位置的前提下，同步实现无人机集群定位与仿射编队跟踪控制，可以有利于应用于无人集群在感知受限环境中。
2、为解决上述技术问题，本专利技术提出的技术方案为：
3、一种同步实现无人机集群定位与仿射编队跟踪控制的方法，包括以下步骤：
4、步骤s01.对固定翼无人机集群进行建模，无人机之间的拓扑连接关系使用无向连通图表示，构建满足预设协同控制要求的标称编队r表示标称构型，所述标称编队中选取多架在空间中不共面的无人机作为领航者、其余无人机作为跟随者，对所述标称编队进行仿射变换得到期望的编队构型；
5、步骤s02.求解所述标称编队的平衡应力矩阵，所述平衡应力矩阵为使得图中各边分配的应力达到平衡的应力矩阵；
6、步骤s03.在固定翼无人机集群飞行过程中，控制领航者实时获取自身位置信息，并通过机间通信将位置信息共享给邻居跟随者，跟随者实时测量与邻居无人机之间的方位信息，并接收来自领航者邻居以及来自跟随者邻居的位置信息对自身位置的估计值，根据实时测量得到的方位信息以及接收到的信息估计跟随者自身位置信息，并共享给邻居无人机；
7、步骤s04.根据实时估计出的自身位置信息以及所述平衡应力矩阵实时计算出跟随者的控制输入，以控制跟随者跟踪领航者，同时控制无人机集群收敛到期望的编队构型，实现无人机集群的仿射编队控制。
8、进一步的，所述步骤s01包括：
9、步骤s101.将固定翼无人机集群建模为其中v＝{1,2…n}代表图中节点的集合，代表图中边的集合，并建立固定翼无人机的简化运动学模型；
10、步骤s102.定义满足普遍刚性以及仿射可定位性的标称构型得到无人机集群的标称编队为其中，如果标称构型r在所有维空间上均为图g关于刚性运动的唯一实现则判定标称构型r满足所述普遍刚性，如果对于处于r的仿射映射中的任意构型pf可以被pl唯一确定，其中中包含了r的所有仿射变换，则判定标称构型r满足所述仿射可定位性；
11、步骤s103.对所述标称编队进行仿射变换，并使得仿射变换后保持构型中节点之间共线或共面的特性不变以及相互平行的线段在仿射变换后保持平行，得到期望的编队构型。
12、进一步的，所述固定翼无人机的简化运动学模型为：
13、
14、其中，pi表示无人机i的位置，pi＝[xi,yi,zi]t，ui＝[vi,0,0]t，vi表示无人机i的线速度，hi表示ri的第一列航向向量变量，τi表示无人机i的虚拟线加速度，τi和ωi为无人机的两个虚拟控制输入；
15、令χi＝-αi，αi表示无人机i飞行航迹角，ri表示无人机i的旋转矩阵：
16、
17、其中，βi表示无人机i的航向角；
18、在惯性坐标系中定义角速度为令(·)∧:则
19、
20、
21、其中，因此，
22、进一步的，步骤s103中，对所述标称编队进行仿射变换后得到无人机i的时变期望位置为：
23、
24、其中，a(t)表示可逆矩阵平移向量b(t)对于时间t连续且ri表示无人机i的仿射变换。
25、进一步的，步骤s02中，给所述无向连通图中的边(i,j)∈ε，随机分配应力且当存在任意节点i满足时，则为平衡应力，节点i、j分别表示无人机i、无人机j，应力矩阵定义为：
26、
27、其中，ω是半正定矩阵，rank(ω)＝n-4，且是正定矩阵。
28、进一步的，根据所述应力矩阵构建应力矩阵求解问题，给所述无向连通图的每一条边随机指定一个方向构建得到有向图，所述有向图中边的方向用关联矩阵表示，关联矩阵h的第i列为bi，即h＝[b1,…bn]，定义如下矩阵：
29、
30、
31、对进行奇异值分解得到令u＝[u1,u2]；
32、定义：
33、
34、构建如下的线性矩阵不等式：
35、
36、其中c1,…cq满足
37、求解所述线性矩阵不等式得到名义编队的平衡应力以及平衡应力矩阵：其中diag表示对角矩阵。
38、进一步的，所述步骤s03中，定义矩阵π＝i3-φφt，其中向量eij表示边{i,j}之间的方位eij＝pj-pi，方位向量按照下式估计得到跟随者无人机i的自身位置信息以进行同步定位：
39、
40、其中，kδ与kp是正的控制增益；为跟随者无人机对自身位置的估计值；向量gij为无人机i与其余邻居无人机j之间的方位向量。
41、进一步的，所述步骤s04中，基于仿射编队控制按照下式计算出跟随者的虚拟控制输入τi和ωi以进行仿射编队协同跟踪控制：
42、
43、
44、
45、
本文档来自技高网...【技术保护点】
1.一种同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，包括以下步骤：
2.根据权利要求1所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，所述步骤S01包括：
3.根据权利要求2所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，所述固定翼无人机的简化运动学模型为：
4.根据权利要求2所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，步骤S103中，对所述标称编队进行仿射变换后得到无人机i的时变期望位置为：
5.根据权利要求1所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，步骤S02中，给所述无向连通图中的边(i,j)∈ε，随机分配应力且当存在任意节点i满足时，则为平衡应力，节点i、j分别表示无人机i、无人机j，应力矩阵定义为：
6.根据权利要求5所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，根据所述应力矩阵构建应力矩阵求解问题，给所述无向连通图的每一条边随机指定一个方向构建得到有向图，所述有向图中边的方向用关联矩阵表示，关
7.根据权利要求1～6中任意一项所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，所述步骤S03中，定义矩阵π＝I3-φφT，其中向量eij表示边{i,j}之间的方位eij＝pj-pi，方位向量按照下式估计得到跟随者无人机i的自身位置信息以进行同步定位：
8.根据权利要求1～6中任意一项所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，所述步骤S04中，基于仿射编队控制按照下式计算出跟随者的虚拟控制输入τi和ωi以进行仿射编队协同跟踪控制：
9.根据权利要求8所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，所述步骤S04中，还包括将计算出跟随者的虚拟控制输入τi和ωi转换为跟随者无人机的真实控制输入，转换计算公式为：
10.一种同步实现无人机集群定位与仿射编队跟踪控制的装置，包括控制模块以及布置在无人机集群中各无人机上的通信模块、导航定位模块、传感器模块，其特征在于，所述控制模块包括处理器以及存储器，所述存储器用于存储计算机程序，所述处理器用于执行所述计算机程序以执行如权利要求1～9中任意一项所述方法。
...【技术特征摘要】
1.一种同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，包括以下步骤：
2.根据权利要求1所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，所述步骤s01包括：
3.根据权利要求2所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，所述固定翼无人机的简化运动学模型为：
4.根据权利要求2所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，步骤s103中，对所述标称编队进行仿射变换后得到无人机i的时变期望位置为：
5.根据权利要求1所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，步骤s02中，给所述无向连通图中的边(i,j)∈ε，随机分配应力且当存在任意节点i满足时，则为平衡应力，节点i、j分别表示无人机i、无人机j，应力矩阵定义为：
6.根据权利要求5所述的同步实现无人机集群定位与仿射编队跟踪控制的方法，其特征在于，根据所述应力矩阵构建应力矩阵求解问题，给所述无向连通图的每一条边随机指定一个方向构建得到有向图，所述有向图中边的方向用关联矩阵表示，关联矩阵h的第i列为bi，即h＝[b1,…b...
【专利技术属性】
技术研发人员：陈浩，王祥科，李慧铭，李杰，刘志宏，赵述龙，丛一睿，余杨广，郑子君，田磊，
申请(专利权)人：中国人民解放军国防科技大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。