Adding trigger at 4kHz AHRS