Fix bug in AHRS android