1、首先,简单介绍一下加速度计和陀螺仪的一些特性。
加速度计:静态稳定性好,动态响应较慢,在高频时信号不可用,在运动时其数据相对不可靠。
陀螺仪: 动态性能好,响应快,积分后可测倾角,在低频段信号不好,存在零漂现象。
2、一维互补滤波算法推导
首先,直接给出两个传感器测量表达式:
其中,为真值,设为零均值量测噪声,为高频噪声,为低频噪声,均为传感器测量值。
接着,设的估计值为,按照线性假设有
1、首先,简单介绍一下加速度计和陀螺仪的一些特性。
加速度计:静态稳定性好,动态响应较慢,在高频时信号不可用,在运动时其数据相对不可靠。
陀螺仪: 动态性能好,响应快,积分后可测倾角,在低频段信号不好,存在零漂现象。
2、一维互补滤波算法推导
首先,直接给出两个传感器测量表达式:
其中,为真值,设为零均值量测噪声,为高频噪声,为低频噪声,均为传感器测量值。
接着,设的估计值为,按照线性假设有