python path finding algorithm