快速搜索随机树(RRT算法)
RRT算法步骤(个人理解):
- 将初始点作为随机搜索树的根,并添加入搜索树
- 随机生成一个点
- 计算搜索树中距离该点最近的点(自己定义代价函数)
- 根据最近点和随机点,生成新节点,方向为最近点朝向随机点,步长自己定义
- 判断新节点是否满足条件,若满足则将新节点加入到搜索树中;若不满足,回到第二步
- 重复2-5步,直到搜索次数到达限定值还未搜索到目标值,代表搜索失败;
若某次中将“终点”加入到搜索树,说明搜索成功。(“终点”可以是距离实际终点一定误差的点)
Matlab代码参考:http://rkala.in/codes.php
附上代码: