Use Moore-Penrose pseudoinverse when calculating the Kalman gain in order to allow positive semi-definite innovation covariance
Use Moore-Penrose pseudoinverse when calculating the Kalman gain in order to allow positive semi-definite innovation covariance

sfwa/ukf,sfwa/ukf