RRT,RRT*,A*,Dijkstra,PRM算法
RRT:实现:给定一个node_start, node_goal,随机选择一个node_rand,在node_list列表里选择一个离node_random最近的点设置为node_nearest,然后沿着node_nearest朝node_random走step_length距离,找到一个node_new, 将其加入node_list。重复上述过程直到找到一个node_new接近node_goal,然后再在得到的node_list中找到从node_start到最后一个node_new的列表就构成了pat
原创
2021-07-29 15:59:00 ·
3955 阅读 ·
0 评论