matlab绘制安全势场

在 MATLAB 中，您可以使用绘图函数来绘制安全势场。安全势场通常用于机器人路径规划和避障问题。下面是一个简单的示例：

% 创建一个网格
[x, y] = meshgrid(-5:0.1:5, -5:0.1:5);

% 定义障碍物的位置和半径
obstacle_x = 1;
obstacle_y = 2;
obstacle_radius = 1;

% 计算每个网格点的安全势场值
safety_potential = sqrt((x - obstacle_x).^2 + (y - obstacle_y).^2) - obstacle_radius;

% 绘制安全势场
figure;
contourf(x, y, safety_potential, 'LineColor', 'none');
colorbar;
axis equal;
xlabel('X');
ylabel('Y');
title('Safety Potential Field');

在这个例子中，我们创建了一个网格来表示二维空间。然后，我们定义了一个圆形障碍物的位置和半径。通过计算每个网格点到障碍物的距离减去障碍物半径，我们可以得到每个点的安全势场值。最后，使用 `contourf` 函数绘制安全势场，并添加颜色条、坐标轴标签和标题。

您可以根据需要调整网格的范围、障碍物的位置和半径，以及绘图属性来适应您的具体问题。