基于改进人工势场法的割草机器人实时避障方法技术

本发明专利技术公开了一种基于改进人工势场法的割草机器人避障方法，包括下述步骤：S1、设定割草机器人起点和目标点的位置，同时设定引力势场增益系数和斥力势场增益系数，建立割草机器人周围环境模型；S2、对引力势场函数进行改进；S3、对斥力势场函数进行改进，S5、计算割草机器人所受引力和各个斥力的大小和方向，计算引力和斥力在水平方向和竖直方向上的分量，并求出割草机器人所受的总的势场力大小和方向；S6、割草机器人在改进人工势场法的总势场力的作用下向目标点移动，并更新割草机器人坐标得到割草机器人的规划路径。本发明专利技术使得割草机器人能够安全、平稳和高效运行，提高了改进的避障方法的实用性。

Real time obstacle avoidance method of mowing robot based on improved artificial potential field method

The invention discloses an obstacle avoidance method for a mowing robot based on the improved artificial potential field method, which comprises the following steps: S1. Setting the starting point and target point of the mowing robot, setting the gain coefficient of the gravitational potential field and the gain coefficient of the repulsive potential field, and establishing the surrounding environment model of the mowing robot; S2. Improving the gravitational potential field function; S3. Improving the repulsive potential field function S5. Calculate the magnitude and direction of the gravity and repulsion force of the mowing robot, calculate the components of the gravity and repulsion force in the horizontal and vertical directions, and calculate the magnitude and direction of the total potential field force of the mowing robot; S6. The mowing robot moves to the target point under the effect of the total potential field force of the improved artificial potential field method, and update the coordinates of the mowing robot to get the mowing machine Human planning path. The invention enables the mowing robot to operate safely, stably and efficiently, and improves the practicability of the improved obstacle avoidance method.

【技术实现步骤摘要】
基于改进人工势场法的割草机器人实时避障方法
本专利技术属割草机器人的
，具体涉及一种基于改进人工势场法的割草机器人实时避障方法。
技术介绍
人工势场法是目前常见的机器人局部路径规划方法之一，其基本思想是通过传感器感知出环境中机器人、障碍物、目标点的位置，障碍物对机器人产生斥力势场，目标点产生引力势场，机器人在引力势场和斥力势场两者产生的复合势场中，搜索总势场下降的路线作为机器人避撞的最优路径。该方法具有结构简单，实时性强，规划路径高效平滑和易于实现底层实时控制等优点，在机器人避障系统的路径规划中得到了广泛的应用。但是经典人工势场法和改进人工势场法仍存在一些问题和不足：障碍物附近目标不可达、在障碍物附近容易产生振荡和机器人易陷入局部极小点等。通过查阅大量文献资料，针对目标点不可达问题大都采用考虑机器人与目标点之间的欧几里得距离，将其作为距离调节因子对斥力函数进行改进，解决了经典人工势场法目标点周围存在障碍物时，目标不可达的问题。但是，这种形式的斥力势场在保证目标点全局最小的情况下，导致机器人不在目标点附近时，极大的扭曲了斥力势场的形状，使得整个路径规划质量变差，进而使得改进的算法实用性变差，影响机器人的工作效率。
技术实现思路
本专利技术是基于经典人工势场法和改进人工势场法的问题和不足，提出一种基于改进人工势场法的割草机器人实时避障方法，不仅解决了机器人在障碍物附近目标不可达、在障碍物附近容易产生振荡和机器人易陷入局部极小值问题，而且使得整个路径规划质量更优，提高了机器人的运行效率，使得改进的算法更具有实用性和高效性。为了达到上述目的，本专利技术采用以下技术方案：本专利技术提供了一种基于改进人工势场法的割草机器人避障方法，包括下述步骤：S1、对割草机器人周围进行环境进行感知，实时反馈周围障碍物的距离和角度信息以及机器人自身的位姿信息，建立割草机器人周围环境模型，所述周围环境模型为各个障碍物和目标点相对于割草机器人的位置分布，同时设定引力势场增益系数和斥力势场增益系数；S2、对引力势场函数进行改进，具体为：由目标点生成的引力势场函数，其经典函数形式为式中：ρ(X,Xg)为X和Xg两个位置之间的欧几里得距离，X为割草机器人当前位置，Xg为目标位置，k为大于0的引力势场系数；当割草机器人与目标点之间的距离很大时，斥力在割草机器人运动控制中几乎不起作用，很容易导致割草机器人与障碍物发生碰撞；故通过增加一个由实际环境决定的范围值d来修改引力势场函数Utatt(X)，避免机器人与障碍物发生碰撞；当机器人与目标点之间的距离小于d时，引力势场函数形式采用当机器人与目标点之间的距离大于d时，引力势场函数形式采用由此根据实际环境将引力势场分成以上连续的两段，可以很好地解决发生碰撞的问题，并且能够降低引力势场形状的畸变，则改进后引力势场函数具体形式为：式中：k为引力增益系数，d为环境决定的常数，X(x,y)为割草机器人当前位置，ρ(X,Xg)为割草机器人与目标点之间的欧几里得距离，ρo障碍物的影响半径；S3、对斥力势场函数进行改进，具体为：添加旋转力的改进斥力势场函数，具体形式为：式中：η为斥力势场增益系数，ρ(X,Xo)为机器人当前位置X和障碍物位置Xo之间的欧几里得距离，ρo为障碍物的影响范围，m为调节因子的指数；这种形式的斥力势场在保证目标点全局最小的情况下，导致机器人不在目标点附近时，极大的扭曲了斥力势场的形状，且仍存在机器人陷入局部极小值的问题；为此，引入考虑割草机器人本体半径的调节因子改进斥力势场函数，使得机器人不在目标点附近时，最小化扭曲障碍物势场，同时保证机器人在目标点在目标点取全局最小，则改进斥力势场函数具体形式为：式中：η为斥力增益系数，ρo障碍物的影响半径，R为机器人半径，Xo(xo,yo)为障碍物位置，Xg(xg,yg)为目标点位置，ρ(X,Xo)为机器人当前位置X和障碍物位置Xo之间的欧几里得距离，ρ(X,Xg)为机器人与目标点之间的欧几里得距离；S4、基于改进的引力势场函数和改进的斥力势场函数，得到割草机器人所受的引力和斥力以及总势场函数和总势场力函数，具体为：改进后的人工势场法的总势场函数为改进后的引力势场函数和斥力势场函数之和；若割草机器人周围存在多个障碍物时，则总的势场函数等于引力势场函数与各斥力势场函数之和；割草机器人所受引力等于引力势场函数的负梯度及其所受斥力等于斥力势场函数的负梯度；改进后的人工势场法的总势场力函数等于所得到的总的势场函数的负梯度；S5、计算割草机器人所受引力和斥力在水平方向和竖直方向上的分量，并求出割草机器人所受的总的势场力与水平方向的夹角θ，所述夹角θ为割草机器人的航向角；机器人所受势场力水平方向上的分量为在竖直方向上的分量为则割草机器人所受的总的势场力与水平方向的夹角为式中：θ为割草机器人的航向角，Fattx(X)、Fatty(X)分别为机器人所受引力在水平方向和竖直方向上的分量，Frepxi(X)、Frepyi(X)(i＝1,2,L,n)分别为机器人所受斥力在水平方向和竖直方向上的分量，Ftotalx(X)、Ftotaly(X)分别为机器人所受势场力水平方向和竖直方向上的分量；S6、割草机器人在改进人工势场法的总势场力的作用下向目标点移动，并更新割草机器人坐标，当割草机器人未到达目标点时，则在合力作用下继续运行；当割草机器人到达目标点时，则停止运行，由此，得到割草机器人的规划路径。作为优选的技术方案，在步骤S1中，由搭载在割草机器人上的激光雷达和GPS/IMU对割草机器人周围进行环境感知，实时反馈周围障碍物的距离和角度信息以及机器人自身的位姿信息，为割草机器人提供环境信息进行路径规划，从而实现机器人的实时避障。作为优选的技术方案，步骤S2中，由于引力函数等于引力势场函数的负梯度，则改进后的引力函数的具体形式如下：式中：k为引力增益系数，d为环境决定的常数，X(x,y)为机器人当前位置，ρ(X,Xg)为机器人与目标点之间的距离，ρo为障碍物的影响半径。作为优选的技术方案，步骤S3中，与引力函数定义相同，斥力函数等于斥力势场函数的负梯度，则斥力函数具体形式如下：式中：作为优选的技术方案，步骤S4中，所述割草机器人所受的总势场函数和势场力，具体为：改进后的人工势场法的总势场函数为改进后的人工势场法的总势场力函数为式中：n为障碍物的数量。作为优选的技术方案，还包括下述步骤：设定割草机器人的移动步长l，更新机器人坐标：式中：x(k+1)为割草机器人在k+1时刻的水平方向的坐标，x(k)为机器人在k时刻的水平方向的坐标，y(k+1)为机器人在k+1时刻的竖直方向的坐标，y(k)为机器人在k时刻的竖直方向的坐标，l为机器人的移动步长，θ为割草机器人所受本文档来自技高网...

【技术保护点】
1.基于改进人工势场法的割草机器人避障方法，其特征在于，包括下述步骤：/nS1、对割草机器人周围进行环境进行感知，实时反馈周围障碍物的距离和角度信息以及机器人自身的位姿信息，建立割草机器人周围环境模型，所述周围环境模型为各个障碍物和目标点相对于割草机器人的位置分布，同时设定引力势场增益系数和斥力势场增益系数；/nS2、对引力势场函数进行改进，具体为：/n由目标点生成的引力势场函数，其经典函数形式为/n

【技术特征摘要】
1.基于改进人工势场法的割草机器人避障方法，其特征在于，包括下述步骤：
S1、对割草机器人周围进行环境进行感知，实时反馈周围障碍物的距离和角度信息以及机器人自身的位姿信息，建立割草机器人周围环境模型，所述周围环境模型为各个障碍物和目标点相对于割草机器人的位置分布，同时设定引力势场增益系数和斥力势场增益系数；
S2、对引力势场函数进行改进，具体为：
由目标点生成的引力势场函数，其经典函数形式为



式中：ρ(X,Xg)为X和Xg两个位置之间的欧几里得距离，X为割草机器人当前位置，Xg为目标位置，k为大于0的引力势场系数；
当割草机器人与目标点之间的距离很大时，斥力在割草机器人运动控制中几乎不起作用，很容易导致割草机器人与障碍物发生碰撞；故通过增加一个由实际环境决定的范围值d来修改引力势场函数Utatt(X)，避免机器人与障碍物发生碰撞；当机器人与目标点之间的距离小于d时，引力势场函数形式采用当机器人与目标点之间的距离大于d时，引力势场函数形式采用由此根据实际环境将引力势场分成以上连续的两段，可以很好地解决发生碰撞的问题，并且能够降低引力势场形状的畸变，则改进后引力势场函数具体形式为：



式中：k为引力增益系数，d为环境决定的常数，X(x,y)为割草机器人当前位置，ρ(X,Xg)为割草机器人与目标点之间的欧几里得距离，ρo障碍物的影响半径；
S3、对斥力势场函数进行改进，具体为：
添加旋转力的改进斥力势场函数，具体形式为：



式中：η为斥力势场增益系数，ρ(X,Xo)为机器人当前位置X和障碍物位置Xo之间的欧几里得距离，ρo为障碍物的影响范围，m为调节因子的指数；
这种形式的斥力势场在保证目标点全局最小的情况下，导致机器人不在目标点附近时，极大的扭曲了斥力势场的形状，且仍存在机器人陷入局部极小值的问题；
为此，引入考虑割草机器人本体半径的调节因子改进斥力势场函数，使得机器人不在目标点附近时，最小化扭曲障碍物势场，同时保证机器人在目标点在目标点取全局最小，则改进斥力势场函数具体形式为：



式中：η为斥力增益系数，ρo障碍物的影响半径，R为机器人半径，Xo(xo,yo)为障碍物位置，Xg(xg,yg)为目标点位置，ρ(X,Xo)为机器人当前位置X和障碍物位置Xo之间的欧几里得距离，ρ(X,Xg)为机器人与目标点之间的欧几里得距离；
S4、基于改进的引力势场函数和改进的斥力势场函数，得到割草机器人所受的引力和斥力以及总势场函数和总势场力函数，具体为：
改进后的人工势场法的总势场函数为改进后的引力势场函数和斥力势场函数之和；若割草机器人周围存在多个障碍物时，则总的势场函数等于引力势场函数与各斥力势场函数之和；割草机器人所受引力等于引力势场函数的负梯度及其所受斥力等于斥力势场函数的负梯度；改进后的人工势场法的总势场力函数等于所得到的总的势场函数的...

【专利技术属性】
技术研发人员：李君，李振伟，陆华忠，袁谋青，谢逢博，卢忠岳，
申请(专利权)人：华南农业大学，
类型：发明
国别省市：广东;44