CN116540709A - 一种基于机器人编队的避障路径规划方法 - Google Patents

一种基于机器人编队的避障路径规划方法 Download PDF

Info

Publication number
CN116540709A
CN116540709A CN202310529600.6A CN202310529600A CN116540709A CN 116540709 A CN116540709 A CN 116540709A CN 202310529600 A CN202310529600 A CN 202310529600A CN 116540709 A CN116540709 A CN 116540709A
Authority
CN
China
Prior art keywords
unmanned aerial
aerial vehicle
vehicle array
target
obstacle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202310529600.6A
Other languages
English (en)
Other versions
CN116540709B (zh
Inventor
仝晓朋
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu Kangbosi Intelligent Logistics Equipment Co ltd
Original Assignee
Jiangsu Bofa Robot Intelligent Equipment Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Jiangsu Bofa Robot Intelligent Equipment Co ltd filed Critical Jiangsu Bofa Robot Intelligent Equipment Co ltd
Priority to CN202310529600.6A priority Critical patent/CN116540709B/zh
Publication of CN116540709A publication Critical patent/CN116540709A/zh
Application granted granted Critical
Publication of CN116540709B publication Critical patent/CN116540709B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/10Internal combustion engine [ICE] based vehicles
    • Y02T10/40Engine management systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及机器人避障领域,具体公开一种基于机器人编队的避障路径规划方法,该方法包括:适宜采集区域划分、无人机队列初始路径选择、障碍物分析、变换队形分析、参考无人机阵列类型效率分析和变换无人机阵列类型执行,本发明综合考虑无人机对应各初始路径所包含的障碍物和路径的复杂程度对初始路径选择的影响,弥补了现有技术中对无人机对应路径复杂层面关注度不高的缺陷,进而提高了无人机阵列的初始路径的适用性,本发明在躲避可移动式障碍物的基础上进行变换阵列的分析,降低了无人机阵列在拍摄过程中的能源消耗,节约了成本,从而保障选择的变换阵列的实行效率,在一定程度上提高了无人机阵列的拍摄效率。

Description

一种基于机器人编队的避障路径规划方法
技术领域
本发明涉及机器人避障技术领域,具体而言,涉及一种基于机器人编队的避障路径规划方法。
背景技术
随着社会的发展和科技的发展,机器人的发展也越来越迅速,机器人的应用范围也越来越宽泛,空中机器人之称是因为电子系统跟地面机器人类似,故无人机是机器人的一种,在城市植被的勘测过程中,同样可以利用无人机进行勘测,单个无人机进行植被勘测时存在局限性且勘测较为缓慢,进而采用无人机编队的方法进行植被勘测,在植被勘测过程中,会出现障碍物,进而五如何避开障碍物成为无人机在植被勘测过程的难题,因此,对无人机阵列的路径规划分析是及其重要的。
现有对无人机阵列的障碍物分析在一定程度上可以满足当前要求,但是还存在一定的缺陷,其具体体现在:(1)现有对无人机阵列的路径规划大多通过无人机对应各初始路径所包含的障碍物进行无人机阵列和初始路径的选择,对无人机对应各初始路径的复杂层面的关注度不高,现有技术对这一层面的忽视导致无人机阵列的初始路径的适用性不强,从而影响无人机阵列的初始拍摄效率。
(2)现有无人机阵列的路径规划在遇到可移动式障碍物时,对躲避可移动式障碍物的变换阵列的选择分析不够深入,进而可能出现选择的避障路径可能耗费较多无人机资源的问题,提高了无人机阵列拍摄过程中的能源消耗,提高了成本,从而无法保障选择的变换阵列的实行效率,在一定程度上降低了无人机阵列的拍摄效率。
发明内容
为了克服背景技术中的缺点,本发明实施例提供了一种基于机器人编队的避障路径规划方法,能够有效解决上述背景技术中涉及的问题。
本发明的目的可以通过以下技术方案来实现:一种基于机器人编队的避障路径规划方法,包括:适宜采集区域划分:获取目标植被采集区域,进而根据目标植被所属的采集区域划定适宜空中采集区域。
无人机队列初始路径选择:分析各种无人机阵列类型的各执行路径,进而分析各种无人机阵列类型所属各执行路径对应的障碍困难系数和复杂系数,从而综合分析各种无人机阵列类型所属各执行路径的综合效率指数,进而筛选目标无人机阵列类型及其对应的执行路径。
障碍物分析:通过目标无人机的前置摄像头采集的各图像分析目标无人机阵列类型对应的目标障碍物。
变换队形分析:基于目标障碍物分析目标无人机阵列类型对应的各参考无人机阵列类型。
参考无人机阵列类型效率分析:分析各参考无人机阵列类型对应的综合评估指数,并筛选最大综合评估指数对应的参考无人机阵列类型作为目标无人机阵列类型对应的变换无人机阵列类型。
变换无人机阵列类型执行:根据目标无人机阵列类型对应的变换无人机阵列类型执行相应变换。
进一步地,所述根据目标植被所属的采集区域划定适宜空中采集区域,其具体方法为:
获取目标植被采集区域对应的长度、宽度,进而得到目标植被采集区域对应的面积,并随机抽选各检测点对目标植被进行高度采集,从而分析目标植被对应的平均高度,并将其作为目标植被采集区域的高度。
将目标植被采集区域的高度与云数据库中储存的各植被采集区域高度对应的无人机适宜飞行高度进行对比,筛选无人机适宜飞行高度。
在目标植被采集区域对应的无人机适宜飞行高度按照目标植被采集区域对应的面积划定适宜采集区域。
进一步地,所述分析各种无人机阵列类型的各执行路径,其具体方法为:从云数据库中提取各种无人机阵列类型及其对应的采集参数,其中采集参数包括采集长度和采集宽度,进而获取各种无人机阵列类型的单次采集面积。
将适宜采集区域按照各种无人机阵列类型对应的单次采集面积进行均匀划分,进而统计各种无人机阵列类型对应的各采集子区域,并将各种无人机阵列类型对应相连采集子区域的交点标记为节点。
统计各种无人机阵列类型所属领头无人机在各采集子区域的位置,并根据领头无人机需要经过所有采集子区域的原则生成各种无人机阵列类型对应的各执行路径,并获取各种无人机阵列类型对应各执行路径的各节点。
进一步地,所述分析各种无人机阵列类型所属各执行路径对应的障碍困难系数,其具体方法为:统计各种无人机阵列所属各执行路径的固定障碍物参数,其中障碍物参数包括各固定障碍物的体积和固定障碍物的数量,并将其分别标记为Vimk、Sim,其中i表示为各种无人机阵列类型的编号,i=1,2,...,n,m表示为各执行路径的编号,m=1,2,...,l,k表示为各固定障碍物的编号,k=1,2,...,j。
分析各种无人机阵列类型所属各执行路径对应的障碍困难系数其中j表示为固定障碍物的数量,λ1、λ2分别表示为预设的障碍物体积、障碍物数量对应的权重因子。
进一步地,所述各种无人机阵列类型所属各执行路径对应的复杂系数,其具体分析方法为:统计各种无人机阵列类型所属各执行路径对应的总长度和各节点的弯曲角度,将其分别标记为Lim、θimf,其中f表示为各节点的编号,f=1,2,...,g,分析各种无人机阵列类型所属各执行路径对应的复杂系数其中γ1、γ2分别表示为预设的路径长度、节点弯曲角度对应的占比因子,g表示为节点的数量。
进一步地,所述综合分析各种无人机阵列类型所属各执行路径的综合效率指数,其计算公式为:其中μim表示为第i种无人机阵列类型所属第m个执行路径的综合效率指数,e为自然常数,χ1、χ2分别表示为预设的路径困难、路径复杂对应的权重系数。
进一步地,所述筛选目标无人机阵列类型及其对应的执行路径,其具体方法为:基于各种无人机阵列类型所属各执行路径的综合效率指数,筛选各种无人机阵列类型对应最大综合效率指数所属的执行路径作为各种无人机阵列类型对应的执行路径,进而获取各种无人机阵列类型对应执行路径的综合效率指数,筛选最大综合效率指数对应的无人机阵列类型作为目标无人机阵列类型,进而得到目标无人机阵列类型及其对应的执行路径。
进一步地,所述目标无人机阵列类型对应的目标障碍物,其具体分析方法为:基于目标无人机采集的各图像勾勒出障碍物对应的飞行轨迹,进而获取障碍物对应的当前飞行路程和当前飞行时长,并分析得到障碍物对应的当前飞行速度,其计算公式为:
将障碍物对应的飞行轨迹沿着其对应的倾斜角度进行延长,进而得到障碍物对应的预计飞行轨迹。
将障碍物对应的预计飞行轨迹与目标无人机阵列类型对应的执行路径进行模拟对比,进而判断障碍物对应的预计飞行轨迹与目标无人机阵列类型对应的执行路径是否存在相撞点,若存在相撞点,则进行以下分析:根据障碍物对应的预计飞行轨迹和当前飞行速度获取障碍物对应的预计飞行时长。
根据目标无人机阵列类型所在执行路径的当前路径点和相撞点获取目标无人机阵列类型对应的预计飞行轨迹。
根据目标无人机阵列类型对应的当前飞行速度和预计飞行轨迹获取目标无人机阵列类型对应的预计飞行时长。
将障碍物对应的预计飞行时长减去目标无人机阵列类型对应的预计飞行时长,进而得到障碍物与目标无人机阵列类型对应的飞行时长差值。
将障碍物与目标无人机阵列类型对应的飞行时长差值与预设的安全飞行时长差值进行对比,若障碍物与目标无人机阵列类型对应的飞行时长差值小于安全飞行时长差值,则将障碍物标记为目标障碍物。
进一步地,所述分析目标无人机阵列类型对应的各参考无人机阵列类型,其具体方法为:基于目标无人机采集的各图像获取目标障碍物在各图像中对应的尺寸参数,其中尺寸参数包括目标障碍物的长度、宽度和高度,并将其分别标记为Lp、Wp和Hp,其中p表示为各图像的编号,p=1,2,...,q。
分析目标障碍物对应的困难系数,其中q为图像的数量,δ1、δ2、δ3分别表示为预设长度层面、宽度层面和高度层面对应的困难因子。
获取目标障碍物与目标无人机阵列类型的相撞点,并以相撞点时目标无人机阵列类型的中心点为基本点进行各种无人机阵列类型的模拟变换,从而获取各种无人机阵列类型对应各顶点的坐标(xih,yih,zih),其中h为各顶点的编号,h=1,2,...,d,并获取相撞点在各种无人机阵列类型对应的坐标(x′i,y′i,z′i)。
分析目标障碍物与各种无人机阵列类型对应各顶点的距离
分析目标障碍物与各种无人机阵列类型对应的位置危险系数其中JL′表示为预设的安全距离。
分析目标障碍物与各种无人机阵列类型对应的综合危险系数并将其与预设的综合危险系数阈值进行对比,若目标障碍物与某种无人机阵列类型对应的综合危险系数小于综合危险系数阈值,则将该种无人机阵列类型标记为目标无人机阵列类型对应的参考无人机阵列类型,进而得到目标无人机阵列类型对应的各参考无人机阵列类型。
进一步地,所述各参考无人机阵列类型对应的综合评估指数,其具体分析方法为:将目标无人机阵列类型与各参考无人机阵列类型进行对比,进而获取各参考无人机阵列类型对应各无人机的变动参数,其中变动参数包括变动角度和变动偏移距离,将其标记为θru、Bru,其中r表示为各参考无人机阵列类型的编号,r=1,2,...,b,u表示为各无人机的编号,u=1,2,...,v。
统计各参考无人机阵列类型对应无人机的变动总数量Qr
分析各参考无人机阵列类型对应的综合评估指数,其中v为无人机的数量,Q″为预设的基础变动数量,ρ1、ρ2分别表示为预设的变动数量、综合偏移对应的比例系数。
相对于现有技术,本发明的实施例至少具有如下优点或有益效果:(1)本发明在对无人机阵列的路径规划时,综合考虑无人机对应各初始路径所包含的障碍物和路径的复杂程度对初始路径选择的影响,弥补了现有技术中对无人机对应路径复杂层面关注度不高的缺陷,进而提高了无人机阵列的初始路径的适用性,从而在一定程度上提高了无人机阵列的初始拍摄效率。
(2)本发明无人机阵列的路径规划在遇到可移动式障碍物时,在躲避可移动式障碍物的基础上进行变换阵列的分析,进而避免出现选择的避障路径耗费较多无人机资源的问题,降低了无人机阵列在拍摄过程中的能源消耗,节约了成本,从而保障选择的变换阵列的实行效率,在一定程度上提高了无人机阵列的拍摄效率。
附图说明
利用附图对本发明作进一步说明,但附图中的实施例不构成对本发明的任何限制,对于本领域的普通技术人员,在不付出创造性劳动的前提下,还可以根据以下附图获得其它的附图。
图1为本发明的方法流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
参照图1所示,本发明提供一种基于机器人编队的避障路径规划方法,包括:适宜采集区域划分:获取目标植被采集区域,进而根据目标植被所属的采集区域划定适宜空中采集区域。
在本发明的具体实施例中,所述根据目标植被所属的采集区域划定适宜空中采集区域,其具体方法为:获取目标植被采集区域对应的长度、宽度,进而得到目标植被采集区域对应的面积,并随机抽选各检测点对目标植被进行高度采集,从而分析目标植被对应的平均高度,并将其作为目标植被采集区域的高度。
将目标植被采集区域的高度与云数据库中储存的各植被采集区域高度对应的无人机适宜飞行高度进行对比,筛选无人机适宜飞行高度。
在目标植被采集区域对应的无人机适宜飞行高度按照目标植被采集区域对应的面积划定适宜采集区域。
无人机队列初始路径选择:分析各种无人机阵列类型的各执行路径,进而分析各种无人机阵列类型所属各执行路径对应的障碍困难系数和复杂系数,从而综合分析各种无人机阵列类型所属各执行路径的综合效率指数,进而筛选目标无人机阵列类型及其对应的执行路径。
需要说明的是,无人机阵列类型具体为正方形阵列、菱形阵列和三角形阵列等。
在本发明的具体实施例中,所述分析各种无人机阵列类型的各执行路径,其具体方法为:从云数据库中提取各种无人机阵列类型及其对应的采集参数,其中采集参数包括采集长度和采集宽度,进而获取各种无人机阵列类型的单次采集面积。
将适宜采集区域按照各种无人机阵列类型对应的单次采集面积进行均匀划分,进而统计各种无人机阵列类型对应的各采集子区域,并将各种无人机阵列类型对应相连采集子区域的交点标记为节点。
统计各种无人机阵列类型所属领头无人机在各采集子区域的位置,并根据领头无人机需要经过所有采集子区域的原则生成各种无人机阵列类型对应的各执行路径,并获取各种无人机阵列类型对应各执行路径的各节点。
在本发明的具体实施例中,所述分析各种无人机阵列类型所属各执行路径对应的障碍困难系数,其具体方法为:统计各种无人机阵列所属各执行路径的固定障碍物参数,其中障碍物参数包括各固定障碍物的体积和固定障碍物的数量,并将其分别标记为Vimk、Sim,其中i表示为各种无人机阵列类型的编号,i=1,2,...,n,m表示为各执行路径的编号,m=1,2,...,l,k表示为各固定障碍物的编号,k=1,2,...,j。
分析各种无人机阵列类型所属各执行路径对应的障碍困难系数其中j表示为固定障碍物的数量,λ1、λ2分别表示为预设的障碍物体积、障碍物数量对应的权重因子。
在本发明的具体实施例中,所述各种无人机阵列类型所属各执行路径对应的复杂系数,其具体分析方法为:统计各种无人机阵列类型所属各执行路径对应的总长度和各节点的弯曲角度,将其分别标记为Lim、θimf,其中f表示为各节点的编号,f=1,2,...,g,分析各种无人机阵列类型所属各执行路径对应的复杂系数其中γ1、γ2分别表示为预设的路径长度、节点弯曲角度对应的占比因子,g表示为节点的数量。
在本发明的具体实施例中,所述综合分析各种无人机阵列类型所属各执行路径的综合效率指数,其计算公式为:其中μim表示为第i种无人机阵列类型所属第m个执行路径的综合效率指数,e为自然常数,χ1、χ2分别表示为预设的路径困难、路径复杂对应的权重系数。
在本发明的具体实施例中,所述筛选目标无人机阵列类型及其对应的执行路径,其具体方法为:基于各种无人机阵列类型所属各执行路径的综合效率指数,筛选各种无人机阵列类型对应最大综合效率指数所属的执行路径作为各种无人机阵列类型对应的执行路径,进而获取各种无人机阵列类型对应执行路径的综合效率指数,筛选最大综合效率指数对应的无人机阵列类型作为目标无人机阵列类型,进而得到目标无人机阵列类型及其对应的执行路径。
本发明在对无人机阵列的路径规划时,综合考虑无人机对应各初始路径所包含的障碍物和路径的复杂程度对初始路径选择的影响,弥补了现有技术中对无人机对应路径复杂层面关注度不高的缺陷,进而提高了无人机阵列的初始路径的适用性,从而在一定程度上提高了无人机阵列的初始拍摄效率。
障碍物分析:通过目标无人机的前置摄像头采集的各图像分析目标无人机阵列类型对应的目标障碍物。
在本发明的具体实施例中,所述目标无人机阵列类型对应的目标障碍物,其具体分析方法为:基于目标无人机采集的各图像勾勒出障碍物对应的飞行轨迹,进而获取障碍物对应的当前飞行路程和当前飞行时长,并分析得到障碍物对应的当前飞行速度,其计算公式为:
将障碍物对应的飞行轨迹沿着其对应的倾斜角度进行延长,进而得到障碍物对应的预计飞行轨迹。
将障碍物对应的预计飞行轨迹与目标无人机阵列类型对应的执行路径进行模拟对比,进而判断障碍物对应的预计飞行轨迹与目标无人机阵列类型对应的执行路径是否存在相撞点,若存在相撞点,则进行以下分析:
需要说明的是,相撞点为障碍物按照预计飞行轨迹进行飞行时首次与目标无人机阵列类型按照执行路径飞行时相接触的点。
根据障碍物对应的预计飞行轨迹和当前飞行速度获取障碍物对应的预计飞行时长。
根据目标无人机阵列类型所在执行路径的当前路径点和相撞点获取目标无人机阵列类型对应的预计飞行轨迹。
根据目标无人机阵列类型对应的当前飞行速度和预计飞行轨迹获取目标无人机阵列类型对应的预计飞行时长。
将障碍物对应的预计飞行时长减去目标无人机阵列类型对应的预计飞行时长,进而得到障碍物与目标无人机阵列类型对应的飞行时长差值。
将障碍物与目标无人机阵列类型对应的飞行时长差值与预设的安全飞行时长差值进行对比,若障碍物与目标无人机阵列类型对应的飞行时长差值小于安全飞行时长差值,则将障碍物标记为目标障碍物。
变换队形分析:基于目标障碍物分析目标无人机阵列类型对应的各参考无人机阵列类型。
在本发明的具体实施例中,所述分析目标无人机阵列类型对应的各参考无人机阵列类型,其具体方法为:基于目标无人机采集的各图像获取目标障碍物在各图像中对应的尺寸参数,其中尺寸参数包括目标障碍物的长度、宽度和高度,并将其分别标记为Lp、Wp和Hp,其中p表示为各图像的编号,p=1,2,...,q。
分析目标障碍物对应的困难系数
,其中q为图像的数量,δ1、δ2、δ3分别表示为预设长度层面、宽度层面和高度层面对应的困难因子。
获取目标障碍物与目标无人机阵列类型的相撞点,并以相撞点时目标无人机阵列类型的中心点为基本点进行各种无人机阵列类型的模拟变换,从而获取各种无人机阵列类型对应各顶点的坐标(xih,yih,zih),其中h为各顶点的编号,h=1,2,...,d,并获取相撞点在各种无人机阵列类型对应的坐标(x′i,y′i,z′i)。
需要说明的是,通过目标无人机配置的定位系统和红外传感器获取各种无人机阵列类型对应各顶点的坐标和相撞点在各种无人机阵列类型对应的坐标。
分析目标障碍物与各种无人机阵列类型对应各顶点的距离
分析目标障碍物与各种无人机阵列类型对应的位置危险系数其中JL′表示为预设的安全距离。
分析目标障碍物与各种无人机阵列类型对应的综合危险系数并将其与预设的综合危险系数阈值进行对比,若目标障碍物与某种无人机阵列类型对应的综合危险系数小于综合危险系数阈值,则将该种无人机阵列类型标记为目标无人机阵列类型对应的参考无人机阵列类型,进而得到目标无人机阵列类型对应的各参考无人机阵列类型。
本发明无人机阵列的路径规划在遇到可移动式障碍物时,在躲避可移动式障碍物的基础上进行变换阵列的分析,进而避免出现选择的避障路径耗费较多无人机资源的问题,降低了无人机阵列在拍摄过程中的能源消耗,节约了成本,从而保障选择的变换阵列的实行效率,在一定程度上提高了无人机阵列的拍摄效率。
参考无人机阵列类型效率分析:分析各参考无人机阵列类型对应的综合评估指数,并筛选最大综合评估指数对应的参考无人机阵列类型作为目标无人机阵列类型对应的变换无人机阵列类型。
在本发明的具体实施例中,所述各参考无人机阵列类型对应的综合评估指数,其具体分析方法为:将目标无人机阵列类型与各参考无人机阵列类型进行对比,进而获取各参考无人机阵列类型对应各无人机的变动参数,其中变动参数包括变动角度和变动偏移距离,将其标记为θru、Bru,其中r表示为各参考无人机阵列类型的编号,r=1,2,...,b,u表示为各无人机的编号,u=1,2,...,v。
统计各参考无人机阵列类型对应无人机的变动总数量Qr
分析各参考无人机阵列类型对应的综合评估指数
,其中v为无人机的数量,Q″为预设的基础变动数量,ρ1、ρ2分别表示为预设的变动数量、综合偏移对应的比例系数。
变换无人机阵列类型执行:根据目标无人机阵列类型对应的变换无人机阵列类型执行相应变换。
以上内容仅仅是对本发明结构所作的举例和说明,所属本技术领域的技术人员对所描述的具体实施例做各种各样的修改或补充或采用类似的方式替代,只要不偏离发明的结构或者超越本权利要求书所定义的范围,均应属于本发明的保护范围。

Claims (10)

1.一种基于机器人编队的避障路径规划方法,其特征在于,包括:
适宜采集区域划分:获取目标植被采集区域,进而根据目标植被所属的采集区域划定适宜空中采集区域;
无人机队列初始路径选择:分析各种无人机阵列类型的各执行路径,进而分析各种无人机阵列类型所属各执行路径对应的障碍困难系数和复杂系数,从而综合分析各种无人机阵列类型所属各执行路径的综合效率指数,进而筛选目标无人机阵列类型及其对应的执行路径;
障碍物分析:通过目标无人机的前置摄像头采集的各图像分析目标无人机阵列类型对应的目标障碍物;
变换队形分析:基于目标障碍物分析目标无人机阵列类型对应的各参考无人机阵列类型;
参考无人机阵列类型效率分析:分析各参考无人机阵列类型对应的综合评估指数,并筛选最大综合评估指数对应的参考无人机阵列类型作为目标无人机阵列类型对应的变换无人机阵列类型;
变换无人机阵列类型执行:根据目标无人机阵列类型对应的变换无人机阵列类型执行相应变换。
2.根据权利要求1所述的一种基于机器人编队的避障路径规划方法,其特征在于:所述根据目标植被所属的采集区域划定适宜空中采集区域,其具体方法为:
获取目标植被采集区域对应的长度、宽度,进而得到目标植被采集区域对应的面积,并随机抽选各检测点对目标植被进行高度采集,从而分析目标植被对应的平均高度,并将其作为目标植被采集区域的高度;
将目标植被采集区域的高度与云数据库中储存的各植被采集区域高度对应的无人机适宜飞行高度进行对比,筛选无人机适宜飞行高度;
在目标植被采集区域对应的无人机适宜飞行高度按照目标植被采集区域对应的面积划定适宜采集区域。
3.根据权利要求1所述的一种基于机器人编队的避障路径规划方法,其特征在于:所述分析各种无人机阵列类型的各执行路径,其具体方法为:
从云数据库中提取各种无人机阵列类型及其对应的采集参数,其中采集参数包括采集长度和采集宽度,进而获取各种无人机阵列类型的单次采集面积;
将适宜采集区域按照各种无人机阵列类型对应的单次采集面积进行均匀划分,进而统计各种无人机阵列类型对应的各采集子区域,并将各种无人机阵列类型对应相连采集子区域的交点标记为节点;
统计各种无人机阵列类型所属领头无人机在各采集子区域的位置,并根据领头无人机需要经过所有采集子区域的原则生成各种无人机阵列类型对应的各执行路径,并获取各种无人机阵列类型对应各执行路径的各节点。
4.根据权利要求3所述的一种基于机器人编队的避障路径规划方法,其特征在于:所述分析各种无人机阵列类型所属各执行路径对应的障碍困难系数,其具体方法为:
统计各种无人机阵列所属各执行路径的固定障碍物参数,其中障碍物参数包括各固定障碍物的体积和固定障碍物的数量,并将其分别标记为Vimk、Sim,其中i表示为各种无人机阵列类型的编号,i=1,2,...,n,m表示为各执行路径的编号,m=1,2,...,l,k表示为各固定障碍物的编号,k=1,2,...,j;
分析各种无人机阵列类型所属各执行路径对应的障碍困难系数其中j表示为固定障碍物的数量,λ1、λ2分别表示为预设的障碍物体积、障碍物数量对应的权重因子。
5.根据权利要求4所述的一种基于机器人编队的避障路径规划方法,其特征在于:所述各种无人机阵列类型所属各执行路径对应的复杂系数,其具体分析方法为:
统计各种无人机阵列类型所属各执行路径对应的总长度和各节点的弯曲角度,将其分别标记为Lim、θimf,其中f表示为各节点的编号,f=1,2,...,g,分析各种无人机阵列类型所属各执行路径对应的复杂系数其中γ1、γ2分别表示为预设的路径长度、节点弯曲角度对应的占比因子,g表示为节点的数量。
6.根据权利要求5所述的一种基于机器人编队的避障路径规划方法,其特征在于:所述综合分析各种无人机阵列类型所属各执行路径的综合效率指数,其计算公式为:其中μim表示为第i种无人机阵列类型所属第m个执行路径的综合效率指数,e为自然常数,χ1、χ2分别表示为预设的路径困难、路径复杂对应的权重系数。
7.根据权利要求1所述的一种基于机器人编队的避障路径规划方法,其特征在于:所述筛选目标无人机阵列类型及其对应的执行路径,其具体方法为:基于各种无人机阵列类型所属各执行路径的综合效率指数,筛选各种无人机阵列类型对应最大综合效率指数所属的执行路径作为各种无人机阵列类型对应的执行路径,进而获取各种无人机阵列类型对应执行路径的综合效率指数,筛选最大综合效率指数对应的无人机阵列类型作为目标无人机阵列类型,进而得到目标无人机阵列类型及其对应的执行路径。
8.根据权利要求1所述的一种基于机器人编队的避障路径规划方法,其特征在于:所述目标无人机阵列类型对应的目标障碍物,其具体分析方法为:
基于目标无人机采集的各图像勾勒出障碍物对应的飞行轨迹,进而获取障碍物对应的当前飞行路程和当前飞行时长,并分析得到障碍物对应的当前飞行速度,其计算公式为:
将障碍物对应的飞行轨迹沿着其对应的倾斜角度进行延长,进而得到障碍物对应的预计飞行轨迹;
将障碍物对应的预计飞行轨迹与目标无人机阵列类型对应的执行路径进行模拟对比,进而判断障碍物对应的预计飞行轨迹与目标无人机阵列类型对应的执行路径是否存在相撞点,若存在相撞点,则进行以下分析:
根据障碍物对应的预计飞行轨迹和当前飞行速度获取障碍物对应的预计飞行时长;
根据目标无人机阵列类型所在执行路径的当前路径点和相撞点获取目标无人机阵列类型对应的预计飞行轨迹;
根据目标无人机阵列类型对应的当前飞行速度和预计飞行轨迹获取目标无人机阵列类型对应的预计飞行时长;
将障碍物对应的预计飞行时长减去目标无人机阵列类型对应的预计飞行时长,进而得到障碍物与目标无人机阵列类型对应的飞行时长差值;
将障碍物与目标无人机阵列类型对应的飞行时长差值与预设的安全飞行时长差值进行对比,若障碍物与目标无人机阵列类型对应的飞行时长差值小于安全飞行时长差值,则将障碍物标记为目标障碍物。
9.根据权利要求1所述的一种基于机器人编队的避障路径规划方法,其特征在于:所述分析目标无人机阵列类型对应的各参考无人机阵列类型,其具体方法为:
基于目标无人机采集的各图像获取目标障碍物在各图像中对应的尺寸参数,其中尺寸参数包括目标障碍物的长度、宽度和高度,并将其分别标记为Lp、Wp和Hp,其中p表示为各图像的编号,p=1,2,...,q;
分析目标障碍物对应的困难系数
其中q为图像的数量,δ1、δ2、δ3分别表示为预设长度层面、宽度层面和高度层面对应的困难因子;
获取目标障碍物与目标无人机阵列类型的相撞点,并以相撞点时目标无人机阵列类型的中心点为基本点进行各种无人机阵列类型的模拟变换,从而获取各种无人机阵列类型对应各顶点的坐标(xih,yih,zih),其中h为各顶点的编号,h=1,2,...,d,并获取相撞点在各种无人机阵列类型对应的坐标(x′i,y′i,z′i);
分析目标障碍物与各种无人机阵列类型对应各顶点的距离
分析目标障碍物与各种无人机阵列类型对应的位置危险系数其中JL′表示为预设的安全距离;
分析目标障碍物与各种无人机阵列类型对应的综合危险系数并将其与预设的综合危险系数阈值进行对比,若目标障碍物与某种无人机阵列类型对应的综合危险系数小于综合危险系数阈值,则将该种无人机阵列类型标记为目标无人机阵列类型对应的参考无人机阵列类型,进而得到目标无人机阵列类型对应的各参考无人机阵列类型。
10.根据权利要求1所述的一种基于机器人编队的避障路径规划方法,其特征在于:所述各参考无人机阵列类型对应的综合评估指数,其具体分析方法为:
将目标无人机阵列类型与各参考无人机阵列类型进行对比,进而获取各参考无人机阵列类型对应各无人机的变动参数,其中变动参数包括变动角度和变动偏移距离,将其标记为θru、Bru,其中r表示为各参考无人机阵列类型的编号,r=1,2,...,b,u表示为各无人机的编号,u=1,2,...,v;
统计各参考无人机阵列类型对应无人机的变动总数量Qr
分析各参考无人机阵列类型对应的综合评估指数
,其中v为无人机的数量,Q″为预设的基础变动数量,ρ1、ρ2分别表示为预设的变动数量、综合偏移对应的比例系数。
CN202310529600.6A 2023-05-11 2023-05-11 一种基于机器人编队的避障路径规划方法 Active CN116540709B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310529600.6A CN116540709B (zh) 2023-05-11 2023-05-11 一种基于机器人编队的避障路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310529600.6A CN116540709B (zh) 2023-05-11 2023-05-11 一种基于机器人编队的避障路径规划方法

Publications (2)

Publication Number Publication Date
CN116540709A true CN116540709A (zh) 2023-08-04
CN116540709B CN116540709B (zh) 2023-11-14

Family

ID=87455664

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310529600.6A Active CN116540709B (zh) 2023-05-11 2023-05-11 一种基于机器人编队的避障路径规划方法

Country Status (1)

Country Link
CN (1) CN116540709B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117970946B (zh) * 2024-04-01 2024-06-11 济南市勘察测绘研究院 一种无人机地理信息数据采集系统

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109343528A (zh) * 2018-10-30 2019-02-15 杭州电子科技大学 一种节能的无人机路径规划避障方法
CN109508035A (zh) * 2018-12-24 2019-03-22 南京邮电大学 基于分布式控制的多区域分级式无人机编队路径规划方法
CN109521794A (zh) * 2018-12-07 2019-03-26 南京航空航天大学 一种多无人机航路规划及动态避障方法
US20210080272A1 (en) * 2017-04-11 2021-03-18 Ping An Technology (Shenzhen) Co., Ltd. Path planning system and method for robot, robot and medium
CN112684807A (zh) * 2019-10-18 2021-04-20 成都凯天电子股份有限公司 无人机集群三维编队方法
WO2021088681A1 (zh) * 2019-11-08 2021-05-14 深圳市道通智能航空技术股份有限公司 无人机长距离循迹飞行方法、装置、设备及存储介质
CN112987732A (zh) * 2021-02-20 2021-06-18 陕西理工大学 基于人工势场法的多移动机器人编队避障控制方法
CN114115353A (zh) * 2021-12-09 2022-03-01 北京润科通用技术有限公司 一种编队避障方法及装置
CN114721438A (zh) * 2022-05-13 2022-07-08 北京航空航天大学 一种无人机编队协同避障的搜索方法、装置及电子设备
CN115454068A (zh) * 2022-09-13 2022-12-09 浙江大学 一种考虑障碍物信息的基于采样的路径规划方法
CN115657721A (zh) * 2022-10-30 2023-01-31 天翼电子商务有限公司 一种基于改进蚁群算法的空间环境无人机轨迹规划方法
CN115674209A (zh) * 2023-01-04 2023-02-03 江苏博发机器人智能装备有限公司 一种机器人路径规划分析方法
CN115903895A (zh) * 2022-11-18 2023-04-04 华东理工大学 一种无人机集群的轨迹规划方法、装置和系统

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20210080272A1 (en) * 2017-04-11 2021-03-18 Ping An Technology (Shenzhen) Co., Ltd. Path planning system and method for robot, robot and medium
CN109343528A (zh) * 2018-10-30 2019-02-15 杭州电子科技大学 一种节能的无人机路径规划避障方法
CN109521794A (zh) * 2018-12-07 2019-03-26 南京航空航天大学 一种多无人机航路规划及动态避障方法
CN109508035A (zh) * 2018-12-24 2019-03-22 南京邮电大学 基于分布式控制的多区域分级式无人机编队路径规划方法
CN112684807A (zh) * 2019-10-18 2021-04-20 成都凯天电子股份有限公司 无人机集群三维编队方法
WO2021088681A1 (zh) * 2019-11-08 2021-05-14 深圳市道通智能航空技术股份有限公司 无人机长距离循迹飞行方法、装置、设备及存储介质
CN112987732A (zh) * 2021-02-20 2021-06-18 陕西理工大学 基于人工势场法的多移动机器人编队避障控制方法
CN114115353A (zh) * 2021-12-09 2022-03-01 北京润科通用技术有限公司 一种编队避障方法及装置
CN114721438A (zh) * 2022-05-13 2022-07-08 北京航空航天大学 一种无人机编队协同避障的搜索方法、装置及电子设备
CN115454068A (zh) * 2022-09-13 2022-12-09 浙江大学 一种考虑障碍物信息的基于采样的路径规划方法
CN115657721A (zh) * 2022-10-30 2023-01-31 天翼电子商务有限公司 一种基于改进蚁群算法的空间环境无人机轨迹规划方法
CN115903895A (zh) * 2022-11-18 2023-04-04 华东理工大学 一种无人机集群的轨迹规划方法、装置和系统
CN115674209A (zh) * 2023-01-04 2023-02-03 江苏博发机器人智能装备有限公司 一种机器人路径规划分析方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
周炜;魏瑞轩;董志兴;: "基于层次分解策略无人机编队避障方法", 系统工程与电子技术, no. 05, pages 1152 - 1157 *
李黎明,巨欣悦等: "无人机电力巡线智能避障方法研究", 《中小企业管理与科技》, pages 192 - 193 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117970946B (zh) * 2024-04-01 2024-06-11 济南市勘察测绘研究院 一种无人机地理信息数据采集系统

Also Published As

Publication number Publication date
CN116540709B (zh) 2023-11-14

Similar Documents

Publication Publication Date Title
CN110472496B (zh) 一种基于目标检测与跟踪的交通视频智能分析方法
CN106683118B (zh) 一种基于分层模型的无人机目标跟踪方法
CN110531376A (zh) 用于港口无人驾驶车辆的障碍物检测和跟踪方法
WO2022188663A1 (zh) 一种目标检测方法及装置
CN103390169A (zh) 一种车载激光扫描点云数据的城市地物分类方法
CN111256681B (zh) 一种无人机群路径规划方法
CN113665574B (zh) 智能汽车换道时长预测及拟人化轨迹规划方法
US11227401B1 (en) Multiresolution voxel space
CN112198899A (zh) 基于无人飞行器的道路检测方法、设备和存储介质
CN110986956A (zh) 一种基于改进的蒙特卡洛算法的自主学习全局定位方法
CN115342821A (zh) 一种复杂未知环境下的无人车导航代价地图构建方法
CN114299607A (zh) 一种基于自动驾驶汽车的人车碰撞危险度分析方法
Tang et al. Road detection for autonomous truck in mine environment
CN114170188A (zh) 一种俯视图像的目标计数方法、系统及存储介质
CN116540709B (zh) 一种基于机器人编队的避障路径规划方法
CN117289301A (zh) 一种未知越野场景下空地无人平台协同路径规划方法
CN116338729A (zh) 一种基于多层地图的三维激光雷达导航方法
CN115980742A (zh) 一种用于无人飞行器的雷达探测方法及装置
CN116913081A (zh) 一种基于路侧激光雷达的车辆排队长度检测方法
CN115619953A (zh) 一种面向崎岖地形的移动机器人地形建图方法及系统
Shan et al. Vehicle collision risk estimation based on RGB-D camera for urban road
CN114357843B (zh) 一种针对风电装备运输进行数值碰撞实验模拟的方法
CN112731335B (zh) 一种基于全区域激光扫描的多无人机协作定位方法
CN111291662B (zh) 一种基于平面选择的车载点云杆状物提取方法
CN113379738A (zh) 一种基于图像的疫木检测与定位方法及系统

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20240201

Address after: 221200 Plant E01 at the intersection of Linkong Avenue and Anlan Avenue, Shuanggou Town, Suining County, Xuzhou City, Jiangsu Province

Patentee after: Jiangsu Kangbosi Intelligent Logistics Equipment Co.,Ltd.

Country or region after: China

Address before: 221200 workshop C5, Xincheng household appliance industrial park, economic development zone, Suining County, Xuzhou City, Jiangsu Province

Patentee before: Jiangsu BofA robot intelligent equipment Co.,Ltd.

Country or region before: China