Small bug in Wayset::resample
More robust obstacle detection in A*
A* is now less granular (faster)