[发明专利]基于人工势场的无人机集群路径规划处理方法、无人机在审
申请号: | 201911347172.5 | 申请日: | 2019-12-24 |
公开(公告)号: | CN111123976A | 公开(公告)日: | 2020-05-08 |
发明(设计)人: | 吴冲;孙航 | 申请(专利权)人: | 一飞智控(天津)科技有限公司 |
主分类号: | G05D1/10 | 分类号: | G05D1/10 |
代理公司: | 天津市宗欣专利商标代理有限公司 12103 | 代理人: | 董光仁 |
地址: | 300457 天津市*** | 国省代码: | 天津;12 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 人工 无人机 集群 路径 规划 处理 方法 | ||
1.一种基于人工势场的无人机集群路径规划处理方法,其特征在于,所述基于人工势场的无人机集群路径规划处理方法包括以下步骤:
第一步,根据无人机阵列的目标形状及其顺序,转换成无人机阵列的位置点阵,同时生成单个无人机的目标航点阵列;
第二步,基于人工势场法,计算单个无人机受到集群中其它无人机的斥力FRi,以及所有斥力的合力FR;
第三步,计算单个无人机受到目标点引力FG;
第四步,仿真飞行,根据引力FG及斥力FR计算无人机收到合力,并根据合力调整无人机下一步的期望航点;
第五步,最终针对每个无人机形成其安全航迹,完成整个无人机集群的航迹规划工作。
2.如权利要求1所述的基于人工势场的无人机集群路径规划处理方法,其特征在于,所述基于人工势场的无人机集群路径规划处理方法包括单个无人机所受其它任一集群中的无人机的斥力势场函数为:
其中,kr为斥力系数,ρ(X,Xo)为无人机到障碍无人机的距离,ρ(X,Xg)为无人机到目标航点的距离,ρ0障碍无人机对该无人机的障碍作用影响距离。
3.如权利要求1所述的基于人工势场的无人机集群路径规划处理方法,其特征在于,所述基于人工势场的无人机集群路径规划处理方法包括编队中的编号i的无人机在飞向第j个目标点Pij(x,y,z)过程中的引力势场函数为:
FG=kg·ρ(X,XG);
其中,kg为引力系数,ρ(X,XG)为无人机到目标航点的距离。
4.如权利要求1所述的基于人工势场的无人机集群路径规划处理方法,其特征在于,所述基于人工势场的无人机集群路径规划处理方法包括引力、斥力势场函数参数应满足以下约束:kgFR·cosθ/ρ(X,XG),θπ/2。
5.如权利要求1所述的基于人工势场的无人机集群路径规划处理方法,其特征在于,所述基于人工势场的无人机集群路径规划处理方法包括引力、斥力势场函数参数应满足以下约束:
6.如权利要求1所述的基于人工势场的无人机集群路径规划处理方法,其特征在于,所述基于人工势场的无人机集群路径规划处理方法还包括以下步骤:
第一步,生成无人机阵列的位置点阵;
第二步,基于人工势场法计算单格无人机所受合力;
第三步,根据无人机受力情况计算无人机的下一目标点;
第四步,判断是否所有无人机均计算过下一目标点,若是进进行第五步;若不是,则基于人工势场法计算下一个无人机所受合力,进行第三步;
第五步,判断是否所有无人机均到达目标点,若是,则结束;若不是,则返回第二步。
7.一种应用权利要求1~6任意一项所述基于人工势场的无人机集群路径规划处理方法的无人机。
8.一种实现权利要求1~6任意一项所述基于人工势场的无人机集群路径规划处理方法的信息数据处理终端。
9.一种计算机可读存储介质,包括指令,当其在计算机上运行时,使得计算机执行如权利要求1~6任意一项所述的基于人工势场的无人机集群路径规划处理方法。
10.一种实施权利要求1~6任意一项所述基于人工势场的无人机集群路径规划处理方法的基于人工势场的无人机集群路径规划处理系统,其特征在于,所述基于人工势场的无人机集群路径规划处理系统包括:
位置点阵生成模块1,用于生成无人机阵列的位置点阵;
单格无人机所受合力计算模块,用于基于人工势场法计算单格无人机所受合力;
下一目标点计算模块,用于根据无人机受力情况计算无人机的下一目标点;
下一目标点计算判断模块,用于判断是否所有无人机均计算过下一目标点;
目标点到达判断模块,用于判断是否所有无人机均到达目标点。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于一飞智控(天津)科技有限公司,未经一飞智控(天津)科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201911347172.5/1.html,转载请声明来源钻瓜专利网。