Removed shortest path variable. Now find_path returns the shortest path