mirror of
https://github.com/AtsushiSakai/PythonRobotics.git
synced 2026-04-22 03:00:22 -04:00
fix added for checking if a neighbor is inside openList (#832)
This commit is contained in:
@@ -311,7 +311,7 @@ def hybrid_a_star_planning(start, goal, ox, oy, xy_resolution, yaw_resolution):
|
||||
neighbor_index = calc_index(neighbor, config)
|
||||
if neighbor_index in closedList:
|
||||
continue
|
||||
if neighbor not in openList \
|
||||
if neighbor_index not in openList \
|
||||
or openList[neighbor_index].cost > neighbor.cost:
|
||||
heapq.heappush(
|
||||
pq, (calc_cost(neighbor, h_dp, config),
|
||||
|
||||
Reference in New Issue
Block a user