FCNPC, MapAndreas, PathFinder

Пытаюсь сделать ботов с помощью FCNPC 2.0.0 + MapAndreas на 0.3 DL версии самп, но увы они начинают летать, когда передвигаются.
Начал использовать плагин PathFinder, но он сильно нагружает сервер, либо я что-то не так делаю.

Как можно найти правильный путь до точки с учетом изменения z координаты, чтобы боты не летали и не заземлялись?

Ну как минимум вместо MapAndreas использовать ColAndreas, для начала.

Если бы под алгоритм pathfinder'a вместо mapandreas кто-то подогнал colandreas, было бы намного проще такое реализовать))
Сам когда-то думал заняться, но ввиду нехватки знаний/опыта и времени, чтобы это наверстать, на желании и остановился (: