Added AHRS sample code