Testing for MST cost

Added some testing to find the MST's and their costs