Marking unreachable vertices with +infinity, fixed checking lowest cost path
Small test graph