Included Graph.cpp, finished getCost()