基于蚁群算法的二、三维路径规划算法

基于蚁群算法的二、三维路径规划算法，matlab代码，注释齐全

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  2018-06-02 19:59  基于蚁群算法的三维路径规划算法\
     文件         373  2018-06-02 19:58  基于蚁群算法的三维路径规划算法\CacuFit.m
     文件         632  2018-06-02 19:59  基于蚁群算法的三维路径规划算法\CacuQfz.m
     文件        3746  2018-06-02 19:59  基于蚁群算法的三维路径规划算法\czfz.m
     文件        2088  2018-06-02 19:59  基于蚁群算法的三维路径规划算法\data.m
     文件        1179  2018-06-02 19:59  基于蚁群算法的三维路径规划算法\data1.m
     文件         697  2018-06-02 19:59  基于蚁群算法的三维路径规划算法\HeightData.mat
     文件        2584  2018-06-02 19:59  基于蚁群算法的三维路径规划算法\main.m
     文件        2055  2018-06-02 19:58  基于蚁群算法的三维路径规划算法\searchpath.m
     目录           0  2018-06-02 19:58  基于蚁群算法的二维路径规划算法\
     文件         190  2018-06-02 19:58  基于蚁群算法的二维路径规划算法\barrier.txt
     文件        1158  2018-06-02 19:58  基于蚁群算法的二维路径规划算法\DijkstraPlan.m
     文件         122  2018-06-02 19:58  基于蚁群算法的二维路径规划算法\lines.txt
     文件        5601  2018-06-02 19:58  基于蚁群算法的二维路径规划算法\main.m
     文件         989  2018-06-02 19:58  基于蚁群算法的二维路径规划算法\matrix.txt