Open iyabchen opened 5 years ago
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.
K = P*C.transpose()*(C*P*C.transpose() + R).inverse();
could try the joseph formulation in that case.
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.