Применение триангуляции к модели движения ТС по маршруту

# Загрузка данных карты (предполагается, что файл map.mat доступен)
using MAT
map_data = matread("$(@__DIR__)/map.mat")
global gridX = map_data["gridX"]
global gridY = map_data["gridY"]
global gridZ = map_data["gridZ"]
global route = map_data["route"]
# n = 100
# gridX = [1.:n;] .* ones(n, n)
# gridY = [1.:n;]' .* ones(n, n)
# gridZ = 9.5 .* ones(n, n)
# route = [[1.:n;] [n:-1:1.;]]