А как лучше проверку сделать? Высчитать расстояние, которое должен проходить агент за секунду, и каждый кадр считать пройденное расстояние за последнюю секунду, если имеется путь, и сравнивать, если прошёл меньше - значит, застрял, и надо пересчитаться?