factored code into filterNode()
added int TrashProblem::findNearestNodeTo(const Vehicle&, int, int, int*) but have a const issue