Switch to using AHRS class on init()