Path intersection with obstacles bugfix