Get rid of the old path finding methods in util.cpp