kalman-cpp
kalman-cpp copied to clipboard
Inverse of a singular matrix result in inf
In code K = P*C.transpose()*(C*P*C.transpose() + R).inverse();
, the inverse of a matrix might not exist if the matrix is singular, and K is invalid in that case.
could try the joseph formulation in that case.