Алгоритм локального планирования пути для объезда препятствий в путевых координатах

Представлен алгоритм локального планирования пути в системе координат дорожного полотна. Он основан на варьировании точек исходной траектории с применением метода потенциального поля и обеспечения гладкости получаемого пути относительно новой системы координат. Реализация алгоритма основывается на решении задачи минимизации целевого функционала. Рассматривается решение задачи применительно к планированию пути беспилотной транспортной платформы, для чего требуется изменять участки заранее подготовленной гладкой траектории движения транспортного средства в режиме реального времени с учетом возникающих препятствий и с сохранением гладкости. Использование новой системы координат дает преимущество во времени выполнения алгоритма по сравнению с его работой в декартовой системе координат. Алгоритм реализован на языке Python. Выделение горизонта планирования позволяет сочетать предложенный подход с различными алгоритмами следования по пути, которые сами по себе не реализуют методы обхода препятствий. Численное моделирование выполнено для характерных примеров, по которым можно оценить эффективность предложенного алгоритма.