细节增强的matlab代码RRT明星
RRT星动计划
这是RRT
*算法的Matlab实现,它是RRT的“增强”版本。
示例运行:
磁石颜色中的线表示障碍物。
黑线代表创建的快速探索树。
红线是从起点到终点的最终路径。
另一个非常幸运的发现:
该算法仅通过幸运地对一个点进行采样就找到了一条路径。
否则它将找不到路径,因为RRT
*在狭窄的通道中无法很好地工作。
没有路径示例:
rrt及其狭窄通道时变体不好,在这里我们可以看到算法无法找到从起点到终点的路径
高层次的解释
使用随机均匀抽样,我们选择一个点的坐标,然后尝试将其连接到当前树。
(起初仅由起点组成),我们尝试将此新点连接到树中最近的顶点。
只有在线路没有碰到任何障碍物的情况下,我们才能连接它们。
重复此过程,直到例如到达多个所需的树节点为止。
最后,我们找到最接近终点的点,并尝试将它们连接起来,如果能够的话,我们已经找到了一条路径。
(由于我们正在统一采样点,因此我们不太可能无法到达终点)如果涉及到一条狭窄的通道,则此算法很有可能找到一条路径。
除了RRT,对于每个随机点x_rand,该算法还会找到树中距随机点半径r的圆内的所有
2022-11-11 10:48:45
180KB
系统开源
1