This commit is contained in:
Sebastian Lorenz 2024-10-07 16:32:04 +02:00 committed by GitHub
commit 553df5840d
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194
1 changed files with 2 additions and 1 deletions

View File

@ -360,6 +360,7 @@ class GlobalRoutePlanner(object):
if select_edge['type'] == RoadOption.LANEFOLLOW: if select_edge['type'] == RoadOption.LANEFOLLOW:
if neighbor != route[index+1]: if neighbor != route[index+1]:
sv = select_edge['net_vector'] sv = select_edge['net_vector']
if sv is not None:
cross_list.append(np.cross(cv, sv)[2]) cross_list.append(np.cross(cv, sv)[2])
next_cross = np.cross(cv, nv)[2] next_cross = np.cross(cv, nv)[2]
deviation = math.acos(np.clip( deviation = math.acos(np.clip(