[发明专利]一种用于振动陀螺信号解算的自适应陷波方法

权利要求书

1.一种用于振动陀螺信号解算的自适应陷波方法，其特征在于：包括信号解调单元、低通滤波器、自适应陷波器、解算单元、PI控制单元、DDS信号发生器，步骤如下：

步骤一：通过信号解调单元将振动陀螺检测电极输出的X、Y信号分别与DDS信号发生器产生的sin(ωt)和cos(ωt)信号相乘获得cx、cy、sx、sy信号；

步骤二：通过低通滤波器过滤掉一部分高频信号；

步骤三：经过自适应陷波器将二倍频信号进行衰减，留下差频信号用于解算；

步骤四：解算单元进行解算；

步骤五：解算后，获得陀螺的振动相位差值并经过PI控制单元，使其振动频率达到期望值，并将振动频率f反馈给自适应陷波器和DDS信号发生器，实现自适应功能。

2.根据权利要求1所述的一种用于振动陀螺信号解算的自适应陷波方法，其特征在于：自适应陷波器的传递函数：

2ω的计算公式为:其中f为期望过滤掉的频率，f_s为采样频率，将锁相环实时输出的频率f代入，实现自适应陷波的功能；调节参数β(0β1)实现对陷波器带宽的控制，选取参数K使通带部分无衰减；

将传递函数转换为差分方程：

Y(k)＝KX(k)-2K cos(2ω)X(k-1)+KX(k-2)+2β cos(2ω)Y(k-1)-β² Y(k-2)。