基于A制造技术

基于A*提取引导点的AGV路径跟踪与避障协调方法，涉及移动机器人导航。提供可实现路径跟踪与障碍避让协调统一的基于A*提取引导点的AGV路径跟踪与避障协调方法。规划安全全局路径，根据环境信息建立初始栅格地图，在初始栅格地图上，通过风险评估函数R(n)对障碍物周围节点的风险等级进行评估，获得新的带有风险区域的安全栅格地图；对规划得到的全局路径上提取关键路径点；路径跟踪与障碍避让的协调，采用基于激光传感器的动态窗口进行避障，并以关键路径点为引导点并实时更新引导点，进行路径跟踪与障碍避让的协调统一。

AGV path tracking and obstacle avoidance coordination method based on A* to extract guidance points

The method of AGV path tracking and obstacle avoidance coordination based on A* extraction guidance point involves mobile robot navigation. A AGV path tracking and obstacle avoidance coordination method based on A* extraction and guidance point is proposed, which can realize path tracking and obstacle avoidance coordination. The global path planning security, according to the environmental information to establish the initial grid map, the initial grid map, the risk assessment function R (n) on the obstacle of nodes around the level of risk assessment, to obtain a new regional security risk with grid map; the global path planning on the extraction of key path points; coordination avoidance path tracking and obstacle, the dynamic window based on laser sensor for obstacle avoidance, and the critical path for real-time update guidance and guide, coordinate unified path tracking and obstacle avoidance.

【技术实现步骤摘要】

本专利技术涉及移动机器人导航，尤其是涉及到一种基于A*提取引导点的AGV路径跟踪与避障协调方法。
技术介绍
AGV(AutomatedGuidedVehicle)是装有自动导引装置，能够沿规定的路径行驶，在车体上具有编程和停车选择装置、安全保护装置以及各种物料移载功能的搬运车辆。其传统的导航方法主要有磁条导引、色带导引、磁钉导引等，仍然简单易行、路径跟踪可靠性好，但均属于固定路径引导方式，灵活性差。新的导航方式，如惯性导航、激光导航等，无需固定路线导引，定位系统具有更高的引导柔性，能够更高效、灵活地完成物料的搬运任务，但是面临着相对复杂的路径规划、路径跟踪与与障碍避让等问题。A*算法是路径规划算法中在静态地图中搜索最短路径最直接有效的方法，然而用传统的A*算法规划出的最优路径常常与障碍物紧挨，AGV路径跟踪时缺少缓冲地带，尤其在拐角区域无法及时避免一些潜在的风险。再者，A*算法生成的路径为无相邻的栅格路径节点组成，各个路径节点之间距离很小，机器人在路径跟踪过程中由于运动节点太多、节点之间距离太短，难以实现平顺的路径跟踪控制。此外，还存在如何兼顾路径跟踪与障碍避让的协调统一问题需要进一步解决。中国专利CN105737838A公开一种AGV路径跟踪方法，包括以下步骤：(a)在AGV的导航装置内建立路径地图，路径地图包括若干路径点，以及由路径点拟合得出的基础路径曲线；(b)AGV的驱动模块驱动AGV沿基础路径曲线行进；(c)AGV内的修正模块提取当前路径点和下一个路径点，根据当前路径点和下一个路径点拟合出实时路径曲线；(d)AGV的定位模块确定AGV的位置，以当前位置确定导航点，以导航点为圆心建立半径为R的跟踪圆，跟踪圆中，沿AGV行进方向±D范围内的圆弧为有效圆弧，所述有效圆弧与实时路径曲线的交点为行进目标点；(e)AGV修正模块导引AGV朝向行进目标点运行。本专利技术提供的路径跟踪方法，AGV行走路径直接朝向行进目标点，运行线路短。
技术实现思路
本专利技术的目的在于针对现有A*全局路径规划中路径与障碍物之间缺少缓冲地带，无法保证AGV机器人安全通行，全局路径节点多、间距小，难以实现AGV机器人的平顺跟踪等问题，提供可实现路径跟踪与障碍避让协调统一的基于A*提取引导点的AGV路径跟踪与避障协调方法。本专利技术包括以下步骤：1)规划安全全局路径根据环境信息建立初始栅格地图，在初始栅格地图上，通过风险评估函数R(n)对障碍物周围节点的风险等级进行评估，获得新的带有风险区域的安全栅格地图；2)对规划得到的全局路径上提取关键路径点；3)路径跟踪与障碍避让的协调，采用基于激光传感器的动态窗口进行避障，并以关键路径点为引导点并实时更新引导点，进行路径跟踪与障碍避让的协调统一。在步骤1)中，所述根据环境信息建立初始栅格地图，在初始栅格地图上，通过风险评估函数R(n)对障碍物周围节点的风险等级进行评估，获得新的带有风险区域的安全栅格地图的具体步骤可为：(1)定义风险评估函数为式中的r表示障碍节点到临近节点的距离，α为风险系数，显然，距离障碍物越近的区域风险等级越高；(2)将初始栅格地图数据转换为图像数据，通过OpenCV中的cvDiate函数以AGV半径进行膨胀处理，再用cvfilter2D函数进行模板操作，初始栅格地图由障碍格和空白格构成，障碍格节点表示确定有障碍物，灰度值为255；空白格表示完全没有障碍物，灰度值为0；在新得到的安全地图上，障碍栅格节点附近会产生一层灰度值介于0～255并逐级递减的风险栅格点；修改A*算法的代价函数为：F(n)＝G(n)+H(n)+R(n)其中，G(n)表示从起点s到当前节点n的实际代价，H(n)表示从当前节点n到终点g的估计代价(采用曼哈顿距离计算)，R(n)表示当前节点的风险评估值。在安全地图上，通过A*算法规划全局路径，具体方法如下：(1)读取起始点s与终点g的坐标值，并且创建两个链表，OPEN表和CLOSED表，将CLOSED表初始化为空表，把起始点s放入OPEN表中。判断OPEN表是否为空表，若为空表则终止程序，若不为空则继续执行；从OPEN表中取出F(n)值最小的节点n作为当前节点，并把n移到CLOSED表中。(2)判断节点n是否是终点g，若是，则已经找到路径，顺次返回依次来自的节点、到达起始节点s，终止算法、得到一个路径；若不是，则继续下一步判断；(3)按照上下左右四个方向扩展节点n，将当前的节点n的子节点设为m，对于每一个当前节点n的子节点计算估计值H(m)，其次计算启发式函数值F(n)＝G(n)+H(n)+R(n)。进一步判断如下：①如果子节点m不在两个链表中，把m点添加到OPEN表中。然后给子节点m一个指向当前节点n的指针；当找到终点g时可以根据这个指针找到每个节点的父节点并以此为根据找回到起始节点s形成路径；②如果节点m已经在OPEN表中，那么比较F(m)的新值和该节点在OPEN表中的旧值；若新的F(m)比较小，表示找到一条更好的路径，则以此新的F(m)值取代子节点m的旧的F(m)的值；修改子节点m的父指针为当前节点n；若子节点m在CLOSED表中，则跳过该节点，继续寻找其他方向的节点；(4)重复以上步骤直到找到终点g或者OPEN表为空为止。在步骤2)中，所述对规划得到的全局路径上提取关键路径点的具体步骤可为：(1)将终点坐标设为第一个关键点，存放于数组中，并且将这个点记为x0；(2)第二个节点设为x1，第三个节点设为x2；(3)判断x2是否是起点s，若是s则结束程序；(4)判断x0，x1和x2是否共线，如果共线则x1和x2沿路径向前移动一格；(5)当x0，x1和x2三点不共线时：①判断由x0到x2连线上是否存在空白格节点，若存在，则x1是关键点，将x1计入关键路径点的数组中，且令x0＝x1，当前的x1和x2依次沿路径向前移动一格，跳到(3)继续执行；②若x0到x2间都是空白节点，x0不动，x1和x2沿路径依次向前移动一格，返回(3)进行判断；(6)找到所有的关键点后，把终点放到关键路径点数组的尾部，则该数组就是完整的最优路径的所有关键路径点。在步骤3)中，所述进行路径跟踪与障碍避让的协调统一的具体步骤可为：(1)AGV机器人从起点出发时，以起点后的第一个关键路径为引导点；(2)使用激光传感器探知周围障碍物信息，若引导点在可通行域内，则直接把引导点作为当前目标点；否则在当前窗口内进行局部路径规划：综合考虑安全性和平稳性，用启发式方法寻找即时子目标；(3)随着运动和窗口的推进，根据局部信息对规划窗口大小进行动态调整，使得局部避障方法有着良好的环境适应性；(4)根据传感器信息和AGV当前位姿，将当前引导点切换到后续的关键路径点上，直到引导点变为终点。在步骤3)第(4)部分中，所述引导点切换的具体方法可为：将提取得到的关键路径点顺序存放在数组中，为集合{p1,p2...pn本文档来自技高网...

【技术保护点】
基于A*提取引导点的AGV路径跟踪与避障协调方法，其特征在于其包括以下步骤：1)规划安全全局路径，根据环境信息建立初始栅格地图，在初始栅格地图上，通过风险评估函数R(n)对障碍物周围节点的风险等级进行评估，获得新的带有风险区域的安全栅格地图；2)对规划得到的全局路径上提取关键路径点；3)路径跟踪与障碍避让的协调，采用基于激光传感器的动态窗口进行避障，并以关键路径点为引导点并实时更新引导点，进行路径跟踪与障碍避让的协调统一。

【技术特征摘要】
1.基于A*提取引导点的AGV路径跟踪与避障协调方法，其特征在于其包括以下步骤：1)规划安全全局路径，根据环境信息建立初始栅格地图，在初始栅格地图上，通过风险评估函数R(n)对障碍物周围节点的风险等级进行评估，获得新的带有风险区域的安全栅格地图；2)对规划得到的全局路径上提取关键路径点；3)路径跟踪与障碍避让的协调，采用基于激光传感器的动态窗口进行避障，并以关键路径点为引导点并实时更新引导点，进行路径跟踪与障碍避让的协调统一。2.如权利要求1所述基于A*提取引导点的AGV路径跟踪与避障协调方法，其特征在于在步骤1)中，所述根据环境信息建立初始栅格地图，在初始栅格地图上，通过风险评估函数R(n)对障碍物周围节点的风险等级进行评估，获得新的带有风险区域的安全栅格地图的具体步骤为：(1)定义风险评估函数为式中的r表示障碍节点到临近节点的距离，α为风险系数，显然，距离障碍物越近的区域风险等级越高；(2)将初始栅格地图数据转换为图像数据，通过OpenCV中的cvDiate函数以AGV半径进行膨胀处理，再用cvfilter2D函数进行模板操作，初始栅格地图由障碍格和空白格构成，障碍格节点表示确定有障碍物，灰度值为255；空白格表示完全没有障碍物，灰度值为0；在新得到的安全地图上，障碍栅格节点附近会产生一层灰度值介于0～255并逐级递减的风险栅格点；修改A*算法的代价函数为：F(n)＝G(n)+H(n)+R(n)其中，G(n)表示从起点s到当前节点n的实际代价，H(n)表示从当前节点n到终点g的估计代价(采用曼哈顿距离计算)，R(n)表示当前节点的风险评估值；在安全地图上，通过A*算法规划全局路径。3.如权利要求1所述基于A*提取引导点的AGV路径跟踪与避障协调方法，其特征在于在步骤1)第(2)部分中，所述通过A*算法规划全局路径的具体方法如下：(2.1)读取起始点s与终点g的坐标值，并且创建两个链表，OPEN表和CLOSED表，将CLOSED表初始化为空表，把起始点s放入OPEN表中；判断OPEN表是否为空表，若为空表则终止程序，若不为空则继续执行；从OPEN表中取出F(n)值最小的节点n作为当前节点，并把n移到CLOSED表中；(2.2)判断节点n是否是终点g，若是，则已经找到路径，顺次返回依次来自的节点、到达起始节点s，终止算法、得到一个路径；若不是，则继续下一步判断；(2.3)按照上下左右四个方向扩展节点n，将当前的节点n的子节点设为m，对于每一个当前节点n的子节点计算估计值H(m)，其次计算启发式函数值F(n)＝G(n...

【专利技术属性】
技术研发人员：仲训昱，王祥，陈映冰，彭侠夫，
申请(专利权)人：厦门大学，
类型：发明
国别省市：福建;35