diff --git a/PathTracking/pure_pursuit/pure_pursuit.py b/PathTracking/pure_pursuit/pure_pursuit.py index 7fc98c33..020df7f4 100644 --- a/PathTracking/pure_pursuit/pure_pursuit.py +++ b/PathTracking/pure_pursuit/pure_pursuit.py @@ -85,7 +85,7 @@ def calc_target_index(state, cx, cy): # search look ahead target point index while Lf > L and (ind + 1) < len(cx): dx = cx[ind + 1] - cx[ind] - dy = cx[ind + 1] - cx[ind] + dy = cy[ind + 1] - cy[ind] L += math.sqrt(dx ** 2 + dy ** 2) ind += 1