pub fn ekf_update( prior_x: f64, meas_z: f64, cov_p: f64, meas_noise_r: f64, ) -> (f64, f64)
1D Extended Kalman Filter (EKF) state estimation step