人工势能场路径规划

代码说明：

人工势场法是由Khatib提出的一种虚拟力法。原理是：将机器人在环境中的运动视为一种机器人在虚拟的人工受力场的运动。障碍物对机器人产生斥力，目标点对机器人产生引力，引力和斥力的合力作为机器人的加速力，来控制机器人的运动方向和计算机器人的位置。 引力场（attraction）随机器人与目标点的距离增加而单调递增，且方向指向目标点； 斥力场（repulsion） 在机器人处在障碍物位置时有一极大值，并随机器人与障碍物距离的增大而单调减小，方向指向远离障碍物方向。