clear all; close all; clc %function m=Map; %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% % Start @ location (12,12). Apply controls to reach (0,0) % %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% xw=-14; xe=14; ys=-14; yn=14; %map dimensions, west, east, south, north mrx=0.05; mry=0.05; % map resolution {x,y} [xm ym]=meshgrid(xw:mrx:xe,ys:mry:yn); m=0*xm.*ym; % initialize the map m for i=1:size(xm,2) for j=1:size(ym,1) r=sqrt(xm(1,i)^2+ym(j,1)^2); ang=atan2(ym(j,1),xm(1,i))+pi; if 10<=r && r<=11 && ((0.1*pi/2<=ang && ang<=0.9*pi/2) || (1.1*pi/2<=ang && ang<=0.95*2*pi)) m(j,i)=1; elseif 6<=r && r<=7 && ~(0.9*5*pi/4<=ang && ang<=1.1*5*pi/4) m(j,i)=1; elseif 3<=r && r<=4 && (pi/2<=ang && ang<=2*pi) m(j,i)=1; elseif xm(1,i)<0.98*xw || 0.98*xe