Added mahalanobis calculation for kf measurement inputs.