一阶互补滤波的应用
上一篇给大家介绍了卡尔曼滤波,今天再给大家讲讲一阶互补滤波。一阶互补滤波的程序非常简单，如下void First_order_Filter(float angle_m, float gyro_m){ angle = K1 * angle_m+ (1-K1) * (angle + gyro_m * dt);}使用的时候，我们只需要如下调用函数：First_order_Filter(Accel_Angle,Gyro_X); 其中 Accel_Angle就是原始计算出的角度.
