Merge 7e9f4b4cef
into 2a2cc5f1be
This commit is contained in:
commit
553df5840d
|
@ -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(
|
||||||
|
|
Loading…
Reference in New Issue