一种用于半球谐振陀螺的变周期分时解调和控制方法技术

一种用于半球谐振陀螺的变周期分时解调和控制方法，它属于惯性技术领域。本发明专利技术解决了传统分时方案滤波暂态过程长的问题。本发明专利技术根据陀螺振动信号的完整谐振周期进行分时，保持分时周期与陀螺谐振周期相同。通过控制芯片判断陀螺振动信号的过零位置，以此作为一个完整谐振周期开始和结束的依据，每当振动信号经历一个完整的谐振周期后，控制多路开关切换为驱动模态，对陀螺施加驱动力，而后再度切换为检测模态，模态与模态之间经历短暂的空闲时间，循环往复。每个检测时段内的检测信号在拼接后更接近连续信号，使解调的滤波过程更趋近于连续滤波过程，大大缩短了解调过程中的滤波暂态时间。本发明专利技术方法可以应用于惯性技术领域。域。域。

【技术实现步骤摘要】
一种用于半球谐振陀螺的变周期分时解调和控制方法


[0001]本专利技术属于惯性
，具体涉及一种用于半球谐振陀螺的变周期分时解调和控制方法。

技术介绍

[0002]半球谐振陀螺以其精度高、寿命长、结构简单、可靠性好等诸多优势，满足了许多应用领域的发展需求，成为主流的惯性器件之一，具有极大的竞争力和发展前景。半球谐振陀螺的基本原理是通过检测电极敏感谐振子的振动状态，通过驱动电极维持振动能量并消除正交误差，当外界有角速度输入时，驻波方位角会相对谐振子沿相反方向进动，通过检测进动角信息即可获知外界角速度输入信息。“两件套”的平板电极式半球谐振陀螺由于共用谐振子唇沿作为周向电容的一侧极板，当对谐振子振动状态的检测和驱动同时进行时，二者会相互干扰，从而降低检测精度和驱动效率，因此检测和驱动需要分时进行。传统的分时方案由于分时周期固定，得到的检测信号是不连续的，这样在每个检测时段内进行解调时滤波的暂态过程较长，导致可用信息减少，从而对解调和驱动产生负面影响。

技术实现思路

[0003]本专利技术的目的是为解决传统分时方案滤波暂态过程长的问题，而提出的一种用于半球谐振陀螺的变周期分时解调和控制方法。
[0004]本专利技术为解决上述技术问题所采取的技术方案是：
[0005]一种用于半球谐振陀螺的变周期分时解调和控制方法，所述方法具体包括以下步骤：
[0006]步骤一、将检测信号整周期开始的时刻记为T0，在T0时刻，通过多路开关将检测电极连接至缓冲放大电路，并将驱动电极与控制电路断开，半球谐振陀螺工作状态进入检测模态，检测X路振动信号和Y路振动信号；
[0007]将检测信号整周期结束的时刻记为T1，称T0～T1时段为检测时段；
[0008]在检测信号整周期结束时，通过多路开关切断检测电极与缓冲放大电路之间的连接，并保持驱动电极与控制电路断开直至T2时刻；
[0009]步骤二、在检测时段T0～T1内，根据检测到的X路振动信号和Y路振动信号计算用于半球谐振陀螺控制的谐振子状态参量E、Q、R、S和L；
[0010]步骤三、根据谐振子状态参量E、Q、R、S和L更新幅值驱动力F
a
、正交驱动力F
q
、振动频率ω、解调信号的相位ψ以及驻波方位角θ；
[0011]步骤四、根据F
a
、F
q
、ω、ψ和θ计算X电极的控制力F
x
和Y电极的控制力F
y
；
[0012]步骤五、从T2时刻开始，通过多路开关将驱动电极与控制电路相连，半球谐振陀螺工作状态进入驱动模态，将步骤四中计算出的控制力F
x
和F
y
施加到驱动电极上，对半球谐振陀螺进行幅值控制和正交控制；
[0013]将T2～T3时段称为驱动时段；
[0014]步骤六、在T3时刻，通过多路开关断开驱动电极与控制电路的连接，并保持检测电极与缓冲放大电路断开，半球谐振陀螺工作状态再次进入空闲时段，等待检测信号下一完整周期；
[0015]步骤七、通过检测过零位置判断检测信号开始进入下一个完整周期的时刻T4，在时刻T4，通过多路开关将检测电极与缓冲放大电路相连，半球谐振陀螺工作状态返回到步骤一的检测模态。
[0016]进一步地，所述X路振动信号和Y路振动信号如下：
[0017][0018]其中，x为X路振动信号，y为Y路振动信号，a代表主波波腹，θ代表驻波方位角，ω代表振动频率，t代表时间，ψ0代表振动信号的初相位，q代表正交波波腹。
[0019]进一步地，所述步骤二的具体过程为：
[0020][0021]其中，C
x
、S
x
、C
y
和S
y
为缓慢变化量。
[0022]进一步地，所述缓慢变化量C
x
、S
x
、C
y
和S
y
通过I/Q解调得到。
[0023]进一步地，所述缓慢变化量C
x
、S
x
、C
y
和S
y
为：
[0024][0025]其中，V
rc
和V
rs
为解调参考信号，LPF代表低通滤波。
[0026]进一步地，所述解调参考信号V
rc
和V
rs
为：
[0027][0028]其中，ψ为解调参考信号的相位。
[0029]进一步地，所述步骤三中采用闭环反馈的方式计算。
[0030]更进一步地，所述步骤四的具体过程为：
[0031][0032]本专利技术的有益效果是：
[0033]本专利技术根据陀螺振动信号的完整谐振周期进行分时，保持分时周期与陀螺谐振周
期相同，均是随时间变化的。通过控制芯片判断陀螺振动信号的过零位置，以此作为一个完整谐振周期开始和结束的依据，每当振动信号经历了一个完整的谐振周期后，控制多路开关切换为驱动模态，对陀螺施加一定时间的驱动力，而后再度切换为检测模态，模态与模态之间经历短暂的空闲时间，循环往复。每个检测时段内的检测信号在拼接后更接近连续信号，使解调的滤波过程更趋近于连续滤波过程，与传统分时方案相比，大大缩短了解调过程中的滤波暂态时间，并增加了陀螺解调产生的可用信息，提高了陀螺的输出精度和控制效率。
附图说明
[0034]图1为本专利技术的整周期分时方案示意图；
[0035]图2为本专利技术的一种用于半球谐振陀螺的变周期分时解调和控制方法的流程图。
具体实施方式
[0036]下面通过具体实施方式结合附图对本申请作进一步详细说明。显然，所描述的实施方式仅仅是本专利技术的一部分实施方式，而不是全部的实施方式。基于本专利技术中的实施方式，本领域普通技术人员在没有做出创造性劳动前提下所获得的其他实施方式，都属于本专利技术保护的范围。
[0037]具体实施方式一、结合图1和图2说明本实施方式。本实施方式所述的一种用于半球谐振陀螺的变周期分时解调和控制方法，所述方法具体包括以下步骤：
[0038]步骤一、将检测信号整周期开始的时刻记为T0，在T0时刻，通过多路开关将检测电极连接至缓冲放大电路，并将驱动电极与控制电路断开，半球谐振陀螺工作状态进入检测模态，检测X路振动信号和Y路振动信号；
[0039]将检测信号整周期结束的时刻记为T1，称T0～T1时段为检测时段；
[0040]在检测信号整周期结束时，通过多路开关切断检测电极与缓冲放大电路之间的连接，并保持驱动电极与控制电路断开直至T2时刻；
[0041]在空闲时段T1～T2内，通过多路开关使检测电极与缓冲放大电路断开，同时保持驱动电极与控制电路断开，以避免检测与驱动信号在切换瞬间产生串扰；
[0042]步骤二、在检测时段T0～T1内，根据检测到的X路振动信号和Y路振动信号计算用于半球本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于半球谐振陀螺的变周期分时解调和控制方法，其特征在于，所述方法具体包括以下步骤：步骤一、将检测信号整周期开始的时刻记为T0，在T0时刻，通过多路开关将检测电极连接至缓冲放大电路，并将驱动电极与控制电路断开，半球谐振陀螺工作状态进入检测模态，检测X路振动信号和Y路振动信号；将检测信号整周期结束的时刻记为T1，称T0～T1时段为检测时段；在检测信号整周期结束时，通过多路开关切断检测电极与缓冲放大电路之间的连接，并保持驱动电极与控制电路断开直至T2时刻；步骤二、在检测时段T0～T1内，根据检测到的X路振动信号和Y路振动信号计算用于半球谐振陀螺控制的谐振子状态参量E、Q、R、S和L；步骤三、根据谐振子状态参量E、Q、R、S和L更新幅值驱动力F
a
、正交驱动力F
q
、振动频率ω、解调信号的相位ψ以及驻波方位角θ；步骤四、根据F
a
、F
q
、ω、ψ和θ计算X电极的控制力F
x
和Y电极的控制力F
y
；步骤五、从T2时刻开始，通过多路开关将驱动电极与控制电路相连，半球谐振陀螺工作状态进入驱动模态，将步骤四中计算出的控制力F
x
和F
y
施加到驱动电极上，对半球谐振陀螺进行幅值控制和正交控制；将T2～T3时段称为驱动时段；步骤六、在T3时刻，通过多路开关断开驱动电极与控制电路的连接，并保持检测电极与缓冲放大电路断开，半球谐振陀螺工作状态再次进入空闲时段，等待检测信号下一完整周期；步骤七、通过检测过零位置判断检测信号开始进入下一个完整周期的时刻T4，在时刻T4，通过多路开关将检测电极与缓冲放大电路相连，半球谐振陀螺工作状态返回到步骤一的检测模态。2.根据权利...

【专利技术属性】
技术研发人员：王常虹，李汉时，解伟男，奚伯齐，伊国兴，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：