Add spanning tree for checking distance costs
The program runs, but is probably producing improper output
Basic functionality seems to be working