本公开提出一种矿井下无人机自主规划路径的方法、装置、电子设备及存储介质，涉及井下无人机路径规划技术领域。该方法包括：获取煤矿井下全局地图，其中，全局地图中包含定位锚点的第一坐标及第一编号；获取飞行起点坐标及飞行终点坐标；根据全局地图中无障碍的区域、飞行起点坐标、飞行终点坐标及定位锚点的第一坐标及第一编号，确定飞行过程中依次经过的目标锚点序列；基于目标锚点序列、飞行终点坐标及飞行起点坐标，生成目标飞行路径。由此，可以根据井下预设的定位锚点及井下全局地图，自主规划飞行路径，从而可以实现井下全局的路径规划，而且基于定位锚点规划路径，可以减少路径规划的工作量，提高路径规划的效率。提高路径规划的效率。提高路径规划的效率。
【技术实现步骤摘要】
矿井下无人机自主规划路径的方法、装置、电子设备及存储介质
[0001]本公开涉及井下无人机路径规划
，尤其涉及一种矿井下无人机自主规划路径的方法、装置、电子设备及存储介质。
技术介绍
[0002]煤矿安全生产关系到煤炭工业的健康发展。井下无人机可以实现对人难以达到的区域进行巡查、检修等工作，无人机轻便灵活，可随时随地全方位、多角度巡检井下情况，省去人工巡检的环节和高空作业带来的安全隐患，既节省时间，又安全可靠。
[0003]矿山井下和地表不同，井下没有卫星信号，因而不能依赖卫星进行飞行设备的定位；空间比较狭小，飞行控制难度大；无线通信难以全面覆盖容易造成通信故障。因此，井下无人机如何自主规划路径成为重点的研究方向。
技术实现思路
[0004]本公开旨在至少在一定程度上解决相关技术中的技术问题之一。
[0005]本公开第一方面实施例提出了一种矿井下无人机自主规划路径的方法，包括：
[0006]获取煤矿井下全局地图，其中，所述全局地图中包含定位锚点的第一坐标及第一编号；
[0007]获取飞行起点坐标及飞行终点坐标；
[0008]根据所述全局地图中无障碍的区域、所述飞行起点坐标、所述飞行终点坐标及所述定位锚点的第一坐标及第一编号，确定飞行过程中依次经过的目标锚点序列；
[0009]基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径。
[0010]可选的，所述基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径，包括：
[0011]根据所述目标锚点序列中每个目标锚点的第二坐标，确定每个所述目标锚点所在的巷道断面；
[0012]根据每个所述巷道断面的中心点坐标，生成中心点坐标序列；
[0013]确定所述中心点坐标序列中每相邻两个中心点坐标之间的多个路径点坐标；
[0014]根据所述中心点坐标序列、所述每相邻两个中心点坐标之间的多个路径点坐标、所述飞行起点坐标及所述飞行终点坐标，生成路径点序列；
[0015]对所述路径点序列进行拟合，生成所述目标飞行路径。
[0016]可选的，在所述基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径之后，还包括：
[0017]在所述无人机基于所述目标飞行路径进行飞行的过程中，基于预设的定位方法，确定所述无人机当前的第三坐标；
[0018]当所述第三坐标与任一目标锚点对应的中心点坐标重合的情况下，通过所述无人机中的锚点探测装置，确定是否接收到锚点信号；
[0019]在接收到锚点信号、且所述锚点信号中包含的第二编号与所述任一目标锚点的第三编号相同的情况下，根据所述任一目标锚点的第四坐标及所述锚点信号，确定所述任一目标锚点与所述无人机之间的第一相对位置；
[0020]基于所述第三坐标，及所述第四坐标，确定所述无人机与所述任一目标锚点之间的第二相对位置；
[0021]在所述第一相对位置与所述第二相对位置之间的误差大于阈值的情况下，基于所述第一相对位置对所述无人机当前的第三坐标进行修正；
[0022]基于修正后的第三坐标，继续沿着所述目标飞行路径进行飞行。
[0023]可选的，在所述通过所述无人机中的锚点探测装置，确定是否接收到锚点信号之后，还包括：
[0024]在未接收到所述锚点信号的情况下，终止飞行任务；或者，
[0025]在接收到所述锚点信号，且所述第二编号与所述第三编号不同的情况下，终止飞行任务。
[0026]可选的，在所述基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径之后，还包括：
[0027]根据所述目标飞行路径中巷道的高度，确定所述无人机的飞行高度；
[0028]基于所述飞行高度，对所述目标飞行路径进行修正。
[0029]本公开第二方面实施例提出了一种矿井下无人机自主规划路径的装置，包括：
[0030]第一获取模块，用于获取煤矿井下全局地图，其中，所述全局地图中包含定位锚点的第一坐标及第一编号；
[0031]第二获取模块，用于获取飞行起点坐标及飞行终点坐标；
[0032]第一确定模块，用于根据所述全局地图中无障碍的区域、所述飞行起点坐标、所述飞行终点坐标及所述定位锚点的第一坐标及第一编号，确定飞行过程中依次经过的目标锚点序列；
[0033]生成模块，用于基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径。
[0034]可选的，所述生成模块，具体用于：
[0035]根据所述目标锚点序列中每个目标锚点的第二坐标，确定每个所述目标锚点所在的巷道断面；
[0036]根据每个所述巷道断面的中心点坐标，生成中心点坐标序列；
[0037]确定所述中心点坐标序列中每相邻两个中心点坐标之间的多个路径点坐标；
[0038]根据所述中心点坐标序列、所述每相邻两个中心点坐标之间的多个路径点坐标、所述飞行起点坐标及所述飞行终点坐标，生成路径点序列；
[0039]对所述路径点序列进行拟合，生成所述目标飞行路径。
[0040]可选的，还包括：
[0041]第二确定模块，用于在所述无人机基于所述目标飞行路径进行飞行的过程中，基于预设的定位装置，确定所述无人机当前的第三坐标；
[0042]第三确定模块，用于当所述第三坐标与任一目标锚点对应的中心点坐标重合的情况下，通过所述无人机中的锚点探测装置，确定是否接收到锚点信号；
[0043]第四确定模块，用于在接收到锚点信号、且所述锚点信号中包含的第二编号与所述任一目标锚点的第三编号相同的情况下，根据所述任一目标锚点的第四坐标及所述锚点信号，确定所述任一目标锚点与所述无人机之间的第一相对位置；
[0044]第五确定模块，用于基于所述第三坐标，及所述第四坐标，确定所述无人机与所述任一目标锚点之间的第二相对位置；
[0045]修正模块，用于在所述第一相对位置与所述第二相对位置之间的误差大于阈值的情况下，基于所述第一相对位置对所述无人机当前的第三坐标进行修正；
[0046]飞行模块，用于基于修正后的第三坐标，继续沿着所述目标飞行路径进行飞行。
[0047]可选的，还包括终止模块，具体用于：
[0048]在未接收到所述锚点信号的情况下，终止飞行任务；或者，
[0049]在接收到所述锚点信号，且所述第二编号与所述第三编号不同的情况下，终止飞行任务。
[0050]可选的，还包括第六确定模块，具体用于：
[0051]根据所述目标飞行路径中巷道的高度，确定所述无人机的飞行高度；
[0052]基于所述飞行高度，对所述目标飞行路径进行修正。
[0053]本公开第三方面实施例提出了一种电子设备，包括：存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，所述处理器执行所述程序时，实现如本公开第一本文档来自技高网...
【技术保护点】
【技术特征摘要】
1.一种矿井下无人机自主规划路径的方法，其特征在于，包括：获取煤矿井下全局地图，其中，所述全局地图中包含定位锚点的第一坐标及第一编号；获取飞行起点坐标及飞行终点坐标；根据所述全局地图中无障碍的区域、所述飞行起点坐标、所述飞行终点坐标及所述定位锚点的第一坐标及第一编号，确定飞行过程中依次经过的目标锚点序列；基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径。2.根据权利要求1所述的方法，其特征在于，所述基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径，包括：根据所述目标锚点序列中每个目标锚点的第二坐标，确定每个所述目标锚点所在的巷道断面；根据每个所述巷道断面的中心点坐标，生成中心点坐标序列；确定所述中心点坐标序列中每相邻两个中心点坐标之间的多个路径点坐标；根据所述中心点坐标序列、所述每相邻两个中心点坐标之间的多个路径点坐标、所述飞行起点坐标及所述飞行终点坐标，生成路径点序列；对所述路径点序列进行拟合，生成所述目标飞行路径。3.根据权利要求2所述的方法，其特征在于，在所述基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径之后，还包括：在所述无人机基于所述目标飞行路径进行飞行的过程中，基于预设的定位方法，确定所述无人机当前的第三坐标；当所述第三坐标与任一目标锚点对应的中心点坐标重合的情况下，通过所述无人机中的锚点探测装置，确定是否接收到锚点信号；在接收到锚点信号、且所述锚点信号中包含的第二编号与所述任一目标锚点的第三编号相同的情况下，根据所述任一目标锚点的第四坐标及所述锚点信号，确定所述任一目标锚点与所述无人机之间的第一相对位置；基于所述第三坐标，及所述第四坐标，确定所述无人机与所述任一目标锚点之间的第二相对位置；在所述第一相对位置与所述第二相对位置之间的误差大于阈值的情况下，基于所述第一相对位置对所述无人机当前的第三坐标进行修正；基于修正后的第三坐标，继续沿着所述目标飞行路径进行飞行。4.根据权利要求3所述的方法，其特征在于，在所述通过所述无人机中的锚点探测装置，确定是否接收到锚点信号之后，还包括：在未接收到所述锚点信号的情况下，终止飞行任务；或者，在接收到所述锚点信号，且所述第二编号与所述第三编号不同的情况下，终止飞行任务。5.根据权利要求1所述的方法，其特征在于，在所述基于所述目标锚点序列、所述飞行终点坐标及所述飞行起点坐标，生成目标飞行路径之后，还包括：根据所述目标飞行路径中巷道的高度，确定所述无人机的飞行高度；基于所述飞行高度，对所述目标飞行...
【专利技术属性】
技术研发人员：高海跃，王保兵，王凯，王丹丹，
申请(专利权)人：北京煤科天玛自动化科技有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。