%SY0707348宗滿意 遺傳算法求解TSP問題(為選擇操作從新設計后程序)
%D是距離矩陣，n為種群個數
%參數a是中國31個城市的坐標(初始給定)
%C為停止代數，遺傳到第 C代時程序停止,C的具體取值視問題的規模和耗費的時間而定
%m為適值淘汰加速指數,最好取為1,2,3,4,不宜太大
%交叉概率Pc,變異概率Pm
%R為最短路徑,Rlength為路徑長度
      
function [R,Rlength]=geneticTSP2(D,a,n,C,m,Pc,Pm)
         [N,NN]=size(D);%(31*31)
         farm=zeros(n,N);%用于存儲種群
         for i=1:n
             farm(i,:)=randperm(N);%隨機生成初始種群
         end
         R=farm(1,:);%一個隨機解(個體)
%在二維圖上畫出所有點
         scatter(a(:,1),a(:,2),'x');
         hold on        
        pause(1)
%畫出隨機解得路徑圖      
       figure;
       plotaiwa(a,R);
       hold on         
       pause(1)
%輸出隨機的解得路徑和總距離
       disp('初始種群中的一個隨機值:')
       R
       Rlength=myLength(D,R)
       disp('~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~')
%計算各個個體總距離和適配置      
                           %farm(1,:)=R;
        len=zeros(n,1);%存儲路徑長度
        fitness=zeros(n,1);%存儲適配值
        counter=0;
        
       while counter<C
            for i=1:n
                len(i,1)=myLength(D,farm(i,:));%計算路徑長度
            end
            %maxlen=max(len);
            minlen=min(len);
           
            %fitness=fit(len,m,maxlen,minlen);%計算適應度
            rr=find(len==minlen);%返回的是在len中路徑最短的路徑坐標(i,1)
            
            R=farm(rr(1,1),:);%更新最短路徑
                                                   %disp('~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~')
            FARM=farm;%優勝劣汰，nn記錄了復制的個數
%選擇,  
          K=30;
          [aa,bb]=size(FARM);
          FARM2=FARM;
          len2=len;
          [len]=sort(len);
          for i=1:aa
              tt= find(len2==len(i,1));
              FARM(i,:)=FARM2(tt(1,1),:);
          end   
          for i=1:K
              j=aa+1-i;
              FARM(j,:)=FARM(i,:);
              
          end
  
                                    
                                    
                                    
                                    
                                    
                                    
                                    
                                    
                                    
                                    
                                    
 %                交叉操作
              [aa,bb]=size(FARM);
               FARM2=FARM;
             
               for i=1:2:aa
                    
                       if Pc>rand&&i<aa %交叉概率Pc
                            A=FARM(i,:);
                            B=FARM(i+1,:);
                            [A,B]=intercross(A,B);
                            FARM(i,:)=A;
                            FARM(i+1,:)=B;
                       end  
                      
               end
              %交叉檢驗  (可省去)             
               for i=1:aa
                   if myLength(D,FARM(i,:))>myLength(D,FARM2(i,:))
                       FARM(i,:)=FARM2(i,:);
                   end
               end
               clear FARM2
               
               
               
               
               
               
      
          
             [aa,bb]=size(FARM); %aa=nn2
   
%       變異   
            FARM2=FARM;
            for i=1:aa
                if Pm>=rand                    
                  FARM(i,:)=mutate(FARM(i,:));
                end
            end
             %變異檢驗(可省略)  
               for i=1:aa
                   if myLength(D,FARM(i,:))>myLength(D,FARM2(i,:))
                       FARM(i,:)=FARM2(i,:);
                   end
               end
               clear FARM2
%群體的更新
           %FARM2=zeros(n-aa+1,N);
           %if n-aa>=1             
           %    for i=1:n-aa
           %       FARM2(i,:)=randperm(N);%隨機生成n-aa種群
           %     end
           % end
           FARM=[R;FARM];%將隨機產生的n-aa個體加入從后面種群,將上次迭代的最優解從前面加入種群
           [aa,bb]=size(FARM);
                                                   %disp('~~~~~~~~~~~~~~~~4~~~~~~~驗證zong~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~')
             %保持種群規模為n                                         
            if aa>n
                FARM=FARM(1:n,:);
            end   
     
    
                                                    %disp('~~~~~~~~~~~~~~~~~~~5~~~~驗證zong~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~')
            %更新farm
            farm=FARM;
            clear FARM
            %更新迭代次數
            counter=counter+1 ; 
            
       end
 %結果輸出
        
        Rlength=myLength(D,R)    
        figure
        plotaiwa(a,R)%畫圖
        disp('迭代次數c');        
        disp(C);
        disp('迭代后結果'); 
        R
        Rlength=myLength(D,R)%結果輸出