This paper presents a design scheme of attitude and heading reference system (AHRS) which consists of low cost MEMS sensors, magnetometers and related data fusion algorithms, based on the chosen sensors and algorithms, the simulation is performed to assess the structure of algorithms, computational burden and convergence from the engineering view of point. Finally, the conclusion was given and related recommendations were proposed.