[发明专利]一种基于激光雷达的路径搜索方法

说明书

一种基于激光雷达的路径搜索方法，设定中心线，中心线的方向从起点指向终点，在该方向上激光雷达搜索障碍物，将扫描到障碍物在中心线两侧的激光雷达反射光线距离突变的点,或将有障碍物和无障碍物的临界点设定为搜索点，选取与中心线距离较近的搜索点作为一级预选点，当搜索点到中心线距离相等时，则任意选取一个搜索点作为一级预选点；激光雷达机器人沿着激光路线到达一级预选点，再按照同样的方法在一级预选点搜索二级预选点；以此类推，每次选取与中心线距离较近的搜索点作为下一级预选点，直到找到目标点；如此，每一级预选点的连线就形成了一条最短路径，同时机器人也沿着这条最优路径到达目标位置。本发明可以节约成本，也更具有实时性。

技术领域

本发明涉及机器人的路径规划技术领域，具体涉及一种基于激光雷达的路径搜索方法。

背景技术

激光雷达是一种工作在从红外到紫外光谱段的雷达系统,其原理和构造与激光测距仪极为相似，因此激光雷达测距功能广泛应用于无人机、AGV等移动机器人上采取环境信息。激光雷达兼具测距远、角度分辨率优、受环境光照影响小的特点，可直接获得物体的距离和方位信息。

移动机器人的路径规划技术可包括环境信息完全已知的全局路径规划和环境信息部分已知的局部路径规划。传统的路径规划方法主要有A^*方法、Dijkstra方法、D方法、人工势场法,基于采样的路径规划方法有PRM方法、RRT方法。特别是人工势场法是较为传统的局部规划方法，根据传感器实时感知周围的障碍物得到与障碍物之间的位置信息，通过人工势场模型得到虚拟力。通过目标点之间的引力和障碍物的斥力共同作用，从而完成规划。因其良好的避障能力和简单的数学表达，则经常被用于移动机器人路径规划中。

然而传统势场也会存在一些固有的缺点，如这些方法在路径规划前都要构建地图，给路径规划增加了复杂性。

发明内容

针对上述的技术问题，本技术方案提供了一种基于激光雷达的路径搜索方法，无需机器人提前构建地图，可以节约成本，也更具有实时性；能有效的解决上述问题。

本发明通过以下技术方案实现：

一种基于激光雷达的路径搜索方法，设定：起点和终点的连线为中心线，中心线的方向从起点指向终点；

步骤一：在中心线的方向上，激光雷达发出激光，搜索中心线的方向是否有障碍物；

步骤二：判定中心线的方向上是否存在障碍物：

a.将没有接收到反射光线的区域视为无障碍物，或者将接收到反射光线的距离比到目标位置距离长的视为无障碍物；进入步骤三；

b.将激光雷达可以接收到反射光线的区域视为有障碍物，或者将接收到反射光线的距离比到目标位置距离短的视为有障碍物；进入步骤四；

步骤三：无障碍物时，机器人沿着中心线到达终点，操作完成；

步骤四：有障碍物时，激光雷达在起点位置，沿着中心线方向选取一级搜索点中的一个搜索点作为一级预选点，激光雷达机器人沿着激光路线到达一级预选点；

步骤五：在一级预选点的位置，激光雷达机器人沿着中心线的方向选取二级预选点，激光雷达机器人沿着激光路线到达二级预选点；

步骤六：到达二级预选点后，在二级预选点的位置选取下一级预选点，以此类推，每次选取与中心线距离较近的搜索点作为下一级预选点，直到找到目标点；

步骤七：每一级预选点的连线形成一条最优路径，同时机器人也沿着这条最优路径到达终点，操作完成。