CN116772818A - 基于驻波伪进动的全角模式陀螺阻尼失配补偿方法及*** - Google Patents
基于驻波伪进动的全角模式陀螺阻尼失配补偿方法及*** Download PDFInfo
- Publication number
- CN116772818A CN116772818A CN202310740886.2A CN202310740886A CN116772818A CN 116772818 A CN116772818 A CN 116772818A CN 202310740886 A CN202310740886 A CN 202310740886A CN 116772818 A CN116772818 A CN 116772818A
- Authority
- CN
- China
- Prior art keywords
- precession
- damping
- standing wave
- angle
- mismatch
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000013016 damping Methods 0.000 title claims abstract description 111
- 238000000034 method Methods 0.000 title claims abstract description 35
- 238000010276 construction Methods 0.000 claims abstract description 3
- 230000003044 adaptive effect Effects 0.000 claims description 30
- 238000006073 displacement reaction Methods 0.000 claims description 24
- 238000006243 chemical reaction Methods 0.000 claims description 21
- 230000001629 suppression Effects 0.000 claims description 12
- 238000000354 decomposition reaction Methods 0.000 claims description 9
- 238000001514 detection method Methods 0.000 claims description 9
- 238000012546 transfer Methods 0.000 claims description 9
- 230000000694 effects Effects 0.000 claims description 8
- 230000008859 change Effects 0.000 claims description 7
- 230000008569 process Effects 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 6
- 238000012545 processing Methods 0.000 claims description 6
- 238000012937 correction Methods 0.000 claims description 5
- 238000012423 maintenance Methods 0.000 claims description 2
- 238000005259 measurement Methods 0.000 abstract description 3
- 239000000306 component Substances 0.000 description 11
- 230000009471 action Effects 0.000 description 3
- 238000001914 filtration Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000008358 core component Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000977 initiatory effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Landscapes
- Gyroscopes (AREA)
Abstract
本发明针对全角模式微半球谐振陀螺因阻尼不对称导致的角度漂移误差,提供一种基于驻波伪进动的全角模式陀螺阻尼失配补偿方法及***。在驻波伪进动方式下,当全角模式微半球谐振陀螺正常工作时,对稳定后的能量环路控制变量信号进行解调,通过两路解调信号得到对应的阻尼失配误差参数,利用阻尼失配误差参数构造补偿力实现阻尼失配误差在线实时补偿,消除微半球谐振陀螺的阻尼各向异性的影响,降低速率阈值,减小角度误差,提高全角陀螺仪的角度测量精度。
Description
技术领域
本发明涉及微半球谐振陀螺仪领域,特别是涉及一种基于驻波伪进动的全角模式陀螺阻尼失配补偿方法及***。
背景技术
惯性导航***拥有完全独立、不依靠外界信息、不受外界干扰等特点,因此在无人机、无人车自主导航、舰船以及巡航导弹等领域得到了广泛的应用,在国防及国民经济中表现出紧要作用。陀螺仪是惯性导航***的核心器件之一,可用于载体运动的角速度或角度的测量。
微半球谐振陀螺是基于哥氏效应测量载体角速率或角度的惯性传感器件,因其尺寸小、低成本和可批量生产等优点,被广泛应用于惯性导航、机器人和航空航天等领域。微半球谐振陀螺在力平衡模式下,其量程和测量带宽往往无法满足大动态的使用要求,而具有大量程和高带宽的全角模式微半球谐振陀螺已成为目前阶段的重要发展方向。但是,全角模式对微半球谐振子的周向对称性要求较高,这类陀螺的阻尼不对称和刚度不对称,会引入角度误差(漂移)和速率阈值问题,进而影响全角模式微半球谐振陀螺的驻波进动角度的输出精度。微半球谐振子的刚度不对称可以通过频率调谐和正交误差控制进行解决;而微半球谐振子的阻尼不对称会导致全角模式微半球谐振陀螺在较低转速输入情况下产生角度闭锁效应(速率“死区”),而在高转速输入的情况下依然存在阻尼失配导致的角度漂移误差。为解决阻尼失配导致的速率阈值以及角度漂移问题,本发明提出了一种便于操作且能在线补偿微半球谐振子阻尼失配的方法及***。
发明内容
本发明针对现有技术中的不足,提供一种基于驻波伪进动的全角模式陀螺阻尼失配补偿方法及***,消除全角模式微半球谐振陀螺因阻尼不对称导致的角度漂移误差。
为实现上述目的,本发明采用以下技术方案:
一种基于驻波伪进动的全角模式陀螺阻尼失配补偿方法,包括以下步骤:
步骤1、构建微半球谐振陀螺的全角模式运动方程;
步骤2、利用微半球谐振陀螺的全角模式运动方程设计全角模式微半球谐振陀螺的基本控制环路,所述基本控制环路包括能量维持环路、正交抑制环路和频率跟踪环路;所述能量维持环路输出能量控制信号;
步骤3、估算驻波进动角度,通过修正角度函数扩展驻波进动角度的范围;
步骤4、设置初始伪进动作用力,用初始伪进动作用力驱动陀螺驻波伪进动,并在伪进动的基础上叠加外界输入角速度通过哥氏效应引起的驻波进动,建立包含驻波进动角度的驻波进动角度传递方程,计算获取最终的总驻波进动角度;
步骤5、将能量控制信号和总驻波进动角度引入自适应滤波器中在线辨识阻尼失配误差参数;
步骤6、利用阻尼失配误差参数构造阻尼补偿力,在阻尼补偿力基础上叠加初始伪进动作用力构成总作用力;利用总作用力消除陀螺的阻尼失配误差。
为优化上述技术方案,采取的具体措施还包括:
进一步地,步骤1中,所述微半球谐振陀螺的全角模式运动方程具体为:
式中,τ为谐振子阻尼衰减时间常数,Δ(1/τ)是阻尼失配误差,Δω为谐振子的频率裂解,ω为谐振子的平均谐振频率,θ为驻波进动角度,θω为谐振子频率主轴的方位角,θτ为谐振子阻尼主轴的方位角,E为谐振子驻波的振动能量,表示振动能量一阶导数,Q为正交误差信号,/>表示正交误差一阶导数,fas为能量控制信号,表示将谐振子驻波的能量幅度维持到基准幅度E0所需的作用力,fqc为将正交误差Q抑制到零所需的作用力,δφ为相位误差,/>表示相位信号一阶导数,/>表示相位误差一阶导数。
进一步地,步骤2中,所述能量维持环路将谐振子驻波的能量E的幅度维持到基准幅度E0,所述正交抑制环路将正交误差信号Q实时抑制为0,所述频率跟踪环路将相位误差量δφ抑制为0使谐振子振动始终处于谐振状态。
进一步地,步骤3具体为:利用下式估算出全角模式微半球谐振陀螺的驻波进动角度θ:
式中,S和R为表征进动角度函数的参数信息;
通过以下修正角度函数来扩展驻波进动角度θ的范围:
式中,cx、sx、cy、sy为x轴方向上的谐振子驻波振动位移和y轴方向上的谐振子驻波振动位移通过同相和正交解调出的四个缓变量信号,具体为,cx和sx分别表示x轴位移变化信号的余弦分量和正弦分量,cy和sy分别表示y轴位移变化信号的余弦分量和正弦分量。
进一步地,步骤4具体为:
设置初始伪进动作用力用初始伪进动作用力/>驱动陀螺驻波伪进动,并在伪进动的基础上叠加外界输入角速度Ω通过哥氏效应引起的驻波进动,用驻波进动角度传递方程表示为:
式中,为振型进动角速度,θ为驻波进动角度,κ为角增益,Ω是外界输入角速度,为初始伪进动作用力;
根据驻波进动角度传递方程计算获取最终的总驻波进动角度θ。
进一步地,步骤5具体为:
步骤5.1、将能量控制信号和总驻波进动角度引入自适应滤波器中,利用自适应滤波器构建阻尼失配误差参数和θτ的在线辨识模型:
式中,m1、m2和m3为自适应滤波器权系数,u1、u2和u3为输入变量,i为迭代次数,
步骤5.2、构造辨识模型的权系数向量m=[m1 m2 m3]T和输入变量的向量u=[u1 u2u3]T,自适应滤波器估计输出量由此得到参数迭代方程:
式中,i是迭代次数;efas(i)为估计误差;λ为收敛因子,是自适应滤波器第i次迭代时估计的能量控制信号;fas(i)是自适应滤波器第i次迭代时输入的能量控制信号,mn(i)(n=1,2,3)是自适应滤波器权系数,mn(i+1)是下一次迭代的自适应滤波器权系数;
步骤5.3、迭代更新参数迭代方程,当趋于0时,则参数迭代方程中的m1(i)、m2(i)和m3(i)均已收敛,此时有:
由上式在线估计出阻尼失配误差参数:
式中,和θτ为阻尼失配误差参数,θτ为谐振子阻尼主轴的方位角,τ为谐振子阻尼衰减时间常数,ω为谐振子的平均谐振频率,E为谐振子驻波的能量。
进一步地,步骤6具体为:
用阻尼失配误差参数和θτ构造阻尼补偿力/>
在阻尼补偿力的基础上叠加初始伪进动作用力/>得总作用力/>
利用总作用力驱动控制陀螺以消除陀螺的阻尼失配误差。
本发明还提出了一种基于驻波伪进动的全角模式陀螺阻尼失配补偿***,包括微半球谐振陀螺表头、前端C/V转换电路、解调滤波电路、ADC转换电路、DAC转换电路、FPGA数字处理平台以及供电电路;
所述微半球谐振陀螺表头包含x模态对应的正极x+和负极x-及y模态对应的正极y+和负极y-,用于检测两模态的振动位移;
所述FPGA数字处理平台包括能量维持环路、正交抑制环路、频率跟踪环路、调制分解模块、阻尼失配在线补偿模块和椭圆参数计算模块;所述阻尼失配在线补偿模块包括自适应滤波器;
所述能量维持环路将谐振子驻波的能量E的幅度维持到基准幅度E0,所述正交抑制环路将正交误差信号Q实时抑制为0,所述频率跟踪环路将相位误差量δφ抑制为0使谐振子振动始终处于谐振状态;
所述前端C/V转换电路将由微半球谐振子检测电极拾取到的x模态检测轴和y模态检测轴的两路位移变化信号转化为电压变化信号;
所述解调滤波电路将转换的两路电压信号解调为cx、sx、cy和sy四种缓变量信号,其中,cx和sx分别表示x轴位移变化信号的余弦分量和正弦分量,cy和sy分别表示y轴位移变化信号的余弦分量和正弦分量;
所述ADC转换电路将前述cx、sx、cy和sy四种缓变量信号转化为数字信号;
所述椭圆参数计算模块将cx、sx、cy、sy四种缓变量信号代入椭圆参数方程中,得谐振子驻波的能量E、正交误差信号Q、相位误差信号L和进动角度θ,将谐振子驻波的能量E、正交误差信号Q和相位误差信号L分别引入能量维持环路、正交抑制环路和频率跟踪环路中,分别获取能量控制信号fas、将正交误差信号Q抑制到零所需的作用力fqc和谐振子的平均谐振频率ω;
所述阻尼失配在线补偿模块将能量控制信号fas和总驻波进动角度θ引入到自适应滤波器模块中在线辨识出阻尼失配误差参数和θτ,再由阻尼失配误差参数构造阻尼补偿力,在阻尼补偿力基础上叠加初始伪进动作用力/>构成总作用力/>
所述调制分解模块将能量控制信号fas、将正交误差信号Q抑制到零所需的作用力fqc和总作用力通过调制和分解分别生成x模态和y模态的驱动信号,再经DAC转换电路后将x模态驱动信号fx施加到x模态对应的驱动电极上,将y模态驱动信号fy施加到y模态对应的驱动电极上;所述驱动电极包括x模态对应的正极dx+和负极dx-及y模态对应的正极dy+和负极dy-;利用交叉刚度调谐电压和频率调谐电压抑制频率裂解以达到与微半球谐振陀螺的频率匹配,并与经DAC转换电路数模转换得到的交流电压进行合成,再经过高压放大电路后直接施加到x模态和y模态的驱动电极上,产生的静电力对微半球谐振陀螺进行驱动控制。
本发明的有益效果是:利用阻尼失配信息构造补偿力实现阻尼失配误差在线实时补偿,消除微半球谐振陀螺的阻尼各向异性的影响,降低速率阈值,减小角度误差,提高全角陀螺仪的角度测量精度。
附图说明
图1为全角陀螺阻尼失配误差在线补偿***结构图。
具体实施方式
现在结合附图对本发明作进一步详细的说明。
在一实施例中,本发明提出了一种基于驻波伪进动的全角模式陀螺阻尼失配补偿方法,该方法包括以下步骤:
步骤1.获取微半球谐振陀螺的全角模式运动方程:利用Lynch提出的“平均法”推导如下式所示的基本运动方程为:
上式中,τ为谐振子阻尼衰减时间常数,Δ(1/τ)是阻尼失配(不对称)误差,Δω为谐振子的频率裂解,ω为谐振子的平均谐振频率,θ为驻波的进动角度,θω为谐振子频率主轴的方位角,θτ为谐振子阻尼主轴的方位角,E为谐振子驻波(振型)的振动能量信号,表示振动能量一阶导数,Q为正交误差信号,/>表示正交误差一阶导数,fas为将幅度E维持到基准E0所需的作用力,fqc为将正交误差Q抑制到零所需的作用力,δφ为相位误差,/>表示相位信号一阶导数,/>表示相位误差一阶导数,fas设置为0。
步骤2.设计全角模式微半球谐振陀螺基本控制环路并估算驻波进动角度:利用所述全角模式基本运动方程,设计出微半球谐振陀螺全角模式功能所需的三个基本控制环路(即能量维持环路、正交抑制环路、频率跟踪环路)。所述能量维持环路是保持谐振子驻波振动的幅度为某固定值,正交抑制环路是将正交误差实时抑制为0,频率跟踪环路使得谐振子振动始终处于谐振状态。当全角微半球谐振陀螺工作在稳定状态时,能量维持环路使得微半球谐振陀螺的能量幅度E维持到E0、正交抑制环路将正交误差信号Q抑制到0、频率跟踪环路将相位误差量δφ抑制0。通过上述三个基本控制环路,可实现微半球谐振陀螺的全角功能,进而可利用下式估算出全角模式微半球谐振陀螺的进动角度为:
式中,S、R为表征进动角度函数的参数信息,由于tan-1函数的输出范围是[-π,π],所以θ的范围是[-π/2,π/2],它没有覆盖θ的整个[-π,π]范围。因此,在实际中,通过以下修正角度函数来扩展进动角度θ的范围(全角模式微半球谐振陀螺处于稳定状态时,正交误差信号Q被抑制到0):
式中,cx、sx、cy、sy为x轴方向上的谐振子驻波振动位移和y轴方向上的谐振子驻波振动位移通过同相和正交解调出的四个缓变量信号,具体为,cx和sx分别表示x轴位移变化信号的余弦分量和正弦分量,cy和sy分别表示y轴位移变化信号的余弦分量和正弦分量。
步骤3.利用作用力fqs驱动陀螺驻波伪进动:设置初始伪进动作用力用初始伪进动作用力/>使得谐振子的振型(驻波)进行伪(虚拟)进动,并叠加外界角速度通过哥氏效应引起的驻波进动(真进动或物理进动),用驻波进动角度传递方程表示为:
式中,为振型进动角速度,θ为驻波进动角度,κ为角增益,Ω是外界输入角速度,是设置驻波伪进动初始速度所需作用力(在常规全角模式下,由于全角模式下允许谐振子自由进动,故而设置fqs=0;这里为使谐振子驻波进动走出速率死区(阈值)而设置成初始作用力/>)。
根据驻波进动角度传递方程计算获取最终的总驻波进动角度θ。
真实的进动角度可通过最终驻波进动角度祛除伪进动角度而获得。驻波伪进动方式一方面可以使得谐振子驻波走出因阻尼失配误差导致的速率死区,另一方面可在无速率转台情况下依然可以使得驻波进动,为自适应滤波辨识参数提供条件。
步骤4.在线辨识阻尼失配误差参数:根据能量控制方程可知,当谐振子驻波的能量E在控制器作用下维持为恒定值E0后,应有则应有:
则可利用自适应滤波方法从上式能量环路的控制变量fas中在线辨识(解调)出阻尼失配误差参数信息和θτ。
具体在线辨识阻尼失配信息的实施步骤为:
(1)构建自适应滤波在线辨识模型:当通过作用力fqs使得全角微半球谐振陀螺驻波伪进动时,利用自适应滤波器构建和θτ的在线辨识模型如下:
式中,m1、m2、m3为辨识模型的权系数(待估计参数),u1、u2、u3为输入变量。
(2)构造参数迭代方程:
可构造向量m=[m1 m2 m3]T,u=[u1 u2 u3]T,则应有由此可得:
式中,i是迭代次数;为估计误差;λ为收敛因子(更新步长);/>是自适应滤波器第i次迭代时估计的能量控制信号;fas(i)是自适应滤波器第i次迭代时输入的能量控制信号,mn(i)(n=1,2,3)是自适应滤波器权系数;mn(i+1)是下一次迭代的自适应滤波器权系数。
(3)在线估计出阻尼失配参数
当趋于0时,则上式迭代方程中的m1(i)、m2(i)和m3(i)均可认为已收敛,此时应有:
由上式可在线估计出阻尼失配信息:
步骤5.构建阻尼失配误差补偿力:利用上式自适应滤波器在线估计出的阻尼失配参数信息,可进一步构造阻尼补偿力
将构造出的阻尼补偿力代入微半球谐振陀螺驻波进动角度的传递方程中,且全角模式陀螺正常工作时(Q≈0,E=E0),则应有阻尼失配误差补偿后的驻波进动角度传递方程为:
由此根据上述分析,可知经构造的补偿力补偿后,由阻尼失配引入的角度漂移误差可被抑制。
为克服由阻尼失配误差引入的速率“死区”(阈值)效应,可利用步骤3所述的驻波伪进动方式,即施加常值作用力驱使驻波远离速率死区,使得步骤4中所述的在线辨识阻尼失配误差参数模块在低转速条件下能正常工作。在驻波伪进动方式作用下,可知总作用力/>进一步变化为:
式中,为实现驻波伪进动的初始作用力,总作用力/>由伪进动初始作用力与阻尼补偿力项/>共同构成。
将上式由伪进动初始作用力和阻尼补偿力一共构成的总作用力代入陀螺驻波进动角度的传递方程中,则可得包含驻波伪进动的驻波总进动角速度输出为:
式中,为伪(虚拟)旋转导致陀螺驻波进动的初始角速度(常量),θt为由外界输入旋转角速度作用引起的真实驻波进动角度。上式表明,陀螺驻波进动角度θ的变化只与外界输入角速度Ω有关,而不再与阻尼失配参数/>和θτ相关,由此说明了通过本方案消除了阻尼失配误差对陀螺驻波进动角度的影响。
此外,真实驻波进动角度(外界输入角速度导致驻波进动的角度)可通过总进动角度减去伪进动角度来获取,即经阻尼失配误差补偿后的真实驻波进动角度:θt=θ-∫Ωvirdt=θ-θvir。
在另一实施例中,本发明提出了一种基于驻波伪进动的全角模式陀螺阻尼失配补偿***,其结构如图1所示,包括微半球谐振陀螺表头、前端C/V转换电路、解调滤波电路、ADC转换电路、DAC转换电路、FPGA数字处理平台以及供电电路;
所述微半球谐振陀螺表头包含x模态对应的正极x+和负极x-及y模态对应的正极y+和负极y-,用于检测两模态的振动位移;
所述FPGA数字处理平台包括能量维持环路、正交抑制环路、频率跟踪环路、调制分解模块、阻尼失配在线补偿模块和椭圆参数计算模块;所述阻尼失配在线补偿模块包括自适应滤波器;
所述能量维持环路将谐振子驻波的能量E的幅度维持到基准幅度E0,所述正交抑制环路将正交误差信号Q实时抑制为0,所述频率跟踪环路将相位误差量δφ抑制为0使谐振子振动始终处于谐振状态;
所述前端C/V转换电路将由微半球谐振子检测电极拾取到的x模态检测轴和y模态检测轴的两路位移变化信号转化为电压变化信号;
所述解调滤波电路将转换的两路电压信号解调为cx、sx、cy和sy四种缓变量信号,其中,cx和sx分别表示x轴位移变化信号的余弦分量和正弦分量,cy和sy分别表示y轴位移变化信号的余弦分量和正弦分量;
所述ADC转换电路将前述cx、sx、cy和sy四种缓变量信号转化为数字信号;
所述椭圆参数计算模块将cx、sx、cy、sy四种缓变量信号代入椭圆参数方程中,得谐振子驻波的能量E、正交误差信号Q、相位误差信号L和进动角度θ,将谐振子驻波的能量E、正交误差信号Q和相位误差信号L分别引入能量维持环路、正交抑制环路和频率跟踪环路中,分别获取能量控制信号fas、将正交误差信号Q抑制到零所需的作用力fqc和谐振子的平均谐振频率ω;
所述阻尼失配在线补偿模块将能量控制信号fas和总驻波进动角度θ引入到自适应滤波器模块中在线辨识出阻尼失配误差参数和θτ,再由阻尼失配误差参数构造阻尼补偿力,在阻尼补偿力基础上叠加初始伪进动作用力/>构成总作用力/>
所述调制分解模块将能量控制信号fas、将正交误差信号Q抑制到零所需的作用力fqc和总作用力通过调制和分解分别生成x模态和y模态的驱动信号,再经DAC转换电路后将x模态驱动信号fx施加到x模态对应的驱动电极上,将y模态驱动信号fy施加到y模态对应的驱动电极上;所述驱动电极包括x模态对应的正极dx+和负极dx-及y模态对应的正极dy+和负极dy-;利用交叉刚度调谐电压和频率调谐电压抑制频率裂解以达到与微半球谐振陀螺的频率匹配,并与经DAC转换电路数模转换得到的交流电压进行合成,再经过高压放大电路后直接施加到x模态和y模态的驱动电极上,产生的静电力对微半球谐振陀螺进行驱动控制。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。
Claims (8)
1.一种基于驻波伪进动的全角模式陀螺阻尼失配补偿方法,其特征在于,包括以下步骤:
步骤1、构建微半球谐振陀螺的全角模式运动方程;
步骤2、利用微半球谐振陀螺的全角模式运动方程设计全角模式微半球谐振陀螺的基本控制环路,所述基本控制环路包括能量维持环路、正交抑制环路和频率跟踪环路;所述能量维持环路输出能量控制信号;
步骤3、估算驻波进动角度,通过修正角度函数扩展驻波进动角度的范围;
步骤4、设置初始伪进动作用力,用初始伪进动作用力驱动陀螺驻波伪进动,并在伪进动的基础上叠加外界输入角速度通过哥氏效应引起的驻波进动,建立包含驻波进动角度的驻波进动角度传递方程,计算获取最终的总驻波进动角度;
步骤5、将能量控制信号和总驻波进动角度引入自适应滤波器中在线辨识阻尼失配误差参数;
步骤6、利用阻尼失配误差参数构造阻尼补偿力,在阻尼补偿力基础上叠加初始伪进动作用力构成总作用力;利用总作用力消除陀螺的阻尼失配误差。
2.如权利要求1所述的基于驻波伪进动的全角模式陀螺阻尼失配补偿方法,其特征在于,步骤1中,所述微半球谐振陀螺的全角模式运动方程具体为:
式中,τ为谐振子阻尼衰减时间常数,Δ(1/τ)是阻尼失配误差,Δω为谐振子的频率裂解,ω为谐振子的平均谐振频率,θ为驻波进动角度,θω为谐振子频率主轴的方位角,θτ为谐振子阻尼主轴的方位角,E为谐振子驻波的振动能量,表示振动能量一阶导数,Q为正交误差信号,/>表示正交误差一阶导数,fas为能量控制信号,表示将谐振子驻波的能量幅度维持到基准幅度E0所需的作用力,fqc为将正交误差Q抑制到零所需的作用力,δφ为相位误差,/>表示相位信号一阶导数,/>表示相位误差一阶导数,fas设置为0。
3.如权利要求1所述的基于驻波伪进动的全角模式陀螺阻尼失配补偿方法,其特征在于,步骤2中,所述能量维持环路将谐振子驻波的能量E的幅度维持到基准幅度E0,所述正交抑制环路将正交误差信号Q实时抑制为0,所述频率跟踪环路将相位误差量δφ抑制为0使谐振子振动始终处于谐振状态。
4.如权利要求1所述的基于驻波伪进动的全角模式陀螺阻尼失配补偿方法,其特征在于,步骤3具体为:利用下式估算出全角模式微半球谐振陀螺的驻波进动角度θ:
式中,S和R为表征进动角度函数的参数信息;
通过以下修正角度函数来扩展驻波进动角度θ的范围:
式中,cx、sx、cy、sy为x轴方向上的谐振子驻波振动位移和y轴方向上的谐振子驻波振动位移通过同相和正交解调出的四个缓变量信号,具体为,cx和sx分别表示x轴位移变化信号的余弦分量和正弦分量,cy和sy分别表示y轴位移变化信号的余弦分量和正弦分量。
5.如权利要求1所述的基于驻波伪进动的全角模式陀螺阻尼失配补偿方法,其特征在于,步骤4具体为:
设置初始伪进动作用力用初始伪进动作用力/>驱动陀螺驻波伪进动,并在伪进动的基础上叠加外界输入角速度Ω通过哥氏效应引起的驻波进动,用驻波进动角度传递方程表示为:
式中,为振型进动角速度,θ为驻波进动角度,κ为角增益,Ω是外界输入角速度,/>为初始伪进动作用力;
根据驻波进动角度传递方程计算获取最终的总驻波进动角度θ。
6.如权利要求1所述的基于驻波伪进动的全角模式陀螺阻尼失配补偿方法,其特征在于,步骤5具体为:
步骤5.1、将能量控制信号和总驻波进动角度引入自适应滤波器中,利用自适应滤波器构建阻尼失配误差参数和θτ的在线辨识模型:
式中,m1、m2和m3为自适应滤波器权系数,u1、u2和u3为输入变量,i为迭代次数,
步骤5.2、构造辨识模型的权系数向量m=[m1 m2 m3]T和输入变量的向量u=[u1 u2 u3]T,自适应滤波器估计输出量由此得到参数迭代方程:
式中,i是迭代次数;为估计误差;λ为收敛因子,/>是自适应滤波器第i次迭代时估计的能量控制信号;fas(i)是自适应滤波器第i次迭代时输入的能量控制信号,mn(i)(n=1,2,3)是自适应滤波器权系数,mn(i+1)是下一次迭代的自适应滤波器权系数;
步骤5.3、迭代更新参数迭代方程,当趋于0时,则参数迭代方程中的m1(i)、m2(i)和m3(i)均已收敛,此时有:
由上式在线估计出阻尼失配误差参数:
式中,和θτ为阻尼失配误差参数,θτ为谐振子阻尼主轴的方位角,τ为谐振子阻尼衰减时间常数,ω为谐振子的平均谐振频率,E为谐振子驻波的能量。
7.如权利要求6所述的基于驻波伪进动的全角模式陀螺阻尼失配补偿方法,其特征在于,步骤6具体为:
用阻尼失配误差参数和θτ构造阻尼补偿力/>
在阻尼补偿力的基础上叠加初始伪进动作用力/>得总作用力/>
利用总作用力驱动控制陀螺以消除陀螺的阻尼失配误差。
8.一种基于驻波伪进动的全角模式陀螺阻尼失配补偿***,其特征在于,包括微半球谐振陀螺表头、前端C/V转换电路、解调滤波电路、ADC转换电路、DAC转换电路、FPGA数字处理平台以及供电电路;
所述微半球谐振陀螺表头包含x模态对应的正极x+和负极x-及y模态对应的正极y+和负极y-,用于检测两模态的振动位移;
所述FPGA数字处理平台包括能量维持环路、正交抑制环路、频率跟踪环路、调制分解模块、阻尼失配在线补偿模块和椭圆参数计算模块;所述阻尼失配在线补偿模块包括自适应滤波器;
所述能量维持环路将谐振子驻波的能量E的幅度维持到基准幅度E0,所述正交抑制环路将正交误差信号Q实时抑制为0,所述频率跟踪环路将相位误差量δφ抑制为0使谐振子振动始终处于谐振状态;
所述前端C/V转换电路将由微半球谐振子检测电极拾取到的x模态检测轴和y模态检测轴的两路位移变化信号转化为电压变化信号;
所述解调滤波电路将转换的两路电压信号解调为cx、sx、cy和sy四种缓变量信号,其中,cx和sx分别表示x轴位移变化信号的余弦分量和正弦分量,cy和sy分别表示y轴位移变化信号的余弦分量和正弦分量;
所述ADC转换电路将前述cx、sx、cy和sy四种缓变量信号转化为数字信号;
所述椭圆参数计算模块将cx、sx、cy、sy四种缓变量信号代入椭圆参数方程中,得谐振子驻波的能量E、正交误差信号Q、相位误差信号L和进动角度θ,将谐振子驻波的能量E、正交误差信号Q和相位误差信号L分别引入能量维持环路、正交抑制环路和频率跟踪环路中,分别获取能量控制信号fas、将正交误差信号Q抑制到零所需的作用力fqc和谐振子的平均谐振频率ω;
所述阻尼失配在线补偿模块将能量控制信号fas和总驻波进动角度θ引入到自适应滤波器模块中在线辨识出阻尼失配误差参数和θτ,再由阻尼失配误差参数构造阻尼补偿力,在阻尼补偿力基础上叠加初始伪进动作用力/>构成总作用力/>
所述调制分解模块将能量控制信号fas、将正交误差信号Q抑制到零所需的作用力fqc和总作用力通过调制和分解分别生成x模态和y模态的驱动信号,再经DAC转换电路后将x模态驱动信号fx施加到x模态对应的驱动电极上,将y模态驱动信号fy施加到y模态对应的驱动电极上;所述驱动电极包括x模态对应的正极dx+和负极dx-及y模态对应的正极dy+和负极dy-;利用交叉刚度调谐电压和频率调谐电压抑制频率裂解以达到与微半球谐振陀螺的频率匹配,并与经DAC转换电路数模转换得到的交流电压进行合成,再经过高压放大电路后直接施加到x模态和y模态的驱动电极上,产生的静电力对微半球谐振陀螺进行驱动控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310740886.2A CN116772818A (zh) | 2023-06-21 | 2023-06-21 | 基于驻波伪进动的全角模式陀螺阻尼失配补偿方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310740886.2A CN116772818A (zh) | 2023-06-21 | 2023-06-21 | 基于驻波伪进动的全角模式陀螺阻尼失配补偿方法及*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116772818A true CN116772818A (zh) | 2023-09-19 |
Family
ID=88005943
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310740886.2A Pending CN116772818A (zh) | 2023-06-21 | 2023-06-21 | 基于驻波伪进动的全角模式陀螺阻尼失配补偿方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116772818A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117029882A (zh) * | 2023-10-10 | 2023-11-10 | 北京航空航天大学 | 一种全角半球谐振陀螺检测增益不对称误差的标定方法 |
CN117664186A (zh) * | 2024-02-01 | 2024-03-08 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺驻波角度校准方法 |
CN117968653A (zh) * | 2024-03-28 | 2024-05-03 | 中国船舶集团有限公司第七〇七研究所 | 基于闭合回路的谐振陀螺角度计算方法及*** |
-
2023
- 2023-06-21 CN CN202310740886.2A patent/CN116772818A/zh active Pending
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117029882A (zh) * | 2023-10-10 | 2023-11-10 | 北京航空航天大学 | 一种全角半球谐振陀螺检测增益不对称误差的标定方法 |
CN117029882B (zh) * | 2023-10-10 | 2023-12-22 | 北京航空航天大学 | 一种全角半球谐振陀螺检测增益不对称误差的标定方法 |
CN117664186A (zh) * | 2024-02-01 | 2024-03-08 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺驻波角度校准方法 |
CN117664186B (zh) * | 2024-02-01 | 2024-05-10 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺驻波角度校准方法 |
CN117968653A (zh) * | 2024-03-28 | 2024-05-03 | 中国船舶集团有限公司第七〇七研究所 | 基于闭合回路的谐振陀螺角度计算方法及*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110865580B (zh) | 基于时分复用的半球谐振陀螺全差分控制***及控制方法 | |
CN116772818A (zh) | 基于驻波伪进动的全角模式陀螺阻尼失配补偿方法及*** | |
CN111578923B (zh) | 一种谐振式陀螺闭环控制方法与*** | |
CN112697123B (zh) | 一种半球谐振陀螺的工作模式切换控制方法及*** | |
CN113670340B (zh) | 基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及*** | |
CN111536993B (zh) | 一种振动陀螺电极角度误差的辨识与补偿方法及*** | |
CN113686356B (zh) | 基于rbf网络的谐振陀螺零偏在线自补偿***及方法 | |
CN113074756B (zh) | 一种速率积分型振动陀螺的误差补偿方法和装置 | |
CN115638780B (zh) | 一种谐振陀螺振动位移提取方法、控制***及谐振陀螺 | |
CN116026299B (zh) | 谐振陀螺静电修调控制方法及*** | |
CN114509057A (zh) | 一种谐振陀螺仪全角模式控制方法 | |
CN114440933B (zh) | 一种谐振陀螺仪旋转调制标度自校正*** | |
CN116086485A (zh) | 半球谐振陀螺误差力补偿方法和装置 | |
CN115407657A (zh) | 输入饱和下的半球谐振陀螺智能控制方法 | |
CN114858184A (zh) | 一种半球谐振子参数辨识方法 | |
CN109827594B (zh) | 基于面内模态旋转的轴对称陀螺仪零位自补偿***及方法 | |
CN112525180A (zh) | 一种基于混合重复控制器的谐波振动力矩抑制方法 | |
CN111854747A (zh) | 一种载体大机动情况下的dvl辅助sins粗对准方法 | |
CN113739806A (zh) | 利用参数识别的惯导***阻尼方法 | |
CN117170234A (zh) | 一种全角模式下的半球谐振陀螺鲁棒智能控制方法 | |
CN117110643A (zh) | 速率积分半球谐振陀螺角速率输出方法 | |
CN116610030A (zh) | 一种全角模式下的半球谐振陀螺死区补偿与抗干扰控制回路设计方法 | |
CN116499492A (zh) | 一种基于dvl辅助的匀速直航下捷联罗经粗对准方法 | |
CN114608614A (zh) | 基于主动驱动旋转的全角模式半球谐振陀螺仪在线调谐方法 | |
CN116046016A (zh) | 一种半球谐振陀螺控制电路相位滞后补偿方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |