check if the cov is invertible to fix the FPE errors
As discussed in https://its.cern.ch/jira/browse/ATLASRECTS-7105, there are FPE errors in the KalmanVertexUpdator, this MR will check if the matrix is invertible first, and return the old vertex is no.