Search papers, labs, and topics across Lattice.
This paper introduces a path integral particle filtering (PIPF) method for state estimation in hybrid systems with intermittent contact, leveraging the duality between smoothing and optimal control. The key innovation is the use of saltation matrices to accurately propagate uncertainty during contact events, addressing a significant challenge in hybrid system estimation. Experimental results demonstrate that the proposed PIPF approach outperforms existing methods in various settings, showcasing its robustness and computational efficiency.
Saltation matrices enable robust state estimation for hybrid systems with contact dynamics, outperforming existing methods in stochastic environments.
We present an optimal-control-based particle filtering method for state estimation in hybrid systems that undergo intermittent contact with their environments. We follow the path integral filtering framework that exploits the duality between the smoothing problem and optimal control. We leverage saltation matrices to map out the uncertainty propagation during contact events for hybrid systems. The resulting path integral optimal control problem allows for a state estimation algorithm robust to outlier effects, flexible to non-Gaussian noise distributions, that also handles the challenging contact dynamics in hybrid systems. This work offers a computationally efficient and reliable estimation algorithm for hybrid systems with stochastic dynamics. We also present extensive experimental results demonstrating that our approach consistently outperforms strong baselines across multiple settings.
