ymadjp1.m

来自「规则障碍物环境下的机器人路径规划matlab源码！」· M 代码 · 共 13 行

function coordinate=ymadjp1(num,d)%序号转换成坐标
if num==0
    coordinate=[0,0];
else
    a0=mod(num-1,d);
   
%     if a0==0
%         a0=a0+d;
%     end 
    b0=fix((num-1)/d);
    coordinate(1)=a0+1;
    coordinate(2)=b0+1;
end