一种地图路径规划方法技术

技术编号:21395222 阅读:22 留言:0更新日期:2019-06-19 06:02
本发明专利技术公开了一种地图路径规划方法,所述地图路径规划方法通过三维激光传感器采集的三维点云信息,经过八叉树结构表示,将离散的点云数据转换成三维栅格地图,实现三维栅格地图下的最优路径规划,使得机器人可以避开环境中的物体,避免碰撞确保机器人行进中的安全。

A Map Path Planning Method

The invention discloses a map path planning method, which converts discrete point cloud data into three-dimensional raster map through octree structure representation of three-dimensional point cloud information collected by three-dimensional laser sensor, realizes optimal path planning under three-dimensional raster map, enables the robot to avoid objects in open environment, avoids collision and ensures the robot. Safety in progress.

【技术实现步骤摘要】
一种地图路径规划方法
本专利技术涉及路径规划技术,具体涉及基地图路径规划方法。
技术介绍
随着各项性能的提高,服务机器人可以在人们日常生活中完成越来越多的任务,比如打扫卫生、移动物体等等。为了使任务完成得更加流畅,机器人必须实现对指定移动目标的路径规划。路径规划依赖于室内地图,常用的室内地图为二维栅格地图,然而二维栅格地图只考虑了某一高度平面的环境信息,太高或者太低的障碍物都不能避免,因此也不能在复杂环境中使用。
技术实现思路
本专利技术目的在于克服现有技术的不足,尤其解决二维栅格地图只考虑了某一高度平面的环境信息,无法得知周围环境的准确三维结构,不能保证所规划的路径上机器人不与障碍物发生碰撞的问题。为解决上述技术问题,本专利技术提供一种地图路径规划方法,该方法采用三维栅格地图,实现立体的路径规划,所述地图路径规划方法包括:采用激光传感器采集周围环境的点云数据;用八叉树将点云地图转换为栅格地图;根据三维栅格地图进行最优路径规划。该专利技术方案的有益效果在于,通过将离散的点云数据转换成三维栅格地图,实现三维栅格立体地图下的最优路径规划,使得机器人可以避开环境中的物体,避免碰撞确保机器人行进中的安全。附图说明图1是本专利技术的实施例的基于八叉树表示的三维栅格地图路径规划系统示意图。具体实施方式下面结合附图及具体实施例对本专利技术进行更加详细与完整的说明。可以理解的是,此处所描述的具体实施例仅用于解释本专利技术,而非对本专利技术的限定。图1是根据本专利技术的实施例的地图路径规划方法包括:S1、采用激光传感器采集周围环境的点云数据;S2、用八叉树将点云地图转换为栅格地图;S3、根据三维栅格地图进行最优路径规划。具体而言,经过步骤S1对周围环境进行点云数据采集后,已经得到大量的点云数据,需要用八叉树将点云地图转换为栅格地图,步骤S2描述如下:八叉树是一种基于树形结构的层次化数据结构,如果树不是空的,那么八叉树的任何一个节点的都只有八个或者零个子节点。八叉树的每个节点与正方体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:综合之前走过的栅格位置生成从初始位置到达目标栅格的路径。上述为本专利技术较佳的实施方式,但本专利技术的实施方式并不受上述内容的限制,其他的任何未背离本专利技术的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本专利技术的保护范围之内。本文档来自技高网...

【技术保护点】
1.一种地图路径规划方法,其特征在于,包括如下步骤:S1.采用激光传感器采集周围环境的点云数据;S2.用八叉树将点云地图转换为栅格地图;S3.根据三维栅格地图进行最优路径规划。

【技术特征摘要】
1.一种地图路径规划方法,其特征在于,包括如下步骤:S1.采用激光传感器采集周围环境的点...

【专利技术属性】
技术研发人员:覃争鸣周健李康
申请(专利权)人:广州映博智能科技有限公司
类型:发明
国别省市:广东,44

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1