卡尔曼滤波算法，输入陀螺仪测得的角速度、加速度计测得的角度，输出量为滤波之后的角度，消除零漂。-Kalman filtering algorithm, the input gyroscope angular velocity and acceleration of the measured meter measured Angle, Angle after output for filtering, to eliminate the zero drift.