Dynamic Programming Algorithms for Finding Cost-Optimal Trajectory on the Terrain

Abstract: This paper considers the problem of finding the optimal trajectory of a road on a given terrain, taking into account the presence of elevation changes. Unlike the heuristic methods often used to solve such problems we present an approach that reduces the problem to a calculus of variations problem by introducing an integral cost functional. We prove the existence of an optimum of the functional. The optimal trajectory that minimizes the specified functional is sought using the dynamic programming method. We also thoroughly study the discretization issue and demonstrate the implementation of Bellman's optimality principle. In addition, we prove the convergence theorem of the proposed algorithm and provide a computational complexity analysis as well as numerical examples.