Added template for Dijkstras algorithm. Cleaned up the commenting and formatting a bit