Use inverse covariance in mahalanobis distance
Update for new manipulator camera mount