Search papers, labs, and topics across Lattice.
This paper introduces LAGO Policy, an innovative framework that integrates trajectory optimization with diffusion policies to enhance the smoothness and safety of visuomotor manipulation in real-world environments. By employing latency-aware classifier-free guidance and predicting task-relevant interaction goals, LAGO Policy effectively addresses the challenges of inter-chunk discontinuities and obstacle awareness in asynchronous inference. Extensive real-world experiments validate that LAGO Policy significantly improves task success rates while ensuring collision-free and low-jerk motion execution in complex manipulation scenarios.
LAGO Policy achieves smooth, collision-free manipulation by seamlessly integrating trajectory optimization with advanced diffusion techniques, setting a new standard for real-world robotic execution.
Diffusion-based visuomotor policies deployed with asynchronous inference often exhibit inter-chunk discontinuities and lack explicit mechanisms for obstacle-aware execution, leading to jerky motions and collisions that hinder reliable manipulation in real-world scenes. To address these issues, we propose LAGO Policy, a unified asynchronous action-generation framework that integrates trajectory optimization with diffusion policy for smooth and safe execution. LAGO Policy improves inter-chunk consistency via latency-aware classifier-free guidance conditioning on future actions. It further enables goal-directed collision-free trajectory planning by predicting a task-relevant interaction goal from demonstrations. Finally, spatial-temporal trajectory optimization refines the actions to be executed for low-jerk and feasible motion. Extensive real-world experiments demonstrate that LAGO Policy achieves smooth collision-free execution with high task success across challenging manipulation tasks. Project Website: https://lago-policy.github.io/