Search papers, labs, and topics across Lattice.
This paper introduces a novel framework for reactive motion generation in dynamic environments by tightly integrating perception and planning for manipulators. They present a tensorized particle weight update scheme to efficiently maintain obstacle velocities and covariance, enabling dynamic property representation. Building on this, they propose an obstacle-aware Model Predictive Path Integral (MPPI) planning formulation that jointly propagates robot-obstacle dynamics, improving safety and reactivity under uncertainty.
Explicitly modeling robot-obstacle dynamics in motion planning significantly boosts safety and reactivity in dynamic environments, outperforming traditional static perception approaches.
Reactive motion generation in dynamic and unstructured scenarios is typically subject to essentially static perception and system dynamics. Reliably modeling dynamic obstacles and optimizing collision-free trajectories under perceptive and control uncertainty are challenging. This article focuses on revealing tight connection between reactive planning and dynamic mapping for manipulators from a model-based perspective. To enable efficient particle-based perception with expressively dynamic property, we present a tensorized particle weight update scheme that explicitly maintains obstacle velocities and covariance meanwhile. Building upon this dynamic representation, we propose an obstacle-aware MPPI-based planning formulation that jointly propagates robot-obstacle dynamics, allowing future system motion to be predicted and evaluated under uncertainty. The model predictive method is shown to significantly improve safety and reactivity with dynamic surroundings. By applying our complete framework in simulated and noisy real-world environments, we demonstrate that explicit modeling of robot-obstacle dynamics consistently enhances performance over state-of-the-art MPPI-based perception-planning baselines avoiding multiple static and dynamic obstacles.