3.5.24 · D1Guidance, Navigation & Control (GNC)

Foundations — Extended Kalman Filter (EKF) — linearization, Jacobians

2,028 words9 min readBack to topic

This page assumes you have seen nothing. We name every symbol the parent note throws at you, draw the picture behind it, and say why the EKF cannot live without it. Read top to bottom; each item is a brick for the next.


0. The stage: what a "state" and a "measurement" are

Figure — Extended Kalman Filter (EKF) — linearization, Jacobians

For example a 2D target is . The little ("transpose") just means "written as a standing-up column instead of a lying-down row" — it saves page space to write on one line.

Why can't we just read the state directly? ::: Sensors report indirect, nonlinear quantities (a range $\sqrt{x^2+y^2}$, a bearing angle) — never the clean state itself.


1. Functions and — the two machines

The subscript means "at time step number ." So is "last tick," is "this tick." is the control input — the commands you sent (throttle, steering) that also move the state.


2. Linear vs nonlinear — the reason the EKF exists

Figure — Extended Kalman Filter (EKF) — linearization, Jacobians

What stays Gaussian through a linear map but not a nonlinear one? ::: The uncertainty cloud (a Gaussian); a curve skews it into a non-Gaussian shape.


3. Slope, derivative, tangent line — how we straighten a curve

Figure — Extended Kalman Filter (EKF) — linearization, Jacobians

This is the single most important formula on the page — the EKF applies it at every time step. Deeper background lives in Taylor Series & Linearization.


4. Partial derivatives — slopes when there are many inputs

The curly (instead of straight ) is a flag that says "several inputs are present; I'm holding the others fixed."

What does $\partial r/\partial x$ mean in words? ::: How much the range $r$ changes when only $x$ moves, with $y$ held still.


5. The Jacobian — all the slopes, stacked into a matrix

In the EKF the two Jacobians earn their own letters: (motion) and (sensor). More on the machinery in Jacobian Matrix & Multivariable Calculus.


6. Covariance — the size and shape of your doubt

Figure — Extended Kalman Filter (EKF) — linearization, Jacobians

The and letters you'll meet are the covariances of the random pushes (process noise) and (sensor noise) — "how jittery is the world" and "how noisy is the sensor." Full treatment in Covariance Propagation.


7. atan2 and angle wrap — the sneaky one


How the foundations feed the topic

State vector x and measurement z

Machines f and h

Linear vs nonlinear

Derivative = local slope

Tangent line = Taylor first order

Partial derivatives

Jacobian matrix F and H

Covariance P as an ellipse

EKF predict and update

atan2 and angle wrap

Extended Kalman Filter

This map feeds directly into the parent, the EKF topic note. If the tangent-line idea still feels shaky, the gentler linear case lives in Kalman Filter (linear), and when linearization is too crude the alternative is Unscented Kalman Filter (UKF). The big-picture role sits in State Estimation in GNC.


Equipment checklist

Say each answer aloud before revealing.

  • What is a state vector ? ::: The shortest list of numbers fully describing the system now, stacked as a column.
  • What does mean? ::: Transpose — write a row as a column (or vice versa).
  • Difference between and ? ::: is the (indirect, curved) sensor reading; is the true internal state.
  • What do and do? ::: maps state to next state (motion); maps state to measurement (sensor).
  • Why does nonlinearity break the ordinary KF? ::: It skews a Gaussian into a non-Gaussian shape the KF can't carry.
  • What is a derivative in one phrase? ::: The local slope — output rise per tiny input nudge.
  • Write the first-order Taylor line. ::: .
  • What is a partial derivative? ::: Slope when you nudge one input and freeze the rest.
  • What is the Jacobian? ::: The grid of all partial derivatives — the best local linear (constant-matrix) approximation.
  • What are and ? ::: Jacobians of and ; the constant matrices the KF equations need.
  • What does represent, and its picture? ::: Uncertainty; an ellipse around the state-dot.
  • Why does transform as not ? ::: Covariance is a spread, stretched by the map's slope (Jacobian), not by the curve.
  • What does fix that can't? ::: The correct quadrant of a bearing angle over the full .