matlab读取八叉树,基于八叉树表示的三维栅格地图路径规划系统及方法技术方案...

【技术实现步骤摘要】

基于八叉树表示的三维栅格地图路径规划系统及方法

本专利技术涉及地图路径规划技术，具体涉及基于八叉树表示的三维栅格地图路径规划系统及方法。

技术介绍

随着各项性能的提高，服务机器人可以在人们日常生活中完成越来越多的任务，比如打扫卫生、移动物体等等。为了使任务完成得更加流畅，机器人必须实现对指定移动目标的路径规划。路径规划依赖于室内地图，常用的室内地图为二维栅格地图，然而二维栅格地图只考虑了某一高度平面的环境信息，太高或者太低的障碍物都不能避免，因此也不能在复杂环境中使用。相比二维栅格地图而言，三维栅格地图能够更加真实和精确地对环境加以描述，处理很多二维图像数据不能解决的问题，适用于包含有各种高度障碍物的复杂室内环境。

技术实现思路

本专利技术目的在于克服现有技术的不足，尤其解决二维栅格地图只考虑了某一高度平面的环境信息，无法得知周围环境的准确三维结构，不能保证所规划的路径上机器人不与障碍物发生碰撞的问题。为解决上述技术问题，本专利技术提供一种基于八叉树表示的三维栅格地图路径规划系统，其中，所述基于八叉树表示的三维栅格地图路径规划系统包括：数据采集模块，用激光传感器收集点云数据；数据表示模块，用八叉树将点云地图转换为栅格地图；路径规划模块，指定机器人的起点位置和终点位置，机器人自动绕开障碍物，选择最优路径。本专利技术还提供一种基于八叉树表示的三维栅格地图路径规划方法，其中，所述基于八叉树表示的三维栅格地图路径规划方法包括：采用激光传感器采集周围环境的点云数据；用八叉树将点云地图转换为栅格地图；根据三维栅格地图进行最优路径规划。进一步地，所述根据三维栅格地图进行最优路径规划操作可使用启发式算法、遗传算法、退火算或其他合适的路径规划方法。该专利技术方案的有益效果在于，通过三维激光传感器采集的三维点云信息，经过八叉树结构表示，将离散的点云数据转换成三维栅格地图，实现三维栅格地图下的最优路径规划，使得机器人可以避开环境中的物体，避免碰撞确保机器人行进中的安全。附图说明图1是本专利技术的实施例的基于八叉树表示的三维栅格地图路径规划系统示意图。图2为本专利技术的实施例的基于八叉树表示的三维栅格地图路径规划方法的流程图。图3为本专利技术的实施例的八叉树数据结构表示三维空间的示意图。图4为本专利技术的实施例的三维栅格地图路径规划的某个实例效果图。具体实施方式下面结合附图及具体实施例对本专利技术进行更加详细与完整的说明。可以理解的是，此处所描述的具体实施例仅用于解释本专利技术，而非对本专利技术的限定。图1是根据本专利技术的实施例的基于八叉树表示的三维栅格地图路径规划系统示意图。参照图1，所述基于八叉树表示的三维栅格地图路径规划系统包括：数据采集模块10，用激光传感器收集点云数据；数据表示模块20，用八叉树将点云地图转换为栅格地图；路径规划模块30，指定机器人的起点位置和终点位置，机器人自动绕开障碍物，选择最优路径。相对应的，本专利技术还提供一种基于八叉树表示的三维栅格地图路径规划方法，具体请参照图2，其是本专利技术的实施例的基于八叉树表示的三维栅格地图路径规划方法的流程图。参照图2，根据本专利技术的实施例的基于八叉树表示的三维栅格地图路径规划方法包括：S1、采用激光传感器采集周围环境的点云数据；S2、用八叉树将点云地图转换为栅格地图；S3、根据三维栅格地图进行最优路径规划。在本实施例中，将点云地图转换为三维栅格地图后，进行最优路径规划，最优路径规划操作可使用启发式算法、遗传算法、退火算或其他合适的路径规划方法。下面以启发式算法为例对本专利技术进行说明。其中启发式算法是一个基于直观或经验构造的算法，在可接受的计算时间和空间下给出待解决组合优化问题的一个可行解。具体而言，经过步骤S1对周围环境进行点云数据采集后，已经得到大量的点云数据，需要用八叉树将点云地图转换为栅格地图，步骤S2描述如下：八叉树是一种基于树形结构的层次化数据结构，如果树不是空的，那么八叉树的任何一个节点的都只有八个或者零个子节点。如图3所示，八叉树的每个节点与正方体C的一个子立方体对应，树根与正方体本身相对应，如果要表示的形体V只有正方体C(V＝C)，那么要表示的形体V的八叉树仅有树根，如果要表示的形体V不仅仅是正方体(V≠C)，则将C等分为八个子立方体，每个子立方体与树根的一个子节点相对应。只要某个子立方体不是完全空白或完全为V所占据，就要被八等分，从而对应的节点也就有了八个子节点。这样的递归判断、分割一直要进行到节点所对应的立方体或是完全空白，或是完全为V占据，步骤S3是最优路径规划操作，对栅格地图内的路径规划需要考虑机器人尺寸大小，旋转动作和停止动作。机器人的尺寸大小可以用来判断是否会与周边物体有碰撞的危险，而机器人运动时则要判断执行旋转动作和停止动作时是否具备足够的空间，同样避免碰撞的危险，考虑到这些因素的路径规划算法流程如下：S31：在八叉树结构的栅格地图内部邻域内遍历可通行栅格；S32：检测S31中得到的栅格位置有没有满足机器人本体尺寸的自由空间，如果有则转至S33，没有的话转至S34；S33：检测S31中得到的栅格位置处是否具有足够机器人执行旋转运动所需的空间，如果没有就放弃当前栅格并回到S31，否则转至S34；S34：检测S31中得到的栅格位置处是否具有足够机器人执行停止动作所需的空间，如果没有的话放弃当前栅格并回到S31，否则转至S35；S35：机器人移动到该栅格位置处，如果该栅格处已经是目标点就转至S36，否则转至S31；S36：综合之前走过的栅格位置生成从初始位置到达目标栅格的路径。图4是三维栅格地图路径规划的某个实例效果图。上述为本专利技术较佳的实施方式，但本专利技术的实施方式并不受上述内容的限制，其他的任何未背离本专利技术的精神实质与原理下所作的改变、修饰、替代、组合、简化，均应为等效的置换方式，都包含在本专利技术的保护范围之内。本文档来自技高网...