Add basic Prims MST implementation