xtubiao.m

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

function =xtubiao(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