Assignment 6: finished Dijkstra and A*