在上述MATLAB代码的基础上设置障碍物

要在上述MATLAB代码中添加障碍物，可以在`plot`函数之前添加以下代码来创建障碍物：

% 障碍物的坐标
obs_x = [1 2 2 1];
obs_y = [3 3 4 4];

% 绘制障碍物
patch(obs_x, obs_y, 'r');

这里我们将障碍物的坐标定义为`obs_x`和`obs_y`，然后使用`patch`函数绘制障碍物。

完整的代码如下：

% 起点的坐标
start_x = 0;
start_y = 0;

% 终点的坐标
goal_x = 4;
goal_y = 5;

% 障碍物的坐标
obs_x = [1 2 2 1];
obs_y = [3 3 4 4];

% 绘制障碍物
patch(obs_x, obs_y, 'r');

% 设置坐标轴范围
axis([-1 6 -1 6]);

% 计算起点到终点的距离
distance = sqrt((goal_x - start_x)^2 + (goal_y - start_y)^2);

% 显示起点、终点和距离
text(start_x, start_y, 'Start');
text(goal_x, goal_y, 'Goal');
text(mean([start_x goal_x]), mean([start_y goal_y]), ...
     sprintf('Distance: %.2f', distance));

运行以上代码，将会在坐标系中添加一个红色的障碍物。