蚁群算法进行三维路径规划

蚁群算法进行三维路径规划，这是三维尺度上的路径规划源代码，非常值得学习。

function fitness=CacuFit（path）
%% 该函数用于计算个体适应度值
%path       input     路径
%fitness    input     路径

[nm]=size（path）;
for i=1:n
    fitness（i）=0;
    for j=2:m/2
        %适应度值为长度加高度
        fitness（i）=fitness（i）+sqrt（1+（path（ij*2-1）-path（i（j-1）*2-1））^2 ...
            +（path（ij*2）-path（i（j-1）*2））^2）+abs（path（ij*2））;
    end
end

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     目录           0  2019-02-14 10:07  蚁群算法进行三维路径规划\
     文件         373  2010-09-01 09:36  蚁群算法进行三维路径规划\CacuFit.m
     文件         632  2010-09-01 09:16  蚁群算法进行三维路径规划\CacuQfz.m
     文件         697  2010-08-31 16:26  蚁群算法进行三维路径规划\HeightData.mat
     文件        3746  2010-01-11 20:12  蚁群算法进行三维路径规划\czfz.m
     文件        2088  2010-12-24 15:44  蚁群算法进行三维路径规划\data.m
     文件        1179  2009-06-14 16:35  蚁群算法进行三维路径规划\data1.m
     文件        2584  2010-12-29 10:52  蚁群算法进行三维路径规划\main.m
     文件        2055  2010-09-01 10:08  蚁群算法进行三维路径规划\searchpath.m