В общем была проблема с неправильным снятием (с ошибками) карты высот.
Это выражалось во внезапной остановки в плюсе по оси Z, либо плавала высота в одной и той же точке.
Доходило до того, что мог по 20 раз снимать высоту на одной точке и она каждый раз была разной.
Поспрашивав тут у местных...