[发明专利]一种多无人机协同跟踪目标的方法和系统有效
申请号: | 201910269353.4 | 申请日: | 2019-04-04 |
公开(公告)号: | CN109976386B | 公开(公告)日: | 2022-03-11 |
发明(设计)人: | 杨祖强;柳海;刘光宏;张德 | 申请(专利权)人: | 中国电子科技集团公司信息科学研究院 |
主分类号: | G05D1/12 | 分类号: | G05D1/12;G05D1/10 |
代理公司: | 北京辰权知识产权代理有限公司 11619 | 代理人: | 刘广达 |
地址: | 100086 北京*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 无人机 协同 跟踪 目标 方法 系统 | ||
1.一种多无人机协同跟踪目标的方法,其特征在于,包括:
S1第一无人机得到目标的速度信息和位置信息,并广播给其他各无人机,接收其他无人机发送的目标的速度信息和位置信息并进行信息融合,
S2多无人机各自根据融合后的目标的速度信息确定跟踪方式,
S3多无人机各自根据自身以及其他无人机的导航信息、目标的速度信息、位置信息以及所述跟踪方式,计算最终制导矢量,
S4多无人机各自更新目标的速度信息和位置信息,并广播给其他各无人机,接收其他无人机发送的目标的速度信息和位置信息并进行信息融合,返回S2;
S2中的确定跟踪方式,包括:
若无人机当前未处于跟踪状态,且目标的速度大于中间速度,则所述无人机使用平飞跟踪方式,
若无人机当前未处于跟踪状态,且目标的速度小于等于中间速度,则所述无人机使用盘旋跟踪方式,
若无人机当前处于盘旋跟踪状态,且目标的速度大于等于最大阈值,则所述无人机使用平飞跟踪方式,
若无人机当前处于平飞跟踪状态,且目标的速度小于等于最小阈值,则所述无人机使用盘旋跟踪方式;
其中,所述中间速度为Vm,所述最大阈值为(Vm+δV),所述最小阈值为(Vm-δV),δV为过渡区间。
2.如权利要求1所述的一种多无人机协同跟踪目标的方法,其特征在于,当跟踪方式为平飞跟踪方式时,计算最终制导矢量包括:
计算参考制导矢量;
检测冲突并采用虚拟势场计算修正角;
根据修正角修正参考制导矢量,得到最终制导矢量。
3.如权利要求2所述的一种多无人机协同跟踪目标的方法,其特征在于,所述计算参考制导矢量使用加权方法。
4.如权利要求1所述的一种多无人机协同跟踪目标的方法,其特征在于,当所述跟踪方式为盘旋跟踪方式时,计算最终制导矢量包括:
计算参考制导矢量;
计算相位调整所需的制导矢量补偿,补偿参考制导矢量,得到补偿后的参考制导矢量;
检测冲突并采用虚拟势场计算修正角;
根据修正角修正补偿后的参考制导矢量,得到最终制导矢量。
5.如权利要求4所述的一种多无人机协同跟踪目标的方法,其特征在于,所述计算参考制导矢量使用李雅普诺夫矢量场制导方法。
6.如权利要求2或4所述的一种多无人机协同跟踪目标的方法,其特征在于,所述检测冲突并采用虚拟势场计算修正角,包括:
监测安全飞行区,若检测到其他物体进入安全飞行区,则采用虚拟势场计算势场力;
根据势场力计算修正角。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国电子科技集团公司信息科学研究院,未经中国电子科技集团公司信息科学研究院许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910269353.4/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种基于加速度的跟随车控制方法
- 下一篇:一种无人车探测轨迹的方法及终端