[发明专利]一种基于人工势场法的机器人避碰路径规划方法

说明书

技术领域

本发明涉及一种复杂形状机器人避碰路径规划方法，特别是一种基于人工势场法的机器人避碰路径规划方法。

背景技术

机器人的避碰路径规划一直以来都是机器人研究领域的难点，也是需要一直深入研究的问题。鉴于往机器人路径规划中，多数将机器人简化为圆形等简单形状，而为实现机器人上加装各类辅助设备的需求（例如机械臂、测距仪等），需针对任意形状的机器人，研究其在复杂环境下的避碰路径规划问题，为机器人路径规划方法的进一步实用化提供支撑。

基于此，本发明提出一种基于线段之间最短距离检测的人工势场法实现了复杂形状移动机器人在未知环境下的避碰路径规划。目前已经基本上达到比较好的控制效果，从而使移动机器人能够及时有效地避开障碍物。该方法是以机器人与障碍物的各边界组成线段之间的最短距离作为其检测距离，并将此距离应用到人工势场法中，作为斥力值的计算参数。本方法不考虑障碍物的运动状态，将其视为静态物体，从而简化机器人避障的分析，机器人能够根据最短距离检测所得的距离值判断是否遇到了存在碰撞危险的障碍物，并及时有效地选择合适的避障方式，使移动机器人在顺利平稳地躲避碰撞的前提下能实现快速的规划路径。

发明内容

本发明的一种基于人工势场法的机器人避碰路径规划方法，目的在于提供一种针对复杂形状移动机器人在未知环境下的避碰路径规划，使得机器人能够根据最短距离检测所得的距离值判断是否遇到了存在碰撞危险的障碍物，并及时有效地选择合适的避障方式，使移动机器人在顺利平稳地躲避碰撞的前提下能实现快速的规划路径。

本发明的目的是这样实现的：

1、检测目标点，包括以下步骤：

1.1、仿真程序开始会检测地图上有无目标点，如果没有目标点，则程序不会往下走，而是会循环地检测直到检测到目标点为止；

1.2、一旦检测到有目标点，则进入下一步。

、规划路径，包括以下步骤：

2.1、计算机器人初始位置与目标点的距离，然后判断其距离是否大于5.0（这个距离是机器人跟踪目标点的误差距离，可以根据具体参数适当改变）；

2.2、如果距离是在5.0这个范围内，则可以认为机器人已经到达目标点，不用再去寻址；若距离超过了这个范围，说明机器人并未到达目标点，此时则需要寻址路径规划，程序继续执行到下一步。

、控制避障，包括以下步骤：

3.1引进目标牵引力使机器人动起来，并检测周围600距离范围内是否存在障碍物；

3.2如果没有障碍物，则继续前进直到到达目标点；如果有则对各障碍物进行最短距离检测，求出各障碍物与机器人之间的距离，并将此距离返回值带入到基于人工势场的算法中从而控制机器人绕过障碍物前行直到最终到达目标点。

本发明还可以包括：

1、在仿真过程中每一时刻机器人前进的位置坐标：

其中θ`为机器人旋转姿态角的弧度值；dx为机器人相对于地图的X方向单位时间内前进的位移值；dy为机器人相对于地图的Y方向单位时间内前进的位移值；为每次前进的时间间隔。

、移动机器人工势场函数：

斥力势函数: ，其中d为通过线段最短距离检测得到的机器人与障碍物之间的最短距离；d_m为势场作用的最大范围，也是距离检测最大范围；k_r为斥力系数。

引力函数：，其中d为机器人距目标的距离，k_a 为引力系数。

本发明的有益效果：

(1)简化了机器人避障的分析，机器人能够根据最短距离检测所得的距离值判断是否遇到了存在碰撞危险的障碍物，并及时有效地选择合适的的避障方式，使移动机器人在顺利平稳地躲避碰撞的前提下能实现快速的规划路径。

（2）采用人工势场，能够使得机器人在较为简单的环境中，可以规划出一条无碰撞的路径，快速准确地到达目标点，实现简单，代码效率高。

附图说明

图1为本发明的程序流程图；

图2为人工势场受力图。

具体实施方式

下面结合附图举例对本发明做更详细地描述：

实施例1