Warmup sequence is no longer good. We should first warmup AHRS filters. Then frequency filters. Then run Kalman integration filters and initialize them with known frequency and phase.