Create PlotGraph.m

Helper function to plot graph and path solution.