EKF work with ST,

jacobian diverges