节约里程法matlab

clearclcA=[015510520;0303020510;08516226140110];rong=300;m=6;c=zeros(6,6);fori=1:mforj=1:mc(i,j)=sqrt((A(1,i)-A(1,j))^2+(A(2,i)-A(2,j))^2);endendp=zeros(6,6);fori=2:(m-1)forj=(i+1):mp(i,j)=c(1,i)+c(1,j)-c(i,j);endends=p(:);[hs,wz]=sort(s,1,'descend');fori=1:(m^2)[x,y]=ind2sub(size(p),wz(i));ifA(3,x)+A(3,y)=rongsolut=[x,y];n(1)=2;zhuang(1)=A(3,x)+A(3,y);ii=i;breakelsecontinueendendforrr=(ii+1):(m^2)[x,y]=ind2sub(size(p),wz(rr))ifhs(rr)==0breakend[xa,ya]=find(x==solut)[xb,yb]=find(y==solut)[sa,sb]=size(solut)ifisempty(xa)==0&&isempty(xb)==0ifxa==xbcontinueendifn(xa)~=2if1yan(xa)continueendendifn(xb)~=2if1ybn(xb)continueendendzh1=zhuang(xa)zh2=zhuang(xb)ifzhuang(xa)+zhuang(xb)=rongifya==1&&yb==1newm=[solut(xb,n(xb):-1:1)solut(xa,1:n(xa))]elseifya==1&&yb==n(xb)newm=[solut(xb,1:n(xb))solut(xa,1:n(xa))]elseifya==n(xa)&&yb==1newm=[solut(xa,1:n(xa))solut(xb,1:n(xb))]elseifya==n(xa)&&yb==n(xb)newm=[solut(xa,1:n(xa))solut(xb,n(xb):-1:1)]endsolut(xa,:)=[]solut(xb,:)=[]n(xa)=[]n(xb)=[]zhuang(xa)=[]zhuang(xb)=[][qa,qb]=size(solut)solut((qa+1),1:length(newm))=newmn(qa+1)=length(newm)zhuang(qa+1)=zh1+zh2elsecontinueendelseifisempty(xa)==0ifn(xa)~=2if1yan(xa)continueendendzh3=zhuang(xa)+A(3,y)ifzhuang(xa)+A(3,y)=rongifya==1newm=[ysolut(xa,1:n(xa))]elseifya==n(xa)newm=[solut(xa,1:n(xa))y]endsolut(xa,:)=[]n(xa)=[]zhuang(xa)=[][qa,qb]=size(solut)solut((qa+1),1:length(newm))=newmn(qa+1)=length(newm)zhuang(qa+1)=zh3endelseifisempty(xb)==0ifn(xb)~=2if1ybn(xb)continueendendzh4=zhuang(xb)+A(3,x)ifzhuang(xb)+A(3,x)=rongifyb==1newm=[xsolut(xb,1:n(xb))]elseifyb==n(xb)newm=[solut(xb,1:n(xb))x]endsolut(xb,:)=[]n(xb)=[]zhuang(xb)=[][qa,qb]=size(solut)solut((qa+1),1:length(newm))=newmn(qa+1)=length(newm)zhuang(qa+1)=zh4endelsezh5=A(3,x)+A(3,y)ifzh5=rongnewm=[xy][qa,qb]=size(solut)solut((qa+1),1:length(newm))=newmn(qa+1)=length(newm)zhuang(qa+1)=zh5endendendifsum(n)(m-1)fori=2:m[qqqa,qqqb]=size(solut)kk=find(i==solut)ifisempty(kk)solut(qqqa+1,1)=in(qqqa+1)=1zhuang(qqqa+1)=A(3,i)endendend[op,ok]=size(solut)fori=1:opsolut(i,n(i)+1)=1endsolut=[ones(op,1)solut]opt=0;fori=1:opforj=2:(n(i)+2)med=c(solut(i,j-1),solut(i,j))opt=opt+medendendsolut=solut-1