arrow
Return

TOP: Trajectory Optimization via Parallel Optimization Towards Constant Time Complexity

delete2025-10-27
delete0
PRE
AI
J
Jiajun Yu
N
Nanhe Chen
G
Guodong Liu
C
Chao Xu
高飞 (Fei Gao)
Y
Yanjun Cao
DOI:10.1109/LRA.2025.3626237delete
deleteOriginal
deleteOriginal request for help
deleteShare
deleteSave
Abstract

Abstract

En 中文
Optimization has been widely used to generate smooth trajectories for motion planning. However, existingtrajectory optimization methods show weakness when dealing with large-scale long trajectories. Recent advances in parallel computing have accelerated optimization in some fields, but how to efficiently solve trajectory optimization via parallelism remains an open question. In this letter, we propose a novel trajectory optimization framework based on the Consensus Alternating Direction Method of Multipliers (CADMM) algorithm, which decomposes the trajectory into multiple segments and solves the subproblems in parallel. The proposed framework reduces the time complexity to <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">$O(1)$</tex-math></inline-formula> per iteration with respect to the number of segments, compared to <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">$O(N)$</tex-math></inline-formula> of the state-of-the-art (SOTA) approaches. Furthermore, we introduce a closed-form solution that integrates convex linear and quadratic constraints to speed up the optimization, and we also present a numerical solution for general convex inequality constraints. A series of simulations and experiments demonstrate that our approach outperforms the SOTA approach in terms of efficiency and smoothness. Especially for a large-scale trajectory, with one hundred segments, achieving over a tenfold speedup. To fully explore the potential of our algorithm on modern parallel computing architectures, we deploy our framework on a GPU and show high performance with thousands of segments.
Keywords:
Aerial systems: applications
motion and path planning
parallel trajectory optimization

Journal

I
IEEE Robotics and Automation Letters
IF:
5.3
Papers:
1.6K
Citations:
3.9W

Organization

Z
zhejiang university
Scholars:
17.4W
Papers: 12.0W
Citations: 152