Kalman filter magnetometer