Fixed imu message covar not being set