AHRS essay: Finish the formula of accelermetor and magnetometer attitude estimation