Completed assignment for week 5 - Dijkstra (without using the heap yet)