Hybrid systems are subject to multiple dynamic models, or so-called modes. To estimate the
state, the sequence of modes has to be estimated, which results in an exponential growth of …

Many state estimation algorithms in robotics rely on nonlinear least squares optimization
procedures that require permanently marginalizing out a subset of variables. This operation …