Search papers, labs, and topics across Lattice.
The paper introduces an ADMM-based solver for continuous trajectory optimization in non-convex environments, leveraging polynomial trajectory parameterization and a spatio-temporal allocation graph. The primal update is computed in closed form as a minimum-control-effort problem, while the slack update is posed as a shortest-path search. This joint optimization over discrete spatial and continuous temporal domains enables the discovery of better trajectories and ensures reliable convergence from naive initializations compared to decoupled approaches.
Unlock superior trajectories in complex environments with a new ADMM-based solver that jointly optimizes spatial and temporal domains, eliminating the need for complex warm starting.
This paper presents a numerical solver for computing continuous trajectories in non-convex environments. Our approach relies on a customized implementation of the Alternating Direction Method of Multipliers (ADMM) built upon two key components: First, we parameterize trajectories as polynomials, allowing the primal update to be computed in closed form as a minimum-control-effort problem. Second, we introduce the concept of a spatio-temporal allocation graph based on a mixed-integer formulation and pose the slack update as a shortest-path search. The combination of these ingredients results in a solver with several distinct advantages over the state of the art. By jointly optimizing over both discrete spatial and continuous temporal domains, our method accesses a larger search space than existing decoupled approaches, enabling the discovery of superior trajectories. Additionally, the solver's structural robustness ensures reliable convergence from naive initializations, removing the bottleneck of complex warm starting in non-convex environments.