Inintialize covariances in GraftImuTopic

On my system, I was seeing cases where the UKF diverged about 50% of the
time during the first updated, because the override covariances aren't
initialized, and would occasionally have values like 1.48947e+195
Add class flag to track divergence