FMT$^{x}$: An Efficient and Asymptotically Optimal Extension of the Fast Marching Tree for Dynamic Replanning
2509.08521v1
cs.RO, cs.AI, cs.SY, eess.SY, I.2.9; I.2.8
2025-09-12
Авторы:
Soheil Espahbodini Nia
Резюме на русском
#### Контекст
Планирование маршрутов в динамических средах является одной из основных проблем в робототехнике, особенно при развертывании автономных систем в непредсказуемых пространствах, таких как склады и дороги. Алгоритмы, такие как Fast Marching Tree (FMT$^{*}$), обеспечивают асимптотически оптимальные решения в статических средах. Однако их однопроходная структура не позволяет изменять маршруты во время выполнения, что необходимо для реакции на изменения среды в реальном времени. Другой подход — полное перепланирование — требует больших вычислительных ресурсов. Данная работа предлагает FMT$^{x}$, расширение FMT$^{*}$, которое позволяет эффективно и консистентно проводить перепланирование в динамических средах.
#### Метод
Авторы пересмотрели правило выбора соседей в FMT$^{*}$, продемонстрировав, что минимальные изменения этого правила позволяют перейти от однопроходного подхода к многопроходному. Теперь алгоритм может обновлять значения cost-to-come при обнаружении лучших путей без потери асимптотической оптимальности и высокой вычислительной эффективности. Используется комбинация общего приоритетного очереди с выбранным условием обновления, которое использует расширяющийся сосед для определения и переоценки любого узла с потенциально субоптимальным путем. Этот метод позволяет эффективно исправлять субоптимальные маршруты в процессе изменения среды, сохраняя эффективность FMT$^{*}$.
#### Результаты
Эксперименты показали, что FMT$^{x}$ быстрее реагирует на изменения в среде по сравнению с RRT$^{x}$, при этом потребляя меньшие вычислительные ресурсы. Алгоритм обеспечивает высокую скорость реакции и эффективное использование ресурсов, что делает его оптимальным выбором для реального времени в планировании маршрутов в непредсказуемых средах.
#### Значимость
Предлагаемый подход может быть применен в различных робототехнических системах, включая роботы-помощники, автомобили-роботы, а также в системы-сироты в складских системах. Он обеспечивает быструю реакцию на изменения и низкое потребление ресурсов, что делает его привлекательным для реального времени. Будущие исследования будут ориентированы на улучшение метода FMT$^{x}$ для более сложных сред и увеличения скорости их выполнения.
#### Выводы
FMT$^{x}$ является эффективным и асимптотически оптимальным решением для планирования маршрутов в динамических средах. Он позволяет эффективно исправлять маршруты при изменении среды, сохраняя высокую эффективность и асимптотическую оптимальность. Дальнейшие исследования будут нацелены на улучшение производительности и расширение применений этого подхода.
Abstract
Path planning in dynamic environments remains a core challenge in robotics,
especially as autonomous systems are deployed in unpredictable spaces such as
warehouses and public roads. While algorithms like Fast Marching Tree
(FMT$^{*}$) offer asymptotically optimal solutions in static settings, their
single-pass design prevents path revisions which are essential for real-time
adaptation. On the other hand, full replanning is often too computationally
expensive. This paper introduces FMT$^{x}$, an extension of the Fast Marching
Tree algorithm that enables efficient and consistent replanning in dynamic
environments. We revisit the neighbor selection rule of FMT$^{*}$ and
demonstrate that a minimal change overcomes its single-pass limitation,
enabling the algorithm to update cost-to-come values upon discovering better
connections without sacrificing asymptotic optimality or computational
efficiency. By maintaining a cost-ordered priority queue and applying a
selective update condition that uses an expanding neighbor to identify and
trigger the re-evaluation of any node with a potentially suboptimal path,
FMT$^{x}$ ensures that suboptimal routes are efficiently repaired as the
environment evolves. This targeted strategy preserves the inherent efficiency
of FMT$^{*}$ while enabling robust adaptation to changes in obstacle
configuration. FMT$^{x}$ is proven to recover an asymptotically optimal
solution after environmental changes. Experimental results demonstrate that
FMT$^{x}$ outperforms the influential replanner RRT$^{x}$, reacting more
swiftly to dynamic events with lower computational overhead and thus offering a
more effective solution for real-time robotic navigation in unpredictable
worlds.