Add function print_path which will display the shortest path, after the path it's found