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