Search papers, labs, and topics across Lattice.
This paper introduces a novel approach for ergodic trajectory generation on 3D surfaces by reformulating point-cloud ergodic coverage as a manifold-aware sampling problem. They derive SE(3)-specific Stein Variational Gradient Descent (SVGD) particle updates and develop a preconditioner to accelerate trajectory optimization convergence. Experiments demonstrate that the proposed method achieves superior coverage quality with tractable computation compared to existing trajectory optimization and sampling-as-optimization approaches, validated in both simulation and real-world robot experiments.
Robots can now achieve superior surface coverage with precise end-effector poses thanks to a new SE(3)-aware Stein Variational Gradient Descent method that outperforms existing trajectory optimization techniques.
Surface manipulation tasks require robots to generate trajectories that comprehensively cover complex 3D surfaces while maintaining precise end-effector poses. Existing ergodic trajectory optimization (TO) methods demonstrate success in coverage tasks, while struggling with point-cloud targets due to the nonconvex optimization landscapes and the inadequate handling of SE(3) constraints in sampling-as-optimization (SAO) techniques. In this work, we introduce a preconditioned SE(3) Stein Variational Gradient Descent (SVGD) approach for SAO ergodic trajectory generation. Our proposed approach comprises multiple innovations. First, we reformulate point-cloud ergodic coverage as a manifold-aware sampling problem. Second, we derive SE(3)-specific SVGD particle updates, and, third, we develop a preconditioner to accelerate TO convergence. Our sampling-based framework consistently identifies superior local optima compared to strong optimization-based and SAO baselines while preserving the SE(3) geometric structure. Experiments on a 3D point-cloud surface coverage benchmark and robotic surface drawing tasks demonstrate that our method achieves superior coverage quality with tractable computation in our setting relative to existing TO and SAO approaches, and is validated in real-world robot experiments.
