一种基于动态环境的路径规划方法技术

本发明专利技术提出一种基于动态环境的路径规划方法，能够对环境进行构造基于动态局部通道三角网格的导航网格，并能够针对不同Agents在动态环境发生变化前后进行搜索路径选择和碰撞规避方法的研究。包括以下步骤：步骤一、对动态环境构造实现局部通道三角网格Local Clearance Triangulation(LCT)；步骤二、保持原有的局部通道三角网格中对通道宽度Clearance值的要求，构建动态局部通道三角网格Dynamic Local Clearance Triangulation(DLCT)；步骤三、将AD*算法作为启发式动态路径规划方法，通过建立新的数据结构使得动态搜索算法能在动态环境中实时获取地图信息进行规划路径。

【技术实现步骤摘要】

本专利技术涉及计算机仿真学及动画学，尤其涉及在动态环境中模拟现实中的人行为模型的路径规划方法，属于计算机应用领域。技术背景动态环境中的路径规划问题是在计算机动画领域中人群导航的重要课题之一，在模拟现实生活中的人行为模型、场景布局等方面有着重要应用。因此对于这些应用来说，找到合适的、优化的而且适用于各种额外条件如动态环境、大规模人群、任意宽度路径等成为路径规划算法的研究方向。动态环境中的路径规划过程中会发生路径方向改变、个体群体碰撞等问题。针对这些问题，在一些算法如弹性线路图、多群体导航图中已提出相对应的解决办法，然而这些算法只是针对多群体的导航而没有具体的动态地图中的路径解决方案。在路径规划中基于传统三角网格的算法，无法直接从三角网格中求出一条从源点到目标点并且带有最小间隙值的路径。然而加利福尼亚大学MarceloKallmann提出的局部通道三角网格即LocalClearanceTriangulation(LCT三角网格)划分中，赋予三角形网格中每条有向边一个LocalClearance值，该值可以保证精确和有效的计算出从源点到目标点具有最小间隙值的最优路径。
技术实现思路
本专利技术提出一种基于动态环境的路径规划方法，能够对环境进行构造基于动态局部通道三角网格的导航网格，并能够针对不同Agents在动态环境发生变化前后进行搜索路径选择和碰撞规避方法的研究。本专利技术的一种基于动态环境的路径规划方法，包括以下步骤：步骤一、对动态环境构造实现局部通道三角网格LocalClearanceTriangulation(LCT)；步骤二、保持原有的局部通道三角网格中对通道宽度Clearance值的要求，构建动态局部通道三角网格DynamicLocalClearanceTriangulation(DLCT)；步骤三、将AD*算法作为启发式动态路径规划方法，通过建立新的数据结构使得动态搜索算法能在动态环境中实时获取地图信息进行规划路径。进一步地，所述的新的数据结构包括：Map_Node中存储了动态网格中障碍物发生变化后节点的构建网格信息；Agent_Node中记录了当移动个体在寻路过程所扩展的三角网格边；Open_Node中记录了用来计算最优路径而在节点中存放的信息。进一步地，所述的AD*算法的执行步骤如下：步骤3.1、程序初始化；构建OPEN、CLOSED和INCONS表，并将该三个表清空，膨胀因子初始值；其中OPEN表保存所有已生成而未考察的节点，CLOSED表中记录已访问过的节点，INCONS表存储在OPEN表中已扩展过需要再次扩展的节点；膨胀因子e通过在搜索过程中递减来找到最优路径；步骤3.2、计算最短路径：计算最短路径的过程中节点的扩展顺序为从目标点goal到起始点start进行扩展，寻找出从源点到目标点的最短路径；步骤3.3、个体从起始点start开始沿路径向目标点goal前进；步骤3.4、在扩展过程中，通过将个体的宽度和通道宽度Clearance值进行对比，将已扩展过的节点存储在INCONS表中，并不断减小膨胀因子e的值；步骤3.5、判断前进过程中网格代价值是否发生变化，如果发生变化，则以当前节点为新的起始点，并减小膨胀因子e的值；步骤3.6、在下一次扩展过程中，在对比个体的宽度和通道宽度Clearance值的基础上，用启发函数扩展OPEN表中剩余的点之前，把上一轮INCONS表中的点插入OPEN表中，在原来OPEN表的基础上修改所有与变化节点相关的最小代价值g、继承最小代价值rhs、节点值key的值，清空CLOSE表；步骤3.7、从新的start点为起始点，goal为目标点，返回步骤3.3直至到达目标点。进一步地，所述的构建动态局部通道三角网格具体包括以下步骤：步骤2.1、获取三角网格在发生变化后的地图信息；步骤2.2、获取地图中障碍物变化信息；步骤2.3、地图网格中障碍物节点信息发生改变时，若有新节点加入，则添加后更新相邻接点；若有节点删除，则删除后更新相邻节点信息；步骤2.4、反复执行步骤2.3直至所有的更新信息都处理完毕；步骤2.5、更新地图中三角网格节点信息。本专利技术的有益效果：对动态环境构造实现局部通道三角网格，保持原有的局部通道三角网格中对通道宽度Clearance值的要求，构建动态局部通道三角网格；通过建立新的数据结构改进AD*算法，并将其作为启发式动态路径规划方法，使其能在动态环境中实时获取地图信息进行规划路径。附图说明图1为本专利技术基于动态环境的路径规划方法的流程图。具体实施方式下面结合附图举例对本专利技术作进一步说明。具体步骤如下：1)获取地图网格中的41506个障碍物顶点信息，根据Delaunay三角剖分原理对地图划分得到基于约束的三角网格即ConstrainedDelaunayTriangulation(CDT三角网格)。3)在CDT三角网的顶点集合T中遍历圆弧查找干扰点，将存在干扰点的圆弧插入链表中。4)遍历完成后，对链表中干扰点进行重新划分得到(CDT函数为将顶点集合S转化为基于约束的三角网格的顶点集合T)。5)重复进行(4)直到链表中所有干扰点消除，且有成立，构造实现局部通道三角网格。6)让每两个Agents在同一条路径上反向移动。7)获取三角网格在发生变化后的地图信息和地图中障碍物变化信息。8)地图网格中障碍物节点信息发生改变时，若有新节点加入，则添加后更新相邻接点；若有节点消失，则删除后更新相邻接点信息。9)在Agent移动过程中，当碰撞即将发生时，每个Agent都把对面个体视为动态障碍物，反复执行过程(8)直至所有的更新信息都处理完毕。10)更新地图中三角网格节点信息，从而绕过之后继续前行，在避免了碰撞发生的同时沿院方向到达目的地。本文档来自技高网...

【技术保护点】
一种基于动态环境的路径规划方法，其特征在于，包括以下步骤：步骤一、对动态环境构造实现局部通道三角网格Local Clearance Triangulation(LCT)；步骤二、保持原有的局部通道三角网格中对通道宽度Clearance值的要求，构建动态局部通道三角网格Dynamic Local Clearance Triangulation(DLCT)；步骤三、将AD*算法作为启发式动态路径规划方法，通过建立新的数据结构使得动态搜索算法能在动态环境中实时获取地图信息进行规划路径。

【技术特征摘要】
1.一种基于动态环境的路径规划方法，其特征在于，包括以下步骤：
步骤一、对动态环境构造实现局部通道三角网格LocalClearance
Triangulation(LCT)；
步骤二、保持原有的局部通道三角网格中对通道宽度Clearance值的要求，
构建动态局部通道三角网格DynamicLocalClearanceTriangulation(DLCT)；
步骤三、将AD*算法作为启发式动态路径规划方法，通过建立新的数据结
构使得动态搜索算法能在动态环境中实时获取地图信息进行规划路径。
2.如权利要求1所述的一种基于动态环境的路径规划方法，其特征在于，
进一步地，所述的新的数据结构包括：Map_Node中存储了动态网格中障碍物发
生变化后节点的构建网格信息；Agent_Node中记录了当移动个体在寻路过程所
扩展的三角网格边；Open_Node中记录了用来计算最优路径而在节点中存放的
信息。
3.如权利要求1或2所述的一种基于动态环境的路径规划方法，其特征在
于，进一步地，所述的AD*算法的执行步骤如下：
步骤3.1、程序初始化；构建OPEN、CLOSED和INCONS表，并将该三个
表清空，膨胀因子初始值；其中OPEN表保存所有已生成而未考察的节点，
CLOSED表中记录已访问过的节点，INCONS表存储在OPEN表中已扩展过需
要再次扩展的节点；膨胀因子e通过在搜索过程中递减来找到最优路径；
步骤3.2、计算最短路径：计算最短路径的过程中节点的扩展顺序为从目标<...

【专利技术属性】
技术研发人员：黄天羽，王磊，裴高军，权子曦，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京;11