人工势场法matlab讲解,传统人工势场法(matlab)

【实例简介】

人工势场法路径规划是由Khatib提出的一种虚拟力法(Oussama Khatib，Real-Time obstacle Avoidance for Manipulators and Mobile Robots. Proc of The 1994 IEEE.)。它的基本思想是将机器人在周围环境中的运动，设计成一种抽象的人造引力场中的运动，目标点对移动机器人产生“引力”，障碍物对移动机器人产生“斥力”，最后通过求合力来控制移动机器人的运动。应用势场法规划出来的路径一般是比较平滑并且安全，但是这种方法存在局部最优点问题。

【实例截图】

【核心代码】

%初始化车的参数

Xo=[0 0];%起点位置

k=15;%计算引力需要的增益系数

K=0;%初始化

m=5;%计算斥力的增益系数，都是自己设定的。

Po=2.5;%障碍影响距离，当障碍和车的距离大于这个距离时，斥力为0，即不受该障碍的影响。也是自己设定。

n=7;%障碍个数

a=0.5;

l=0.2;%步长

J=200;%循环迭代次数

%如果不能实现预期目标，可能也与初始的增益系数，Po设置的不合适有关。

%end

%给出障碍和目标信息

Xsum=[10 10;1 1.2;3 2.5;4