Fixed a bug in astar
The bug in question caused the algorithm to sometimes loop over too many states, which impacted performance and sometimes the algorithm returned suboptimal paths.
The bug in question caused the algorithm to sometimes loop over too many states, which impacted performance and sometimes the algorithm returned suboptimal paths.