Added an algorithm to find a path with obstacles