代码的简要说明: 
1.创建地图:通过设置地图大小和分辨率,创建了一个二进制占用栅格地图对象 map。 
2.添加障碍物:将预定义的障碍物位置添加到地图中,并使用 inflate 函数扩大障碍物区域以考虑无人机体积。 
3.创建路径规划器:使用 robotics.PRM 创建了一个路径规划器对象 planner,并将地图对象分配给 Map 属性。还设置了节点数量和连接距离等参数。 
4.设置起始位置和目标位置:指定了起始位置 startPos 和目标位置 targetPos。 
5.进行路径规划:调用 findpath 函数进行路径规划,尝试找到从起始位置到目标位置的有效路径。 
6.显示地图和路径:如果找到有效路径,则绘制地图、路径和障碍物;否则显示一条无法找到有效路径的消息。  
文件列表: Untitled5.m  
运行例图:  
 
 
 |