机器人路径规划 壁障

%障碍和目标，起始位置都已知的路径规划,意图实现从起点可以规划出一条避开障碍到达目标的路径。 %初始化车的参数 clear; Xo=[0 0];%起点位置 k=5;%计算引力需要的增益系数 m=2;%计算斥力的增益系数，都是自己设定的。 Po=5;%障碍影响距离，当障碍和车的距离大于这个距离时，斥力为0，即不受该障碍的影响。也是自己设定。 n=7;%障碍个数 l=0.25;%步长 J=300;%循环迭代次数