基于蚁群算法的移动机器人三维路径规划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-03-09 13:59  chapter24\
     文件         373  2010-09-01 09:36  chapter24\CacuFit.m
     文件         632  2010-09-01 09:16  chapter24\CacuQfz.m
     文件        3746  2010-01-11 20:12  chapter24\czfz.m
     文件        2088  2010-12-24 15:44  chapter24\data.m
     文件        1179  2009-06-14 16:35  chapter24\data1.m
     文件         697  2010-08-31 16:26  chapter24\HeightData.mat
     文件        2584  2010-12-29 10:52  chapter24\main.m
     文件        2055  2010-09-01 10:08  chapter24\searchpath.m