Bar-Shalom — Estimation with Applications to Tracking
x̂ = Fx + Bu, P = FPF' + Q
K = PH'(HPH'+R)⁻¹
h(x) = [√(x²+y²), atan2(y,x)]
H = ∂h/∂x