updown.m

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

%给变异过后的P排序
function [P,P0]=updown(P,a)
% a=0.4;
P=ymfitness1(P);
[m1,m2]=size(P);
T=zeros(1,m2);
%选择法对P排序
for i=1:m1-1
    
    for j=1:m1-i
        if P(j,1)>P(j+1,1)
            
        
    
       % if imin~=i
            T=P(j,:);
            P(j,:)=P(j+1,:);
            P(j+1,:)=T;
       end
    end
end
    P0=P(1:(a*m1),:);  
    %P0=P(1:2,:);