[发明专利]一种基于Costas环的全数字半球谐振陀螺频率跟踪回路

说明书

本发明涉及一种基于Costas环的全数字半球谐振陀螺频率跟踪回路，陀螺电极振动信号采样电路分别采集陀螺x电极和y电极上的振动信号；两路振动信号通过乘法器分别与压控振荡器的sin支路和cos支路的输出信号进行乘法鉴相，再通过各个低通滤波器进行滤波；滤波后的信号经过相位误差信号运算器计算得到相位误差信号后送至环路滤波器；环路滤波器根据输入的相位误差信号产生控制信号，控制信号对压控振荡器NCO输出信号的相位进行调整，使得振动信号与输出信号相位差不断减小至环路锁定稳态相位差为0；基于Costas环技术在FPGA中实现了全数字半球谐振陀螺的频率跟踪回路设计，该设计可提高频率跟踪的精度，并具有结构简单、通用性强的优点。

技术领域

本发明涉及半球谐振陀螺数字信号处理领域，尤其涉及一种基于Costas环的全数字半球谐振陀螺频率跟踪回路。

背景技术

半球谐振陀螺是一种基于科里奥利效应的固体振动陀螺，其具有高精度、长寿命、高可靠性、质量小以及体积小等特点，目前已应用于航天、航海、战术等领域，半球谐振陀螺已成为当前惯性导航领域内的研究热点。

半球谐振陀螺有力平衡和全角两种工作模式，可分别用于角速度或者角度的测量，两种工作模式对应控制电路涉及陀螺信号采集、信号处理、滤波、幅度控制、正交控制以及频率跟踪等多个环节。其中陀螺振动信号的解调一般需要跟踪陀螺的谐振频率产生本振信号，基于本振信号进行解调，根据解调量计算出陀螺振动信号的幅度以及方位角等信息；另外跟踪得到的本振信号用于陀螺信号调制。因此频率跟踪回路的稳定性能和跟踪精度直接影响到陀螺控制的稳定与解算角度的精度。

在力平衡模式下陀螺振型被控制在固定电极方向，可对陀螺振型波腹轴单个电极上信号进行频率跟踪；在全角模式下因陀螺振型自由进动，需利用利用谐振子上互成45°两个电极上信号进行频率跟踪。频率跟踪的方法有多种，基于模拟电路鉴相方式不需要数字电路支持，但依赖于硬件电路精度，受信号干扰影响大；基于全数字频率跟踪需要实现进行数字信号鉴相、滤波，如何实现高精度频率跟踪是目前需要解决的问题。

发明内容

本发明针对现有技术中存在的技术问题，提供一种基于Costas环的全数字半球谐振陀螺频率跟踪回路，解决现有技术中半球谐振陀螺频率跟踪精度低的问题。

本发明解决上述技术问题的技术方案如下：一种基于Costas环的全数字半球谐振陀螺频率跟踪回路，包括：陀螺电极振动信号采样电路、压控振荡器、乘法器、低通滤波器、相位误差信号运算器和环路滤波器；

所述陀螺电极振动信号采样电路分别采集陀螺x电极和y电极上的振动信号；

两路振动信号分别与所述压控振荡器的sin支路和cos支路的输出信号通过各个所述乘法器进行乘法鉴相，再通过各个所述低通滤波器进行滤波；

滤波后的信号经过所述相位误差信号运算器计算得到相位误差信号后送至所述环路滤波器；

所述环路滤波器根据输入的所述相位误差信号产生控制信号，所述控制信号对所述压控振荡器输出信号的相位进行调整，使得所述振动信号与所述压控振荡器输出信号相位差不断减小至环路锁定稳态相位差为0。

本发明的有益效果是：基于Costas环技术在FPGA中实现了全数字半球谐振陀螺的频率跟踪回路设计，可提高频率跟踪的精度，并具有结构简单、通用性强的优点。

在上述技术方案的基础上，本发明还可以做如下改进。

进一步，所述陀螺电极振动信号采样电路包括分别与陀螺x电极和y电极连接的两路AD采样电路；

两路AD采样电路通过同步触发信号进行同步采集。

进一步，所述压控振荡器的sin支路和cos支路的信号分别为：