Create shortest_path_finder.m