xutubiao.m

规则障碍物环境下的机器人路径规划matlab源码！

function P=xutubiao(p,d)
[n1,n3]=size(p);
for i=1:n1
    for j=1:n3
         coordinate=ymadjp1(p(i,j),d);%将p中各序号转换为坐标
         P(i,2*j)=coordinate(1);
         P(i,2*j+1)=coordinate(2);
    end
end