CSDO: Enhancing Efficiency and Success in Large-Scale Multi-Vehicle Trajectory Planning

Fuente: arXiv
Salvato in:
Dettagli Bibliografici
Autori principali: Yang, Yibin, Xu, Shaobing, Yan, Xintao, Jiang, Junkai, Wang, Jianqiang, Huang, Heye
Natura: Preprint
Pubblicazione: 2024
Soggetti:
Accesso online:
Tags: Aggiungi Tag
Nessun Tag, puoi essere il primo ad aggiungerne!!
_version_ 1866913560406261760
author Yang, Yibin
Xu, Shaobing
Yan, Xintao
Jiang, Junkai
Wang, Jianqiang
Huang, Heye
author_facet Yang, Yibin
Xu, Shaobing
Yan, Xintao
Jiang, Junkai
Wang, Jianqiang
Huang, Heye
contents This paper presents an efficient algorithm, naming Centralized Searching and Decentralized Optimization (CSDO), to find feasible solution for large-scale Multi-Vehicle Trajectory Planning (MVTP) problem. Due to the intractable growth of non-convex constraints with the number of agents, exploring various homotopy classes that imply different convex domains, is crucial for finding a feasible solution. However, existing methods struggle to explore various homotopy classes efficiently due to combining it with time-consuming precise trajectory solution finding. CSDO, addresses this limitation by separating them into different levels and integrating an efficient Multi-Agent Path Finding (MAPF) algorithm to search homotopy classes. It first searches for a coarse initial guess using a large search step, identifying a specific homotopy class. Subsequent decentralized Quadratic Programming (QP) refinement processes this guess, resolving minor collisions efficiently. Experimental results demonstrate that CSDO outperforms existing MVTP algorithms in large-scale, high-density scenarios, achieving up to 95% success rate in 50m $\times$ 50m random scenarios around one second. Source codes are released in https://github.com/YangSVM/CSDOTrajectoryPlanning.
format Preprint
id arxiv_https___arxiv_org_abs_2405_20858
institution arXiv
publishDate 2024
record_format arxiv
spellingShingle CSDO: Enhancing Efficiency and Success in Large-Scale Multi-Vehicle Trajectory Planning
Yang, Yibin
Xu, Shaobing
Yan, Xintao
Jiang, Junkai
Wang, Jianqiang
Huang, Heye
Robotics
This paper presents an efficient algorithm, naming Centralized Searching and Decentralized Optimization (CSDO), to find feasible solution for large-scale Multi-Vehicle Trajectory Planning (MVTP) problem. Due to the intractable growth of non-convex constraints with the number of agents, exploring various homotopy classes that imply different convex domains, is crucial for finding a feasible solution. However, existing methods struggle to explore various homotopy classes efficiently due to combining it with time-consuming precise trajectory solution finding. CSDO, addresses this limitation by separating them into different levels and integrating an efficient Multi-Agent Path Finding (MAPF) algorithm to search homotopy classes. It first searches for a coarse initial guess using a large search step, identifying a specific homotopy class. Subsequent decentralized Quadratic Programming (QP) refinement processes this guess, resolving minor collisions efficiently. Experimental results demonstrate that CSDO outperforms existing MVTP algorithms in large-scale, high-density scenarios, achieving up to 95% success rate in 50m $\times$ 50m random scenarios around one second. Source codes are released in https://github.com/YangSVM/CSDOTrajectoryPlanning.
title CSDO: Enhancing Efficiency and Success in Large-Scale Multi-Vehicle Trajectory Planning
topic Robotics
url https://arxiv.org/abs/2405.20858