Search papers, labs, and topics across Lattice.
This paper introduces Clustering-Embedded MPPI (CE-MPPI), a novel framework that addresses the averaging-induced failures of traditional Model Predictive Path Integral (MPPI) control in complex, non-convex environments. By integrating density-based spatial clustering and a geometric direction feature, CE-MPPI effectively isolates feasible trajectory modes from infeasible rollouts, enhancing decision-making in cluttered and dynamic settings. Experimental results demonstrate that CE-MPPI significantly reduces time-to-goal by 48% and shortens end-effector paths by 12% in real-world robotic applications.
CE-MPPI achieves a remarkable 48% reduction in time-to-goal for robotic motion planning by effectively isolating feasible trajectories in cluttered environments.
With the widespread availability of parallel computing hardware, sampling-based motion planning methods such as Model Predictive Path Integral (MPPI) control have become increasingly powerful for complex nonlinear systems in non-smooth task spaces. However, the sampling and forward-simulation pipeline in MPPI suffers from averaging-induced failure in cluttered environments, where the importance-weighted update averages incompatible rollouts and leads to hesitation or even collision when an obstacle lies directly ahead. This paper proposes Clustering-Embedded MPPI (CE-MPPI), a framework that architecturally resolves the averaging-induced failures inherent in standard MPPI within non-convex environments. Rather than simply mitigating interference, CE-MPPI redefines the control law by integrating a high-fidelity pruning and clustering stage. By leveraging density-based spatial clustering of applications with noise (DBSCAN) alongside a novel geometric direction feature that is extracted from collision-derived reference points, the system isolates feasible trajectory modes from the noise of infeasible rollouts. This is paired with an intelligent selection logic that optimizes for minimum cost in static scenes while actively steering opposite to obstacle flux in dynamic environments. Experiments in 2-D JAX-accelerated simulations show that CE-MPPI alleviates obstacle-front hesitation and avoids persistent coupling with moving obstacles in dynamic scenes. In particular, real-world tests on a 6-DoF UR5e manipulator with CUDA-parallel rollouts in Isaac Gym achieve a 48\% reduction in time-to-goal and a 12\% shorter end-effector path.
