一种基于人工势场法的机器人避碰路径规划方法
【专利摘要】本发明公开了一种基于人工势场法的机器人避碰路径规划方法，步骤包括： 1 、检测目标点：检测地图上有无目标点，如果没有目标点，则程序不会往下走，而是会循环地检测直到检测到目标点为止； 2 、规划路径：一旦检测到有目标点，则计算机器人初始位置与目标点的距离，然后判断其距离是否大于 5.0 ，未达到需要寻址路径规划，程序继续往下走； 3 、控制避障：引进目标牵引力使机器人动起来，并检测周围 600 距离范围内是否存在障碍物，求出各障碍物与机器人之间的距离，并将此距离返回值带入到基于人工势场的算法中从而控制机器人绕过障碍物前行直到最终到达目标点。
【专利说明】一种基于人工势场法的机器人避碰路径规划方法
【技术领域】
[0001] 本发明涉及一种复杂形状机器人避碰路径规划方法，特别是一种基于人工势场法 的机器人避碰路径规划方法。
【背景技术】
[0002] 机器人的避碰路径规划一直以来都是机器人研究领域的难点，也是需要一直深入 研究的问题。鉴于往机器人路径规划中，多数将机器人简化为圆形等简单形状，而为实现机 器人上加装各类辅助设备的需求(例如机械臂、测距仪等)，需针对任意形状的机器人，研究 其在复杂环境下的避碰路径规划问题，为机器人路径规划方法的进一步实用化提供支撑。
[0003] 基于此，本发明提出一种基于线段之间最短距离检测的人工势场法实现了复杂形 状移动机器人在未知环境下的避碰路径规划。目前已经基本上达到比较好的控制效果，从 而使移动机器人能够及时有效地避开障碍物。该方法是以机器人与障碍物的各边界组成线 段之间的最短距离作为其检测距离，并将此距离应用到人工势场法中，作为斥力值的计算 参数。本方法不考虑障碍物的运动状态，将其视为静态物体，从而简化机器人避障的分析， 机器人能够根据最短距离检测所得的距离值判断是否遇到了存在碰撞危险的障碍物，并及 时有效地选择合适的避障方式，使移动机器人在顺利平稳地躲避碰撞的前提下能实现快速 的规划路径。
【发明内容】
[0004] 本发明的一种基于人工势场法的机器人避碰路径规划方法，目的在于提供一种针 对复杂形状移动机器人在未知环境下的避碰路径规划，使得机器人能够根据最短距离检测 所得的距离值判断是否遇到了存在碰撞危险的障碍物，并及时有效地选择合适的避障方 式，使移动机器人在顺利平稳地躲避碰撞的前提下能实现快速的规划路径。
[0005] 本发明的目的是这样实现的： 1、检测目标点，包括以下步骤： 1. 1、仿真程序开始会检测地图上有无目标点，如果没有目标点，则程序不会往下走，而 是会循环地检测直到检测到目标点为止； 1. 2、一旦检测到有目标点，则进入下一步。
[0006]、规划路径，包括以下步骤： 2. 1、计算机器人初始位置与目标点的距离，然后判断其距离是否大于5.0(这个距离是 机器人跟踪目标点的误差距离，可以根据具体参数适当改变）； 2. 2、如果距离是在5.0这个范围内，则可以认为机器人已经到达目标点，不用再去寻 址；若距离超过了这个范围，说明机器人并未到达目标点，此时则需要寻址路径规划，程序 继续执行到下一步。
[0007]、控制避障，包括以下步骤： 3. 1引进目标牵引力使机器人动起来，并检测周围600距离范围内是否存在障碍物； 3. 2如果没有障碍物，则继续前进直到到达目标点；如果有则对各障碍物进行最短距 离检测，求出各障碍物与机器人之间的距离，并将此距离返回值带入到基于人工势场的算 法中从而控制机器人绕过障碍物前行直到最终到达目标点。
[0008] 本发明还可以包括： 1、在仿真过程中每一时刻机器人前进的位置坐标：
【权利要求】
1. 一种基于人工势场法的机器人避碰路径规划方法，其特征在于：包括以下步骤： 1、 检测目标点； 2、 规划路径； 3、 控制避障。
2. 根据权利要求1所述的一种基于人工势场法的机器人避碰路径规划方法，其特征在 于，所述步骤1包括以下步骤： 1. 1、仿真程序开始会检测地图上有无目标点，如果没有目标点，则程序不会往下走，而 是会循环地检测直到检测到目标点为止； 1. 2、一旦检测到有目标点，则进入下一步。
3. 根据权利要求1所述的一种基于人工势场法的机器人避碰路径规划方法，其特征在 于，所述步骤2包括以下步骤： 2. 1、计算机器人初始位置与目标点的距离，然后判断其距离是否大于5.0 ; 2. 2、如果距离是在5.0这个范围内，则可以认为机器人已经到达目标点，不用再去寻 址；若距离超过了这个范围，说明机器人并未到达目标点，此时则需要寻址路径规划，程序 继续执行到下一步。
4. 根据权利要求1所述的一种基于人工势场法的机器人避碰路径规划方法，其特征在 于，所述步骤3包括以下步骤： 3. 1、引进目标牵引力使机器人动起来，并检测周围600距离范围内是否存在障碍物； 3. 2、如果没有障碍物，则继续前进直到到达目标点；如果有则对各障碍物进行最短距 离检测，求出各障碍物与机器人之间的距离，并将此距离返回值带入到基于人工势场的算 法中从而控制机器人绕过障碍物前行直到最终到达目标点。
【文档编号】G05D1/02GK104317291SQ201410467887
【公开日】2015年1月28日 申请日期:2014年9月16日 优先权日:2014年9月16日
【发明者】费浚纯 申请人:哈尔滨恒誉名翔科技有限公司