一种基于BRRT算法的矿井救援机器人路径规划方法

技术领域

本发明涉及机器人的路径规划技术领域，特别地，涉及一种基于BRRT算法的矿井救援机器人的路径规划方法。

背景技术

我国煤炭资源储量丰富，煤炭开采人员众多，一旦煤炭开采过程中发生安全事故，矿井环境就会变得十分危险甚至危及开采人员生命安全。随着煤矿智能化的应用，越来越多的灾后矿井救援机器人代替救援人员迅速的进入复杂危险的灾后现场，完成环境探测和人员搜索的任务。救援机器人在矿井下崎岖的通道环境中实现路径规划是完成救援任务的关键技术问题。目前利用传统的BRRT算法进行路径规划并没有引入环境信息。在复杂的矿井环境中，救援机器人运动性能较差，传统的BRRT算法规划的路径仍然会产生大量的冗余节点的树。路径与障碍物可能极其接近，不适用于对环境要求较高的复杂矿井下的救援机器人路径规划。因此，如何进一步提高复杂矿井下的救援机器人路径规划效果成为本技术领域亟需解决的问题。

为此，本发明提出一种基于BRRT算法的矿井救援机器人的路径规划方法，为减少随机搜索树冗余路径，平滑其路径转折点，从而能够更好的提高路径质量。同时也为复杂环境下的路径规划提供了一种新思路。

发明内容

本发明的目的在于提供一种基于BRRT算法的矿井救援机器人的路径规划方法，用于矿井救援机器人的路径规划，可以进一步提高复杂环境下路径规划的质量。

为了达成上述目的，本发明的解决方案是：

基于BRRT算法的矿井救援机器人的路径规划方法，包括以下步骤(1)～(4)：

1、一种基于BRRT算法的矿井救援机器人的路径规划方法，包括以下步骤：

(1)采用型号为ZX2-LDA11 2M的激光传感器采集灾后矿井环境的障碍物信息，然后将采集到的障碍物信息数据存储在激光传感器的控制器当中，对控制器存储的信息在MATLAB平台下用rectangle()函数来搭建灾后矿井下的环境地图；

(2)利用APF-BRRT算法产生一条双向随机搜索树节点更少的初步路径route1，APF-BRRT算法是BRRT算法与APF的结合，具体步骤为：利用双向快速探索随机树 (the Bi-directional Rapidly exploring Random Tree，BRRT)的路径规划算法，在步骤(1) 搭建的环境地图中产生一条双向随机搜索树，然后通过双向随机搜索树节点的扩展进行路径搜索，将双向随机搜索树记为T

(3)利用A*算法从步骤(1)中所建环境地图的起点和目标点同时开始沿着步骤(2)产生的route1进行碰撞检测，基于检测结果删除route1中冗余节点，基于删除后的剩余节点将步骤(2)APF-BRRT算法中产生的route1调整为最短路径route2；

(4)将步骤(3)中得出的最短路径route2离散为散点图，散点坐标为(x

2、如权利要求1所述一种基于BRRT算法的矿井救援机器人路径规划方法，所述步骤(1)中所述的构建BRRT目标引力函数H

其中，k为引力调节因子，ε为步长，Q

3、如权利要求1所述一种基于BRRT算法的矿井救援机器人路径规划方法，所述步骤(4)中所述的选择”最佳”曲线

附图说明

图1为一种基于BRRT算法的矿井救援机器人的路径规划方法流程图。

具体实施方式

下面结合附图对本发明的技术方案进行进一步说明：

本发明提供一种基于BRRT算法的矿井救援机器人的路径规划方法，其总体思路为：

首先采用激光传感器采集灾后矿井环境的障碍物信息，根据障碍物信息在MATLAB平台下用rectangle()函数来搭建灾后矿井下的环境地图；然后利用APF- BRRT算法产生一条双向随机搜索树节点更少的初步路径route1；利用A*算法在环境地图的起点和目标点同时开始对route1进行碰撞检测，基于检测结果删除route1中冗余节点，将APF-BRRT算法中产生的route1调整为最短路径route2；将最短路径route2 离散为散点图，基于各散点，利用最小二乘法，根据偏差的平方和最小的条件来拟合“最佳”曲线

如图1所示，本发明的一种基于BRRT算法的矿井救援机器人的路径规划方法，具体实施包括以下步骤(1)～(4)：

(1)采用型号为ZX2-LDA11 2M的激光传感器采集灾后矿井环境的障碍物信息，然后将采集到的障碍物信息数据存储在激光传感器的控制器当中，对控制器存储的信息在MATLAB平台下用rectangle()函数来搭建灾后矿井下的环境地图；

(2)利用APF-BRRT算法产生一条双向随机搜索树节点更少的初步路径route1，APF-BRRT算法是BRRT算法与APF的结合，具体步骤为：利用双向快速探索随机树(the Bi-directional Rapidly exploring Random Tree，BRRT)的路径规划算法，在步骤(1) 搭建的环境地图中产生一条双向随机搜索树，然后通过双向随机搜索树节点的扩展进行路径搜索，将双向随机搜索树记为T

(3)利用A*算法从步骤(1)中所建环境地图的起点和目标点同时开始沿着步骤(2)产生的route1进行碰撞检测，基于检测结果删除route1中冗余节点，基于删除后的剩余节点将步骤(2)APF-BRRT算法中产生的route1调整为最短路径route2；

(4)将步骤(3)中得出的最短路径route2离散为散点图，散点坐标为(x

以上实施例仅为说明本发明的技术思想，不能以此限定本发明的保护范围，凡是按照本发明提出的技术思想，在技术方案基础上所做的任何改动，均落入本发明保护范围之内。