github/PythonRobotics
1
1
Fork 0
mirror of https://github.com/AtsushiSakai/PythonRobotics.git synced 2026-04-22 03:00:22 -04:00
Code Issues Packages Projects Releases Wiki Activity

cleanup closed loop RRT star.

Browse Source
This commit is contained in:
Atsushi Sakai
2019-07-28 19:50:02 +09:00
parent 0747db006f
commit 76977ac256
7 changed files with 87 additions and 300 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
PathPlanning/LQRRRTStar/lqr_rrt_star.py
View File

@@ -72,7 +72,7 @@ class LQRRRTStar(RRTStar):
for i in range(self.max_iter):
print("Iter:", i, ", number of nodes:", len(self.node_list))
rnd = self.get_random_node()
nearest_ind = self.get_nearest_list_index(self.node_list, rnd)
nearest_ind = self.get_nearest_node_index(self.node_list, rnd)
new_node = self.steer(self.node_list[nearest_ind], rnd)
if self.check_collision(new_node, self.obstacle_list):