CN113741503B - 一种自主定位式无人机及其室内路径自主规划方法 - Google Patents
一种自主定位式无人机及其室内路径自主规划方法 Download PDFInfo
- Publication number
- CN113741503B CN113741503B CN202111088637.7A CN202111088637A CN113741503B CN 113741503 B CN113741503 B CN 113741503B CN 202111088637 A CN202111088637 A CN 202111088637A CN 113741503 B CN113741503 B CN 113741503B
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- representing
- obstacle
- autonomous
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 32
- 238000001514 detection method Methods 0.000 claims abstract description 8
- 230000008569 process Effects 0.000 claims abstract description 6
- 238000005259 measurement Methods 0.000 claims description 23
- 238000010586 diagram Methods 0.000 claims description 19
- 239000011159 matrix material Substances 0.000 claims description 17
- 230000004888 barrier function Effects 0.000 claims description 14
- 238000001914 filtration Methods 0.000 claims description 10
- 238000013145 classification model Methods 0.000 claims description 8
- 238000013527 convolutional neural network Methods 0.000 claims description 5
- 238000000605 extraction Methods 0.000 claims description 5
- 238000005070 sampling Methods 0.000 claims description 5
- 238000004891 communication Methods 0.000 claims description 4
- 238000006073 displacement reaction Methods 0.000 claims description 4
- 230000010354 integration Effects 0.000 claims description 3
- 238000012549 training Methods 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 claims description 2
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 230000007704 transition Effects 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims 1
- 230000007613 environmental effect Effects 0.000 description 5
- 230000007812 deficiency Effects 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 238000011897 real-time detection Methods 0.000 description 2
- 108050006002 RNA polymerase sigma factor FliA Proteins 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 125000004122 cyclic group Chemical group 0.000 description 1
- 238000005034 decoration Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011176 pooling Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
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)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种自主定位式无人机及其室内路径自主规划方法,包括确定无人机起点和目标点,并根据室内环境参考图规划全局路径;实时获取激光雷达、双目摄像头和惯性传感器的探测信息,解析无人机的位置信息,并创建环境地图;预判当前节点到下一节点飞行过程是否存在障碍物,若存在,进行障碍物识别和特征提取;根据障碍物的特征信息,规划局部路径,并更新所述全局路径和环境地图。本发明提供的室内路径自主规划方法可用于GPS缺失的室内环境,自主定位精度高,构建高精度环境地图,还可规划局部最优路径并快速绕过障碍物。
Description
技术领域
本发明涉及无人机自主定位技术领域,特别涉及一种自主定位式无人机及其室内路径自主规划方法。
背景技术
随着社会进步与发展,室内移动智能机器人成为目前机器人的热门研究方向。自主定位与导航系统设计是实现室内移动机器人自动化的关键技术。定位精度及导航效率决定了机器人的推广应用程度。但室内环境存在GPS缺失或盲点、物体布局复杂、动态因素多、部分环境纹理缺失、光照强度易随动态物体移动发生变化等问题,限制了移动机器人在家庭、车间等室内环境中的应用,因此有必要提出一种具有室内路径自主规划的自主定位式机器人。
发明内容
本发明提供了一种自主定位式无人机及其室内路径自主规划方法,在无人机主体上设置激光雷达、双目摄像头和惯性传感器,通过惯性传感器实时解析无人机的位置信息,基于提前规划的全局路径,结合激光雷达和双目摄像头实时探测,建立环境地图并绕过障碍物,实时更新全局路径。
本发明的技术方案是:
一种自主定位式无人机,包括:
无人机本体;
激光雷达,其连接无人机主体,以获取环境信息;
双目摄像头,其连接无人机主体,以获取地面信息;
惯性传感器,其连接无人机主体,以获取无人机位姿信息;
自主定位模块,其与激光雷达、双目摄像头和惯性传感器通信连接,以解析无人机的位置信息,并创建环境地图;
障碍物识别和路径规划模块,其连接自主定位模块,能够进行障碍物识别、全局和局部路径规划。
优选的是,惯性传感器包括三轴陀螺仪和三轴加速度计。
一种自主定位式无人机室内路径自主规划方法,基于上述的自主定位式无人机,包括:
步骤一、确定无人机起点和目标点,并根据室内环境参考图规划全局路径;
步骤二、实时获取激光雷达、双目摄像头和惯性传感器的探测信息,解析无人机的位置信息,并创建环境地图;
步骤三、预判当前节点到下一节点飞行过程是否存在障碍物,若存在,进行障碍物识别和特征提取;
步骤四、根据障碍物的特征信息,规划局部路径,并更新全局路径和环境地图。
优选的是,步骤一包括:
将室内环境参考图进行栅格化,并对参考图中的障碍物进行膨胀处理;
将不含障碍物的网格标记为自由栅格,含有障碍物的栅格标记为障碍栅格,并划分为自由栅格区和障碍栅格区;
将紧邻障碍栅格区的自由栅格作为顶点,初始化无人机起点与各顶点的距离;
向外层层扩展,循环搜索,直到起点与各顶点的距离最短。
优选的是,解析无人机的位置信息包括:
无人机本体按照全局路线行进,获取惯性传感器的探测信息,利用惯性积分方法连续计算飞行的相对距离和航向;
根据起点位置和航向计算当前无人机的绝对位置及方位:
基于卡尔曼滤波模型,建立航迹推算状态方程,并根据状态方程,计算误差状态向量和速度测量值误差;
结合贝叶斯滤波算法,以全局路径约束航迹推算轨迹。
优选的是,障碍物识别包括:
获取激光雷达的采集特征图,将特征图分割为多个相等的方形区块;
分别计算每个方形区块的占比值,将占比值大于占比阈值的方形区块作为感兴趣区块;
设定邻域和最低密度值,遍历感兴趣区块,得到每个感兴趣区块的中心点;
若相邻感兴趣区块的中心点密度相连,则相邻感兴趣区块归为一个障碍物团簇。
优选的是,特征提取包括:
采用卷积神经网络训练得到分类模型;
获取激光雷达和双目摄像头采集的特征图,将三维锚框投影到特征图中;
根据投影结果将特征图裁剪成多个二维锚框;
将二维锚框输入到分类模型中进行目标分类和边界框回归。
优选的是,二维锚框尺度为8、16、32中的一种,比例为2:1、1:1、1:2中的一种。
优选的是,局部路径包括:
基于无人机的位置信息,计算无人机所受的势场合力;
判断无人机是否处于局部极小值;
如果是,无人机沿斥力势场等势线绕行,直到逃离局部极小值区域。
优选的是,局部极小值包括:无人机所受势场合力趋于零和或无人机行进位移与路程比趋于零。
本发明的有益效果是:
1、本发明提供的自主定位式无人机及其室内路径自主规划方法,在无人机主体上设置激光雷达、双目摄像头和惯性传感器,通过惯性传感器实时解析无人机的位置信息,基于提前规划的全局路径,结合激光雷达和双目摄像头实时探测,建立环境地图并绕过障碍物,实时更新全局路径,适用于GPS缺失的室内环境。
2、本发明提供的自主定位式无人机室内路径自主规划方法,基于卡尔曼滤波模型结合贝叶斯滤波算法,解析得到无人机的位置信息,自主定位精度高。
3、本发明提供的自主定位式无人机室内路径自主规划方法,基于卷积神经网络建立二维分类模型,进行目标分类和边界框回归,障碍物特征提取高效,准确率高,同时采用人工势场法规划局部路径,能够快速绕过障碍物。
附图说明
图1为本发明提供的自主定位式无人机的结构示意图。
图2为本发明提供的自主定位式无人机室内路径自主规划方法流程图。
图3为本发明的一个实施例中制定全局路径的方法流程图。
图4为本发明的一个实施例中障碍物膨胀前的栅格图。
图5为本发明的一个实施例中障碍物膨胀后的栅格图。
图6为本发明的一个实施例中循环搜索的原理图。
图7为本发明的一个实施例中解析无人机的位置信息的方法流程图。
图8为本发明的一个实施例中无人机飞行图。
图9为本发明的一个实施例中障碍物识别和特征提取方法流程图。
图10为本发明的一个实施例中局部路径规划方法流程图。
具体实施方式
以下由特定的具体实施例说明本发明的实施方式,熟悉此技术的人士可由本说明书所揭露的内容轻易地了解本发明的其他优点及功效,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明的是,在本发明的描述中,术语“中”、“上”、“下”、“横”、“内”等指示的方向或位置关系的术语是基于附图所示的方向或位置关系,这仅仅是为了便于描述,而不是指示或暗示装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性。
此外,还需要说明的是,在本发明的描述中,除非另有明确的规定和限定,术语“设置”、“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域技术人员而言,可根据具体情况理解上述术语在本发明中的具体含义。
如图1所示,自主定位式无人机,包括无人机本体110、激光雷达120、双目摄像头130、惯性传感器140、自主定位模块150和障碍物识别和路径规划模块160。
其中,激光雷达120连接无人机主体110,以获取环境信息,双目摄像头130连接无人机主体110,以获取地面信息,惯性传感器140连接无人机主体110,以获取无人机位姿信息,自主定位模块150与激光雷达120、双目摄像头130和惯性传感器140通信连接,以解析无人机的位置信息,并创建环境地图,障碍物识别和路径规划模块160连接自主定位模块150,能够进行障碍物识别、全局和局部路径规划。
进一步的,惯性传感器140包括三轴陀螺仪141和三轴加速度计142。
基于上述自主定位式无人机的室内路径自主规划方法,如图2所示包括:
S110、确定无人机起点和目标点,并根据室内环境参考图规划全局路径;
S120、实时获取激光雷达、双目摄像头和惯性传感器的探测信息,解析无人机的位置信息,并创建环境地图;
S130、预判当前节点到下一节点飞行过程是否存在障碍物,若存在,进行障碍物识别和特征提取;
S140、根据障碍物的特征信息,规划局部路径,并更新全局路径和环境地图。
本发明通过惯性传感器实时解析无人机的位置信息,基于提前规划的全局路径,结合激光雷达和双目摄像头实时探测,建立环境地图并绕过障碍物,实时更新全局路径,适用于GPS缺失的室内环境,自主定位精度高,构建高精度环境地图,还可规划局部最优路径并快速绕过障碍物。
获取室内环境的结构图,如建筑结构或装修结构图,能够对无人机飞行区域做初步预判,绘制全局地图,能够有效约束无人机飞行路线,如图3所示,具体包括:
S111、将室内环境参考图进行栅格化,并对参考图中的障碍物进行膨胀处理。
S112、将不含障碍物的网格标记为自由栅格,含有障碍物的栅格标记为障碍栅格,并划分为自由栅格区和障碍栅格区;
对环境参考图进行图像处理,转化为计算机能够识别的栅格化模型,利用栅格块组成环境参考图中的可行区域与不可行区域,其中可以自由飞行且在此区域内不含任何障碍物的网格称为自由栅格,含有障碍物的栅格称为障碍栅格,中除了自由栅格与障碍栅格外还存在第三种栅格,该栅格内一部分是自由区域,另一部分是障碍物区域。为此,按照图像形态学扩充理论对其进行障碍物膨胀处理,当障碍物占据某一栅格时,无论占据栅格的面积为多少均将其视为完全不可行区域。
S113、将紧邻障碍栅格区的自由栅格作为顶点,初始化无人机起点与各顶点的距离;
S114、向外层层扩展,循环搜索,直到起点与各顶点的距离最短。
向外层拓展时,每加入一个新节点,需要对边进行松弛判断,判断起点通过新顶点到达其他顶点的距离是否比起点直接到达其他节点的距离小,若小则替换起点与其他节点间的直达路径。
在一个具体实施例中,障碍物膨胀前的栅格图如图4所示,膨胀后的栅格图如图5所示,循环搜索的原理如图6所示,获得的路径更短、转折角更小、转向更平滑,能够更好满足无人机实际飞行的要求。
如图7所示,解析无人机的位置信息包括:
S121、无人机本体按照全局路线行进,获取惯性传感器的探测信息,利用惯性积分方法连续计算飞行的相对距离和航向,如图8所示。
S122、根据起点位置和航向计算当前无人机的绝对位置及方位。
其中,t表示采样时间;Zt表示t时刻传感器坐标系到导航坐标系的转换矩阵,E表示单位矩阵,T表示采样单位时间,Ω表示三轴角速度反对称矩阵,vt表示是t时刻导航坐标系下的速度,ft表示是传感器坐标系下加速度计的比力测量值,g表示导航坐标系下的重力加速度,pt表示t时刻计算得到的导航系下的位置。
S123、基于卡尔曼滤波模型,建立航迹推算状态方程,并根据状态方程,计算误差状态向量和速度测量值误差。
航迹推算状态方程为:
其中,表示姿态误差,/>表示姿态误差估计,δv表示速度误差,/>表示速度误差估计,δp表示位置误差,/>表示位置误差估计,δwi表示陀螺仪测量误差,δf表示加速度计测量误差。
根据所状态方程,计算误差状态向量和速度测量值误差;
其中,Ft表示t时刻的状态转移矩阵,Hv表示基于速度的测量矩阵,wt-1表示状态噪声,ηv,t表示速度测量噪声,zv,t表示速度测量值对应的速度误差,状态矩阵Ft和速度测量矩阵Hv表示如下:
Hv=[O3×3I3×3O3×3];
这里,Δt表示采样间隔,I3×3表示3×3的实阵;O3×3表示3×3的零阵,St表示比力向量f的反对称矩阵;
S124、结合贝叶斯滤波算法,以全局路径约束航迹推算轨迹。
建立约束估计模型为:
其中,xt表示状态向量,zt表示测量向量,w表示过程噪声,v表示测量噪声,函数f和h是全局路径的非线性约束函数。
基于卡尔曼滤波模型结合贝叶斯滤波算法,解析得到无人机的位置信息,自主定位精度高。
如图9所示,障碍物识别和特征提取包括:
S131、获取激光雷达的采集特征图,将特征图分割为多个相等的方形区块。
S132、分别计算每个方形区块的占比值,将占比值大于占比阈值的方形区块作为感兴趣区块。
S133、设定邻域和最低密度值,遍历感兴趣区块,得到每个感兴趣区块的中心点。
S134、若相邻感兴趣区块的中心点密度相连,则相邻感兴趣区块归为一个障碍物团簇。
S135、采用卷积神经网络训练得到分类模型。
S136、获取激光雷达和双目摄像头采集的特征图,将三维锚框投影到特征图中。
本发明设置了3种尺寸的锚框,锚框由其中心坐标(x,y,z)和长度,宽度、高度(l,w,h)六个参数表示,锚框的大小通过对数据集中检测目标的标签信息进行聚类来确定。由于雷达点云稀疏会导致许多空锚,对于不包含点云的空锚,根据锚框中点云的总和是否为零来决定是否将其剔除。
S137、根据投影结果将特征图裁剪成多个二维锚框。
为了实现雷达点云和图像的特征融合,需要对特征图进行ROI池化。因此,本发明将三维锚框投影到特征图上,然后对其进行裁剪和尺寸调整,对于三维锚框(x,y,z,l,w,h),特征图上投影区域的左上角和右下角可以表示为(xl,left,zl,left)和(xl,right,zl,right),即:
S138、将二维锚框输入到分类模型中进行目标分类和边界框回归。
由于锚框通常不能很好地包围目标障碍物,所以需要通过神经网络进行回归,以帮助网络输出更为准确的边界框。
作为一种优选,二维锚框尺度为8、16、32中的一种,比例为2:1、1:1、1:2中的一种。
基于卷积神经网络建立二维分类模型,进行目标分类和边界框回归,障碍物特征提取高效,准确率高。
本发明局部路径规划采用人工势场法,基本思想是把智能体的运动环境抽象为目标点产生的引力势场和障碍物产生的斥力势场构成的势场空间,在这个空间中,智能体分别受到障碍物的斥力和目标点的引力,并在这两种力的共同作用下向目标点的方向运动,最终到达目标点位置,具体如图10所示,包括:
S141基于无人机的位置信息,计算无人机所受的势场合力。
假设无人机目标点坐标为pe=(xe,ye),那么无人机到位置pi=(xi,yi)时,引力势场函数为:
其中,Ug(pi)表示引力势场函数,kg表示引力势场正比例系数,n表示引力势场因子,d(pi,pe)表示无人机到目标点的距离。
斥力势场函数为:
其中,Ur(pi)表示斥力势场函数,kr表示斥力势场正比例系数,d(pi,po)表示无人机与障碍物之间的距离,do表示受障碍物影响的最大距离,当且仅当无人机到do范围内的时候才会受到障碍物斥力作用。
无人机飞行路径中一般都要经过多个障碍物,产生的斥力势场也会有多个,所以其受到的斥力也应是多个斥力势场产生斥力的合力∑Fr(pi)。那么,无人机飞行过程中受到的引力与斥力的合力为:
F(pi)=Fg(pi)+∑Fr(pi);
其中,F(pi)表示无人机在pi点受到的势场合力,Fg(pi)表示无人机在pi点受到的引力,Fr(pi)表示无人机在pi点受到的斥力。
S142判断无人机是否处于局部极小值。
其中,局部极小值的判断规则为:无人机所受势场合力趋于零和或无人机行进位移与路程比趋于零,即:
F(pi)=Fg(pi)+∑Fr(pi)→0,和/或
其中,|xi-xj|表示i点到j点的直线距离即位移,s表示路程。
S143如果是,无人机沿斥力势场等势线绕行,直到逃离局部极小值区域。
采用人工势场法规划局部路径,能够快速绕过障碍物。
以上内容仅是本发明的实施例,方案中公知的具体结构及特性等常识在此未作过多描述,本领域技术人员容易理解的是,本发明的保护范围显然不局限于这些具体实施方式。在不脱离本发明的前提下,还可以作出若干变形和改进,这些也应该视为本发明的保护范围,这些都不会影响本发明实施的效果和专利的实用性。
Claims (8)
1.一种自主定位式无人机,其特征在于,包括:
无人机主体;
激光雷达,其连接所述无人机主体,以获取环境信息;
双目摄像头,其连接所述无人机主体,以获取地面信息;
惯性传感器,其连接所述无人机主体,以获取无人机位姿信息;
自主定位模块,其与所述激光雷达、所述双目摄像头和所述惯性传感器通信连接,以解析所述无人机的位置信息,并创建环境地图;
障碍物识别和路径规划模块,其连接所述自主定位模块,能够进行障碍物识别、全局和局部路径规划;
所述自主定位式无人机室内路径自主规划方法,包括:
步骤一、确定无人机起点和目标点,并根据室内环境参考图规划全局路径;
步骤二、实时获取激光雷达、双目摄像头和惯性传感器的探测信息,解析无人机的位置信息,并创建环境地图;
步骤三、预判当前节点到下一节点飞行过程是否存在障碍物,若存在,进行障碍物识别和特征提取;
步骤四、根据所述障碍物的特征信息,规划局部路径,并更新所述全局路径和环境地图;
所述解析无人机的位置信息包括:
无人机主体按照所述全局路线行进,获取所述惯性传感器的探测信息,利用惯性积分方法连续计算飞行的相对距离和航向;
根据所述起点位置和所述航向计算当前无人机的绝对位置及方位:具体根据公式计算当前无人机的绝对位置及方位,其中,t表示采样时间;Z(t)表示t时刻传感器坐标系到导航坐标系的转换矩阵,Z(t-1)表示t-1时刻传感器坐标系到导航坐标系的转换矩阵,E表示单位矩阵,T表示采样单位时间,Ωt表示三轴角速度反对称矩阵,vt表示是t时刻导航坐标系下的速度,vt-1表示是t-1时刻导航坐标系下的速度,ft表示是传感器坐标系下加速度计的比力测量值,g表示导航坐标系下的重力加速度,pt表示t时刻计算得到的导航系下的位置,pt-1表示t-1时刻计算得到的导航系下的位置;
基于卡尔曼滤波模型,建立航迹推算状态方程,并根据所述状态方程,计算误差状态向量和速度测量值误差;航迹推算状态方程为:其中,/>表示姿态误差,/>表示姿态误差估计,δV表示速度误差,/>表示速度误差估计,δp表示位置误差,/>表示位置误差估计,δwi表示陀螺仪测量误差,δf表示加速度计测量误差;
根据所状态方程,计算误差状态向量和速度测量值误差;/>其中,Ft表示t时刻的状态转移矩阵,Hv表示基于速度的测量矩阵,wt-1表示状态噪声,ηv,t表示速度测量噪声,zv,t表示速度测量值/>对应的速度误差,状态矩阵Ft和速度测量矩阵Hv表示如下:/>Hv=[O3×3 I3×3 O3×3],Δt表示采样间隔,I3×3表示3×3的实阵;O3×3表示3×3的零阵,St表示比力向量f的反对称矩阵;
结合贝叶斯滤波算法,以所述全局路径约束航迹推算轨迹;
建立约束估计模型为:
其中,xt表示状态向量,zt表示测量向量,w表示过程噪声,v表示测量噪声,函数f和h是全局路径的非线性约束函数。
2.如权利要求1所述的自主定位式无人机,其特征在于,所述惯性传感器包括三轴陀螺仪和三轴加速度计。
3.如权利要求1所述的自主定位式无人机,其特征在于,所述步骤一包括:
将所述室内环境参考图进行栅格化,并对所述参考图中的障碍物进行膨胀处理;
将不含障碍物的网格标记为自由栅格,含有障碍物的栅格标记为障碍栅格,并划分为自由栅格区和障碍栅格区;
将紧邻障碍所述栅格区的所述自由栅格作为顶点,初始化无人机起点与各顶点的距离;
向外层层扩展,循环搜索,直到所述起点与所述各顶点的距离最短。
4.如权利要求1所述的自主定位式无人机,其特征在于,所述障碍物识别包括:
获取激光雷达的采集特征图,将所述特征图分割为多个相等的方形区块;
分别计算每个所述方形区块的占比值,将所述占比值大于占比阈值的方形区块作为感兴趣区块;
设定邻域和最低密度值,遍历所述感兴趣区块,得到每个所述感兴趣区块的中心点;
若相邻感兴趣区块的所述中心点密度相连,则所述相邻感兴趣区块归为一个障碍物团簇。
5.如权利要求4所述的自主定位式无人机室,其特征在于,所述特征提取包括:
采用卷积神经网络训练得到分类模型;
获取所述激光雷达和所述双目摄像头采集的特征图,将三维锚框投影到所述特征图中;
根据投影结果将所述特征图裁剪成多个二维锚框;
将所述二维锚框输入到所述分类模型中进行目标分类和边界框回归。
6.如权利要求5所述的自主定位式无人机,其特征在于,所述二维锚框尺度为8、16、32中的一种,比例为2:1、1:1、1:2中的一种。
7.如权利要求6所述的自主定位式无人机,其特征在于,所述局部路径包括:
基于所述无人机的位置信息,计算无人机所受的势场合力;
判断所述无人机是否处于局部极小值;
如果是,所述无人机沿斥力势场等势线绕行,直到逃离局部极小值区域。
8.如权利要求7所述的自主定位式无人机,其特征在于,所述局部极小值包括:无人机所受势场合力趋于零和或无人机行进位移与路程比趋于零。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111088637.7A CN113741503B (zh) | 2021-09-16 | 2021-09-16 | 一种自主定位式无人机及其室内路径自主规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111088637.7A CN113741503B (zh) | 2021-09-16 | 2021-09-16 | 一种自主定位式无人机及其室内路径自主规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113741503A CN113741503A (zh) | 2021-12-03 |
CN113741503B true CN113741503B (zh) | 2024-01-30 |
Family
ID=78739424
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111088637.7A Active CN113741503B (zh) | 2021-09-16 | 2021-09-16 | 一种自主定位式无人机及其室内路径自主规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113741503B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115494877A (zh) * | 2022-10-21 | 2022-12-20 | 哈尔滨工业大学 | 基于人工势场法的卫星模拟器编队避障路径规划方法 |
CN116382310B (zh) * | 2023-06-06 | 2023-08-18 | 南京理工大学 | 一种人工势场路径规划方法及系统 |
CN117214908B (zh) * | 2023-10-10 | 2024-05-10 | 深圳市宇讯通光电有限公司 | 一种基于智能裁缆机械的定位控制方法及系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106708054A (zh) * | 2017-01-24 | 2017-05-24 | 贵州电网有限责任公司电力科学研究院 | 结合地图栅格与势场法避障的巡检机器人路径规划方法 |
CN108663681A (zh) * | 2018-05-16 | 2018-10-16 | 华南理工大学 | 基于双目摄像头与二维激光雷达的移动机器人导航方法 |
CN110471441A (zh) * | 2019-08-12 | 2019-11-19 | 南京理工大学 | 一种基于激光探测的四旋翼无人机避障方法 |
CN112783194A (zh) * | 2020-12-18 | 2021-05-11 | 上海电力股份有限公司吴泾热电厂 | 一种无人机在室内煤场飞行的避障方法 |
-
2021
- 2021-09-16 CN CN202111088637.7A patent/CN113741503B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106708054A (zh) * | 2017-01-24 | 2017-05-24 | 贵州电网有限责任公司电力科学研究院 | 结合地图栅格与势场法避障的巡检机器人路径规划方法 |
CN108663681A (zh) * | 2018-05-16 | 2018-10-16 | 华南理工大学 | 基于双目摄像头与二维激光雷达的移动机器人导航方法 |
CN110471441A (zh) * | 2019-08-12 | 2019-11-19 | 南京理工大学 | 一种基于激光探测的四旋翼无人机避障方法 |
CN112783194A (zh) * | 2020-12-18 | 2021-05-11 | 上海电力股份有限公司吴泾热电厂 | 一种无人机在室内煤场飞行的避障方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113741503A (zh) | 2021-12-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Wang et al. | F-loam: Fast lidar odometry and mapping | |
Mansouri et al. | Cooperative coverage path planning for visual inspection | |
CN112347840B (zh) | 视觉传感器激光雷达融合无人机定位与建图装置和方法 | |
CN113741503B (zh) | 一种自主定位式无人机及其室内路径自主规划方法 | |
US10696300B2 (en) | Vehicle tracking | |
EP4318397A2 (en) | Method of computer vision based localisation and navigation and system for performing the same | |
JP2019527832A (ja) | 正確な位置特定およびマッピングのためのシステムおよび方法 | |
Li et al. | Collaborative mapping and autonomous parking for multi-story parking garage | |
CN112639502A (zh) | 机器人位姿估计 | |
KR20190064311A (ko) | 라이다를 이용한 지도 생성 방법 및 장치 | |
CN103278170A (zh) | 基于显著场景点检测的移动机器人级联地图创建方法 | |
CN116147642B (zh) | 融合地形与力的四足机器人可达性地图构建方法及系统 | |
Bai et al. | A sensor fusion framework using multiple particle filters for video-based navigation | |
Pang et al. | Low-cost and high-accuracy LiDAR SLAM for large outdoor scenarios | |
Akopov et al. | Choosing a Camera for 3D Mapping | |
Choi et al. | Online 3D coverage path planning using surface vector | |
Anousaki et al. | Simultaneous localization and map building of skid-steered robots | |
CN117234203A (zh) | 一种多源里程融合slam井下导航方法 | |
Soleimani et al. | A disaster invariant feature for localization | |
Wang et al. | Micro aerial vehicle navigation with visual-inertial integration aided by structured light | |
Rangan et al. | Improved localization using visual features and maps for Autonomous Cars | |
CN113227713A (zh) | 生成用于定位的环境模型的方法和系统 | |
Shoushtari et al. | 3d indoor localization using 5g-based particle filtering and cad plans | |
Yang et al. | An optimization-based selection approach of landing sites for swarm unmanned aerial vehicles in unknown environments | |
Liu et al. | Relative Flash LiDAR Aided-Inertial Navigation using Surfel Grid Maps |
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 |