Update dijkstra.C

Added destination
Added new struct to id node
Hard coded weights