[发明专利]矿井下无人机自主规划路径的方法、装置、电子设备及存储介质

说明书

本公开提出一种矿井下无人机自主规划路径的方法、装置、电子设备及存储介质，涉及井下无人机路径规划技术领域。该方法包括：获取煤矿井下全局地图，其中，全局地图中包含定位锚点的第一坐标及第一编号；获取飞行起点坐标及飞行终点坐标；根据全局地图中无障碍的区域、飞行起点坐标、飞行终点坐标及定位锚点的第一坐标及第一编号，确定飞行过程中依次经过的目标锚点序列；基于目标锚点序列、飞行终点坐标及飞行起点坐标，生成目标飞行路径。由此，可以根据井下预设的定位锚点及井下全局地图，自主规划飞行路径，从而可以实现井下全局的路径规划，而且基于定位锚点规划路径，可以减少路径规划的工作量，提高路径规划的效率。

技术领域

本公开涉及井下无人机路径规划技术领域，尤其涉及一种矿井下无人机自主规划路径的方法、装置、电子设备及存储介质。

背景技术

煤矿安全生产关系到煤炭工业的健康发展。井下无人机可以实现对人难以达到的区域进行巡查、检修等工作，无人机轻便灵活，可随时随地全方位、多角度巡检井下情况，省去人工巡检的环节和高空作业带来的安全隐患，既节省时间，又安全可靠。

矿山井下和地表不同，井下没有卫星信号，因而不能依赖卫星进行飞行设备的定位；空间比较狭小，飞行控制难度大；无线通信难以全面覆盖容易造成通信故障。因此，井下无人机如何自主规划路径成为重点的研究方向。

发明内容

本公开旨在至少在一定程度上解决相关技术中的技术问题之一。

本公开第一方面实施例提出了一种矿井下无人机自主规划路径的方法，包括：

获取煤矿井下全局地图，其中，所述全局地图中包含定位锚点的第一坐标及第一编号；

获取飞行起点坐标及飞行终点坐标；

根据所述全局地图中无障碍的区域、所述飞行起点坐标、所述飞行终点坐标及所述定位锚点的第一坐标及第一编号，确定飞行过程中依次经过的目标锚点序列；

基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径。

可选的，所述基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径，包括：

根据所述目标锚点序列中每个目标锚点的第二坐标，确定每个所述目标锚点所在的巷道断面；

根据每个所述巷道断面的中心点坐标，生成中心点坐标序列；

确定所述中心点坐标序列中每相邻两个中心点坐标之间的多个路径点坐标；

根据所述中心点坐标序列、所述每相邻两个中心点坐标之间的多个路径点坐标、所述飞行起点坐标及所述飞行终点坐标，生成路径点序列；

对所述路径点序列进行拟合，生成所述目标飞行路径。

可选的，在所述基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径之后，还包括：

在所述无人机基于所述目标飞行路径进行飞行的过程中，基于预设的定位方法，确定所述无人机当前的第三坐标；

当所述第三坐标与任一目标锚点对应的中心点坐标重合的情况下，通过所述无人机中的锚点探测装置，确定是否接收到锚点信号；

在接收到锚点信号、且所述锚点信号中包含的第二编号与所述任一目标锚点的第三编号相同的情况下，根据所述任一目标锚点的第四坐标及所述锚点信号，确定所述任一目标锚点与所述无人机之间的第一相对位置；

基于所述第三坐标，及所述第四坐标，确定所述无人机与所述任一目标锚点之间的第二相对位置；

在所述第一相对位置与所述第二相对位置之间的误差大于阈值的情况下，基于所述第一相对位置对所述无人机当前的第三坐标进行修正；