已知某小区的道路如下面的图形所示图5 小区道路示意图现要安排一台清扫机械车辆从交叉点P点出发将所有道路清扫一遍请安排最优的清扫道路并使用动态曲线表示清扫路线。道路的数据和动态曲线的显示方法如下面的两个程序所示。x2=250;x3=50;x4=1251;x5=3751;t=linspace02pi;x=cost;y=sint;plotxyx+x21y+x22…x+x31y+x32x+x41…y+x4

% pr_qmks4_zhyy2.m % 小区道路清扫机械车辆最优路径规划 % 作者：XXX，时间：20XX年XX月XX日 % 定义道路交叉点坐标 x1=[0,0];x2=[2.5,0];x3=[5,0];x6=[10,0]; x4=[1.25,1];x5=[3.75,1]; % 绘制道路示意图 t=linspace(0,2pi); x=cos(t);y=sin(t); plot(x,y,x+x2(1),y+x2(2),x+x3(1),y+x3(2),x+x6(1),y+x6(2),x+x4(1),y+x4(2),x+x5(1),y+x5(2)) hold on % 定义清扫路径起点和终点 start=[2.5,1];endp=[7.5,1]; % 计算最优路径 path=[start]; while ~isequal(path(end,:),endp) dist=zeros(1,size(x1,1)); for i=1:size(x1,1) if ~ismember(x1(i,:),path,'rows') dist(i)=norm(x1(i,:)-path(end,:)); end end [~,idx]=min(dist); path=[path;x1(idx,:)]; end % 绘制最优路径动态曲线 x=path(:,1);y=path(:,2); for i=1:numel(x) plot(x(1:i),y(1:i),'r') axis([min(x)(11/10),max(x)(11/10),min(y)(11/10),max(y)*(11/10)]) % 设置坐标轴的范围 hold on pause(0.1) end % 显示清扫路径 plot(path(:,1),path(:,2),'b','LineWidth',2) hold of