Bayesian Filtering and Belief States › Approximate Filtering for Nonlinear Systems

Michael BrenndoerferJune 8, 20265 min read
World Models HandbookAll chapters
Part 2 of 12Inference, Decisions, and Control
Chapter 8Bayesian Filtering and Belief States › Approximate Filtering for Nonlinear Systems
Reading section 5 of 11 · Approximate Filtering for Nonlinear Systems · 5 minSection 5 of 11 · 5 min

Book contents

Section 5 of 11 · 5 min read

Bayesian Filtering and Belief States › Approximate Filtering for Nonlinear SystemsOne section · Sections in this chapter5 / 11 ↓
Reading tools Definitions & inline links

Choose your expertise level to adjust how many terms are explained. Beginners see more tooltips, experts see fewer to maintain reading flow. Hover over underlined terms for instant definitions.

Article links

Make inline references clickable

Real systems are nonlinear: angles wrap, contacts switch, aerodynamics saturate. Once either the dynamics or the observation model bends away from linearity, Gaussians no longer close, and we must approximate. The two dominant classical strategies push in opposite directions: the extended Kalman filter forces the belief to stay Gaussian and linearizes locally, while particle filters abandon parametric forms entirely and carry samples. Between these poles lies a spectrum of compromises, and choosing among them is fundamentally a choice about which failure mode you can afford: the bias of a wrong parametric family, or the variance and cost of Monte Carlo approximation.

The Extended Kalman Filter

The extended Kalman filter (EKF) keeps the Gaussian belief and uses first-order Taylor expansions of the nonlinear functions to build linearized covariance and correction maps. Write the general system as

xt=f(xt−1,ut−1)+w,ot=h(xt)+v,x_t = f(x_{t-1}, u_{t-1}) + w, \qquad o_t = h(x_t) + v,

with additive noise covariances QQ and RR. The mean prediction uses the nonlinear transition ff, and the predicted observation uses the nonlinear function hh. The EKF linearizes only the covariance and correction maps, using the Jacobians

Ft=∂f∂x∣x^t−1,Ht=∂h∂x∣x^t∣t−1,F_t = \left.\frac{\partial f}{\partial x}\right|_{\hat{x}_{t-1}}, \qquad H_t = \left.\frac{\partial h}{\partial x}\right|_{\hat{x}_{t|t-1}},

so Pt∣t−1=FtPt−1∣t−1Ft⊤+QP_{t|t-1}=F_tP_{t-1|t-1}F_t^\top+Q and the correction uses HtH_t in the Kalman gain. The intuition is that the Jacobian captures the local sensitivity of the dynamics at the operating point, so the covariance update approximates how neighboring trajectories spread apart or converge near the current estimate, even though the mean follows the full curved dynamics. A separate control-noise Jacobian is needed only when uncertainty enters through the control channel rather than as the additive state noise written above.

The EKF is cheap, ubiquitous, and fragile in equal measure. Its failure modes deserve explicit attention:

  • Linearization error compounds over rollouts, because each corrected estimate becomes the expansion point for the next prediction. Small biases accumulate.
  • Divergence: if the true belief is multimodal or strongly skewed, the Gaussian approximation can place its mean somewhere no plausible state exists, after which innovations may point the wrong way and the filter can walk away from the truth.
  • Jacobian availability: deriving analytic derivatives is laborious; automatic differentiation helps, but discontinuous models (contact, mode switches) resist differentiation altogether.

Each failure mode suggests a partial remedy that practitioners have catalogued over decades: iterating the correction step to refine the expansion point, inflating QQ to hedge against unmodeled curvature, or switching to derivative-free variants when Jacobians are unavailable. None of these removes the fundamental constraint, which is the Gaussian bottleneck.

The Unscented Kalman Filter

The unscented Kalman filter (UKF) attacks linearization error differently. Rather than differentiating, it propagates a small deterministic set of sigma points through the nonlinear functions and fits a Gaussian to the transformed cloud. A common construction uses 2n+12n+1 points for an nn-dimensional state. It captures curvature that a single local Jacobian misses without requiring derivatives, which makes it useful for black-box simulation models. Whether it improves on an EKF depends on the system, tuning, and operating regime; both methods still force the belief into a Gaussian family. Neither can represent a multimodal belief. To see why that limitation bites, imagine localizing a robot in a symmetric corridor from ambiguous landmarks: the true posterior has two peaks, one for each consistent interpretation, and a single Gaussian summary places its mean between them.

Out[5]:
Visualization
Density plot showing two posterior peaks and a single Gaussian fit centered in the low-density valley between them.
A bimodal posterior produced by an ambiguous measurement, with its moment-matched Gaussian centered between the two modes. A single Gaussian loses the competing hypotheses; a sufficiently supported particle representation can retain both.

The mixture represents two competing interpretations of the same observation. The dashed curve matches its mean and variance, but its mean lies in the low-density valley between the modes. The problem is not high confidence in this plotted Gaussian, which is broad; it is that a single mean and covariance erase the distinction between two hypotheses. A particle representation can retain both modes when its proposal and finite sample set cover them.