蚁群算法的三维路径寻优

程序详细，带有注释，方遍学习改进，可以在机器人路径规划中应用

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

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----

     文件        373  2018-05-07 21:33  chapter24\CacuFit.m

     文件        632  2018-05-07 21:33  chapter24\CacuQfz.m

     文件       3746  2018-05-07 21:33  chapter24\czfz.m

     文件       2088  2018-05-07 21:33  chapter24\data.m

     文件       1179  2018-05-07 21:33  chapter24\data1.m

     文件        697  2018-05-07 21:33  chapter24\HeightData.mat

     文件       2584  2018-05-07 21:33  chapter24\main.m

     文件       2055  2018-05-07 21:32  chapter24\searchpath.m

     目录          0  2018-09-15 22:54  chapter24

----------- ---------  ---------- -----  ----

                13354                    9