TOP: Trajectory Optimization via Parallel Optimization towards Constant Time Complexity

Fuente: arXiv
Saved in:
Bibliographic Details
Main Authors: Yu, Jiajun, Chen, Nanhe, Liu, Guodong, Xu, Chao, Gao, Fei, Cao, Yanjun
Format: Preprint
Published: 2025
Subjects:
Online Access:
Tags: Add Tag
No Tags, Be the first to tag this record!
_version_ 1866916847460286464
author Yu, Jiajun
Chen, Nanhe
Liu, Guodong
Xu, Chao
Gao, Fei
Cao, Yanjun
author_facet Yu, Jiajun
Chen, Nanhe
Liu, Guodong
Xu, Chao
Gao, Fei
Cao, Yanjun
contents Optimization has been widely used to generate smooth trajectories for motion planning. However, existing trajectory 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 paper, 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 O(1) per iteration to the number of segments, compared to O(N) 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 numerical solutions for general 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.
format Preprint
id arxiv_https___arxiv_org_abs_2507_10290
institution arXiv
publishDate 2025
record_format arxiv
spellingShingle TOP: Trajectory Optimization via Parallel Optimization towards Constant Time Complexity
Yu, Jiajun
Chen, Nanhe
Liu, Guodong
Xu, Chao
Gao, Fei
Cao, Yanjun
Robotics
Optimization has been widely used to generate smooth trajectories for motion planning. However, existing trajectory 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 paper, 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 O(1) per iteration to the number of segments, compared to O(N) 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 numerical solutions for general 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.
title TOP: Trajectory Optimization via Parallel Optimization towards Constant Time Complexity
topic Robotics
url https://arxiv.org/abs/2507.10290