人工势场斥力函数matlab三维图代码

以下是一个简单的人工势场斥力函数的 Matlab 三维图代码示例：

% 设置网格范围
[X,Y] = meshgrid(-5:0.5:5,-5:0.5:5);

% 设置目标点坐标
goal = [2,2];

% 定义斥力函数
k = 1;  % 斥力函数参数
U = @(x,y) k./sqrt((x-goal(1)).^2 + (y-goal(2)).^2); 

% 计算网格上每个点的斥力
Z = U(X,Y);

% 绘制三维图
surf(X,Y,Z)
xlabel('x')
ylabel('y')
zlabel('Potential')
title('Artificial Potential Field Repulsion')

在这个例子中，我们使用了 meshgrid 函数来生成一个网格，然后定义了一个斥力函数 U，其中 k 是斥力函数的参数。然后，我们计算了网格上每个点的斥力，并使用 surf 函数绘制了三维图。