BatteryManager - High-pile carpet ss = 4, but weight (power consumption) = 3
ShortestPath - Made some methods private and made it so that a vertex couldn't be added to allVertices twice in case that ever happens