Completed heap-based Prim's MST alg, about 2 debug