Matlab基于A*算法的多agv路径规划仿真系统，地图自定义导入，改进A*算法平滑了路径，系统可输出路径长度，每个时间的点的坐标，多agv路径规划时输出时空图

在自动化物流和智能制造领域，多 AGV（自动导引车）路径规划是一个关键问题。今天咱就聊聊用 Matlab 搭建基于 A* 算法的多 AGV 路径规划仿真系统，这系统还带不少有趣的功能。

地图自定义导入

要进行路径规划，首先得有地图。咱这个系统支持自定义地图导入，Matlab 里可以利用 imread 函数读取图像格式的地图，比如常见的 .png 图片。假设地图是黑白二值图，白色代表可通行区域，黑色代表障碍物。

map = imread('custom_map.png');
map = logical(map); % 将图像转换为逻辑矩阵，0 代表障碍物，1 代表可通行

这段代码很简单，imread 把图片读进来，然后通过 logical 函数转换为逻辑矩阵，方便后续 A* 算法处理。这样我们就能根据实际场景，随意导入不同的地图进行路径规划啦。

改进 A* 算法平滑路径

传统 A 算法找到的路径可能会比较 “曲折”，为了让 AGV 行驶路径更平滑，咱得改进改进。一种常见的思路是，在 A 算法找到初始路径后，进行二次处理。

% 假设 path 是 A* 算法找到的初始路径
smoothed_path = [];
for i = 1:size(path, 1) - 1
    start = path(i, :);
    end_point = path(i + 1, :);
    % 这里可以使用一些插值算法，比如线性插值
    inter_points = interp1([start(1), end_point(1)], [start(2), end_point(2)], linspace(1, 2, 10), 'linear');
    for j = 1:size(inter_points, 2)
        new_point = [inter_points(1, j), inter_points(2, j)];
        if map(new_point(1), new_point(2)) % 判断新点是否在可通行区域
            smoothed_path = [smoothed_path; new_point];
        end
    end
end

这段代码对相邻路径点之间进行线性插值，生成一系列中间点，再判断这些点是否在可通行区域，从而平滑路径。这样一来，AGV 就不用老是急转弯，行驶起来更顺畅。

系统输出信息

1. 路径长度：计算路径长度很简单，在 Matlab 里利用欧几里得距离公式就行。假设 smoothed_path 是平滑后的路径。

path_length = 0;
for i = 1:size(smoothed_path, 1) - 1
    current = smoothed_path(i, :);
    next = smoothed_path(i + 1, :);
    path_length = path_length + sqrt((next(1) - current(1))^2 + (next(2) - current(2))^2);
end
disp(['路径长度为：', num2str(path_length)]);

这段代码通过循环累加相邻点之间的欧几里得距离，得出整个路径的长度。

1. 每个时间点的坐标：多 AGV 系统中，要记录每个时间点 AGV 的坐标。假设每个 AGV 按照一定速度匀速行驶，速度为 v，时间间隔为 dt。

v = 1; % 速度
dt = 0.1; % 时间间隔
time_points = 0:dt:path_length / v;
agv_coordinates = [];
for t = time_points
    distance_traveled = v * t;
    current_length = 0;
    for i = 1:size(smoothed_path, 1) - 1
        current = smoothed_path(i, :);
        next = smoothed_path(i + 1, :);
        segment_length = sqrt((next(1) - current(1))^2 + (next(2) - current(2))^2);
        if current_length + segment_length >= distance_traveled
            % 利用比例计算当前时间点在当前线段上的坐标
            ratio = (distance_traveled - current_length) / segment_length;
            x = current(1) + ratio * (next(1) - current(1));
            y = current(2) + ratio * (next(2) - current(2));
            agv_coordinates = [agv_coordinates; x, y];
            break;
        else
            current_length = current_length + segment_length;
        end
    end
end

这段代码通过计算每个时间点 AGV 在路径上行驶的距离，再根据路径点间的距离比例算出对应坐标。

1. 多 AGV 路径规划时输出时空图：时空图可以直观展示多个 AGV 在不同时间的位置。Matlab 里可以用 plot3 函数来绘制三维时空图，x、y 坐标表示 AGV 在地图上的位置，z 坐标表示时间。

figure;
hold on;
for agv_id = 1:num_agvs % num_agvs 是 AGV 的数量
    % 假设每个 AGV 都有对应的坐标矩阵 agv_coordinates_agv_id
    plot3(agv_coordinates_agv_id(:, 1), agv_coordinates_agv_id(:, 2), (1:size(agv_coordinates_agv_id, 1)) * dt);
end
xlabel('X 坐标');
ylabel('Y 坐标');
zlabel('时间');
title('多 AGV 时空图');

这段代码循环绘制每个 AGV 的时空轨迹，让我们能一目了然地看到各 AGV 的运行情况，方便分析是否存在冲突等问题。

Matlab基于A*算法的多agv路径规划仿真系统，地图自定义导入，改进A*算法平滑了路径，系统可输出路径长度，每个时间的点的坐标，多agv路径规划时输出时空图

通过这些功能，这个基于 A* 算法的多 AGV 路径规划仿真系统能更好地模拟和分析实际场景中的 AGV 运行，为物流和制造等行业提供有效的路径规划解决方案。