Function reconstruct_path 

pub fn reconstruct_path(
    predecessors: &HashMap<NodeId, NodeId>,
    source: NodeId,
    target: NodeId,
    total_cost: Cost,
) -> Path

Reconstruct path from predecessors map