Add get_step to Pathfinder, returns the first step of a path