Robots Atlas>ROBOTS ATLAS
Robotics

KF

1960ActivePublished: 4 May 2026Updated: 4 May 2026Published
Key innovation
Recursive linear state estimator that minimizes estimation error variance in Gaussian-noise systems without storing the full measurement history.
Category
Robotics
Abstraction level
Building block
Operation level
Robot control
Use cases
Sensor fusion (IMU + GPS + LiDAR)Robot localization (SLAM)Tracking objects in robotics and autonomous systemsFault detection (residual generation)State prediction for MPCInertial navigation (INS)Biomedical signal filtering

How it works

Predict: x̂⁻ = F·x̂ + B·u; P⁻ = F·P·Fᵀ + Q. Update: K = P⁻·Hᵀ·(H·P⁻·Hᵀ + R)⁻¹; x̂ = x̂⁻ + K·(z - H·x̂⁻); P = (I - K·H)·P⁻. The residual (innovation) z - H·x̂⁻ serves as a signal for fault detection and isolation (FDI).

Problem solved

How to optimally estimate the state of a dynamic system from noisy measurements, without storing the full data history and under limited computational resources.

Components

Prediction StepComputes the a priori state estimate before a new measurement is incorporated.

Propagation of state and covariance through the dynamics model (matrices F, B, Q).

Update Step (Correction)Update step: refines the state estimate upon receiving a new measurement.

Update of the estimate using the new measurement z (matrices H, R), computation of Kalman gain K.

Residual (Innovation)Diagnostic signal for fault detection and estimation quality assessment.

Difference between predicted and actual measurement: ν = z - H·x̂⁻. Foundation of FDI.

Implementation

Implementation pitfalls
Incorrect Q and R TuningHigh

Poorly tuned Q (process) and R (measurement) covariances lead to filter divergence or overly slow updates.

Fix:Offline tuning on historical data, adaptive filters (autocovariance least squares — ALS).
EKF Linearization Errors Under Strong NonlinearitiesMedium

EKF loses optimality and may diverge for strongly nonlinear models.

Fix:Use UKF or a Particle Filter for strongly nonlinear systems.

Evolution

1960
Kálmán's original paper published
Inflection point

R. E. Kálmán publishes "A New Approach to Linear Filtering and Prediction Problems" in ASME Journal of Basic Engineering.

1961
Kálmán–Bucy – continuous-time

Extension to continuous time (Kálmán–Bucy Filter).

1968
Apollo navigation — first application
Inflection point

KF applied in the Apollo mission navigation computer — the first large-scale industrial implementation.

1987
Extended Kalman Filter widely adopted in robotics

EKF becomes the standard in robotic navigation and SLAM after popularisation by Smith, Self & Cheeseman.

2000
Unscented Kalman Filter
Inflection point

Julier & Uhlmann propose the UKF — a better nonlinearity approximation via sigma points than EKF linearisation.

Hardware requirements

Primary

KF runs on RT CPU in most embedded and robotic systems.

Good fit

FPGAs used for very short cycles (e.g. IMU at 10 kHz) with deterministic latency.

Good fit

Algorithm is hardware-agnostic — a deterministic scheduler is the key requirement.