Bug-fix vertex_of_optimized_path algorithm (index error on edgesEquality append)