Update icp_covariance.m