removed unnecessary stuff: pathfinding is now in getToGoal