Razor_AHRS code simplified
Razor_AHRS code simplified