[发明专利]基于IIR滤波的半球谐振陀螺正弦波幅度相位检测方法

说明书

本发明涉及半球谐振陀螺，尤其涉及一种基于IIR滤波的半球谐振陀螺正弦波幅度相位检测方法，包括如下步骤：将陀螺输出的模拟信号转换为数字信号，对所述数字信号进行乘法解调，通过信号滤波器滤除二倍频的信号成分，所述信号滤波使用IIR滤波器。本方法采用IIR滤波器，具有阶数小，延迟小的特点，基于IIR滤除解调带来的二倍频信号，可以降低信号的延迟，提高陀螺振动位移参数解算的精度。与传统的基于FIR滤波算法相比，在取得相同精度及噪声水平的同时，其延时降低10倍，FPGA内部硬件资源消耗降低10倍左右。

技术领域

本发明涉及半球谐振陀螺，尤其涉及一种基于IIR滤波的半球谐振陀螺正弦波幅度相位检测方法。

背景技术

半球谐振陀螺是基于哥氏效应敏感外界角速度。相比传统机械陀螺，它结构简单，核心工作部件只有石英谐振子和电极基座，并且依靠微幅振动工作，无机械磨损，使其具有造价低、可靠性高、寿命长的特点。中国虽然是为数不多的能完全自主生产半球谐振陀螺的国家之一，但所生产的陀螺在性能、一致性等方面与美国、法国、俄罗斯等相比还存在差距，为了缩小国产陀螺与世界领先水平的差距，一方面要对陀螺和谐振子制造、加工工艺进行突破，另一方面则要对陀螺控制中伺服电路检测精度和检测速度提出更高的要求。

数字滤波器是由数字乘法器、加法器和延时单元组成的一个离散时间系统或算法单元，通过对数字代码进行运算处理改变信号频谱，广泛应用的有IIR（InfiniteImpulseResponse，无限脉冲响应）和FIR(FiniteImpulseResponse，有限脉冲响应）数字滤波器两种。IIR数字滤波器幅频特性精度很高；而FIR滤波器具有线性相位延迟。如何通过数字滤波得到幅频特性精度高，且线性相位无延迟的正弦波幅度相位是亟待解决的问题。

发明内容

本发明所要解决的技术问题是克服现有技术中存在的不足，提供一种通过数字滤波得到幅频特性精度高，且线性相位无延迟的基于IIR滤波的半球谐振陀螺正弦波幅度相位检测方法。

本发明是通过以下技术方案予以实现：

一种基于IIR滤波的半球谐振陀螺正弦波幅度相位检测方法，包括如下步骤：

将陀螺输出的模拟信号转换为数字信号，对所述数字信号进行乘法解调，通过信号滤波器滤除二倍频的信号成分，所述信号滤波使用IIR滤波器。

优先的，将陀螺输出的模拟信号转换为数字信号的方法为：

将半球谐振陀螺谐振子的运动轨迹等效为二维摆，在恒定的外角速率下，其重心轨迹呈椭圆型，其中a为椭圆半长轴，主波振幅、q为椭圆半短轴，正交波振幅、θ为半长轴转角，驻波进动角、为振子轨道相位，为了获得谐振子运动状态，在x、y方向上分别设置谐振子检测电极，并采用锁相环作为外部参考信号发生器以跟踪谐振子的运动。谐振子在x、y方向上运动方程为：

(1)

其中，为谐振子固有频率；为振动初始相位，为x电极上正弦波幅值，为y电极上正弦波幅值，为x电极上正弦波相位，为x电极上正弦波相位；通过对不同电极上正弦波幅度相位检测得到半球谐振陀螺谐振子的运动轨迹。

优先的，对数字信号进行乘法解调方法为相敏解调法，

采用陀螺振动信号公式（1）与参考信号和相乘，进行电极信号的解调，

(2)

(3)

(4)

(5)

谐振子振型与参考信号的同相部分和正交部分分别在x、y上的分量为：、、、。

优先的，通过信号滤波器滤除二倍频的信号成分方法为：根据公式(2)(3)(4)(5),通过滤波滤掉二倍频信号后得到。

(6)