1工业六轴机器人关节轨迹优化

function pareto_front=CrowdingDistance（setN）
%%%%%%%%%%%%%计算拥挤距离%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% set 为超过某数量的最优解集
% N 为欲输出最优解集个数
L=length（set）;
f=zeros（L2）;
new_f=zeros（L1）;
dist=zeros（L1）; %最优解集的距离
pareto_front=zeros（1N）;
for i=1:L