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

Set index to ind

Browse Source
This commit is contained in:
Kitsunow
2019-05-09 15:16:07 +02:00
parent 54c872aa2b
commit 58c2a80e97
1 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
PathTracking/pure_pursuit/pure_pursuit.py
View File

@@ -93,10 +93,10 @@ def calc_target_index(state, cx, cy):
old_nearest_point_index = ind
else:
ind = old_nearest_point_index
distance_this_index = calc_distance(state, cx[index], cy[index])
distance_this_index = calc_distance(state, cx[ind], cy[ind])
while True:
index = index + 1 if (index + 1) < len(cx) else index
distance_next_index = calc_distance(state, cx[index], cy[index])
ind = ind + 1 if (ind + 1) < len(cx) else ind
distance_next_index = calc_distance(state, cx[ind], cy[ind])
if distance_this_index < distance_next_index:
break
distance_this_index = distance_next_index