以下是一个简单的 Matlab 避障路径规划代码示例:
% 创建一个障碍物地图
map = robotics.OccupancyGrid(20, 20, 10);
setOccupancy(map, [5:15, 25:35, 45:55, 65:75], ones(1, 40));
% 创建一个路径规划器并设置地图
prm = robotics.PRM;
prm.Map = map;
% 配置路径规划器的参数
prm.NumNodes = 50;
prm.ConnectionDistance = 5;
% 搜索一条可行路径
startLocation = [2 2