CN115235444B - 一种用于测量全角半球谐振陀螺的控制回路带宽的方法 - Google Patents
一种用于测量全角半球谐振陀螺的控制回路带宽的方法 Download PDFInfo
- Publication number
- CN115235444B CN115235444B CN202210854986.3A CN202210854986A CN115235444B CN 115235444 B CN115235444 B CN 115235444B CN 202210854986 A CN202210854986 A CN 202210854986A CN 115235444 B CN115235444 B CN 115235444B
- Authority
- CN
- China
- Prior art keywords
- amplitude
- bandwidth
- frequency
- control loop
- disturbance
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/56—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
- G01C19/567—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces using the phase shift of a vibration node or antinode
- G01C19/5691—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces using the phase shift of a vibration node or antinode of essentially three-dimensional vibrators, e.g. wine glass-type vibrators
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
Abstract
本发明提供了一种用于测量全角半球谐振陀螺的控制回路带宽的方法,包括:将扰动信号引入全角半球谐振陀螺的幅值控制回路中,获取所述幅值控制回路中若干组椭圆参数a的幅值信号;基于若干组所述幅值信号,获取扰动‑输出闭环传递函数的幅频特性模型;识别所述幅频特性模型中预设位置对应的频率,获取输入‑输出控制系统的带宽频率,基于所述带宽频率获得所述控制回路带宽。本发明克服了在实际应用过程中全角半球谐振陀螺的控制回路带宽难以测量的问题。
Description
技术领域
本发明属于惯性仪表控制技术领域,尤其涉及一种用于测量全角半球谐振陀螺的控制回路带宽的方法。
背景技术
半球谐振陀螺是一种基于科氏效应的固体波动陀螺。目前,半球谐振陀螺具有两种控制方法,分别为力平衡模式与全角模式。力平衡模式需要通过驱动力抑制驻波方位角进动,其动态测量范围会受到驱动力的限制,为闭环模式;而全角模式下驻波方位角能够自由进动,陀螺仪具有无限大的带宽和动态测量范围,为开环模式。
尽管以全角模式工作的陀螺仪为开环模式,但是其内部的幅值、正交控制回路仍为闭环控制。因此,需要考虑闭环控制回路的带宽。控制回路的带宽取决于PID控制器参数以及半球谐振子特征参数,而半球谐振子具有的高品质因数会导致较大的时间常数,进而引起闭环控制回路的滞后。尽管其不会限制全角陀螺仪的测量范围,但是当外界输入转速较大时,控制系统的滞后会使得幅值控制回路与正交控制回路无法快速跟踪椭圆参量a与q的变化。而当椭圆参量a与q存在较大波动时,解算角度的变化量中的阻尼误差项与刚度误差项均会增大,这将会直接降低陀螺仪的量测精度。
在实际应用过程中,以现有技术测量控制回路带宽的方法如下:将闭环控制回路中的常值设定改为正弦信号输入,通过输入多个频率的正弦信号并测量相应的响应信号幅值,并绘制出控制系统的幅频特性曲线,进而得到控制系统带宽。该方法不仅需要对陀螺仪的运行程序进行较大的修改,并且需要消耗较多的芯片资源来生成正弦信号,还需要分别测试幅值、正交控制回路的带宽,因此实施起来有诸多不便。
发明内容
为解决上述技术问题,本发明提出了一种用于测量全角半球谐振陀螺的控制回路带宽的方法,克服了在实际应用过程中全角半球谐振陀螺的控制回路带宽难以测量的问题。
为实现上述目的,本发明提供了一种用于测量全角半球谐振陀螺的控制回路带宽的方法,包括:
将扰动信号引入全角半球谐振陀螺的幅值控制回路中,获取所述幅值控制回路中若干组椭圆参数的幅值信号;
基于若干组所述幅值信号,获取扰动-输出闭环传递函数的幅频特性模型;
识别所述幅频特性模型中预设位置对应的频率,获取输入-输出控制系统的带宽频率,基于所述带宽频率获得所述控制回路带宽。
可选地,获取所述幅值控制回路中若干组椭圆参数的幅值信号包括:
将半球谐振陀螺固联在单轴转台上,以全角模式运行所述半球谐振陀螺,获取全角半球谐振陀螺的所述幅值控制回路;
调整所述幅值控制回路中检测通道增益系数,获取此时的幅值信号;
将所述扰动信号引入所述幅值控制回路中,基于预设转台转速运行所述半球谐振陀螺,获取若干组所述幅值信号。
可选地,所述幅值信号的表达式为:
其中,ac为解算得到的幅值信号,a为椭圆参量,gx与gy均为检测通道增益系数,θ为驻波方位角。
可选地,所述扰动-输出闭环传递函数基于所述扰动信号引入所述幅值控制回路中获得;
所述扰动-输出闭环传递函数的表达式为:
其中,C(s)为输出信号,N(s)为扰动信号,G(s)为开环传递函数,τ为阻尼时间常数,s为微分算子,K为开环传递函数的增益系数,KP为比例控制系数,KI为积分控制系数,ΦN(s)为扰动-输出闭环传递函数。
可选地,所述扰动-输出闭环传递函数的幅频特性为:
其中,G(jω)为开环传递函数,ω为复频域的信号角频率,j为虚数,s=jω。
可选地,所述幅频特性模型包括横轴与纵轴;
所述横轴为外界输入旋转频率,所述纵轴为所述扰动信号的响应幅值。
可选地,获取输入-输出控制系统的带宽频率包括:
识别所述幅频特性模型中预设位置对应的频率,获得扰动-输出控制系统的带宽频率;
将所述扰动-输出控制系统的带宽频率,近似为输入-输出控制系统的带宽频率。
可选地,所述控制回路带宽的表达式为:
其中,ωNb为扰动-输出控制系统的带宽频率。
与现有技术相比,本发明具有如下优点和技术效果:
本发明中首次揭示了全角半球谐振陀螺控制回路的带宽对于陀螺仪控制精度的影响,并且针对此控制回路提出了一种带宽测量方法,能够准确地测量幅值控制回路的带宽频率。该方法不需要消耗芯片资源来生成正弦信号,因此也不需要对运行程序进行任何的修改,并且该方法可以通过一次测试同时得到幅值、正交控制回路的带宽,而不需要分别测试幅值、正交控制回路的带宽,简化了测试方法,提升了测试效率。本发明为全角半球谐振陀螺仪提出了一种新的控制器性能指标以及一种有效的控制系统带宽测量方法。
附图说明
构成本申请的一部分的附图用来提供对本申请的进一步理解,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1为本发明实施例的一种用于测量全角半球谐振陀螺的控制回路带宽的方法流程示意图;
图2为本发明实施例的全角半球谐振陀螺的控制系统框图;
图3为本发明实施例的幅值控制回路的闭环传递函数框图;
图4为本发明实施例的对于图3进行化简后的闭环传递函数框图;
图5为本发明实施例的调整检测通道的增益系数gx与gy后,ac随着θ呈正弦变化的曲线图;
图6为本发明实施例的引入扰动信号的控制系统闭环传递函数框图;
图7为本发明实施例的扰动-输出控制系统闭环传递函数的波特图;
图8为本发明实施例的输入-输出控制系统闭环传递函数的波特图。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本申请。
需要说明的是,在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行,并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
实施例
如图1所示,本实施例提供了一种用于测量全角半球谐振陀螺的控制回路带宽的方法,包括:
将扰动信号N(s)引入全角半球谐振陀螺的幅值控制回路中,获取所述幅值控制回路中若干组椭圆参数a的幅值信号ac;
基于若干组所述幅值信号ac,获取扰动-输出闭环传递函数ΦN(s)的幅频特性模型;
识别所述幅频特性模型中预设位置对应的频率,获取输入-输出控制系统的带宽频率ωRb,基于所述带宽频率获得所述控制回路带宽。
进一步地,获取所述幅值控制回路中若干组椭圆参数a的幅值信号ac包括:
将半球谐振陀螺固联在单轴转台上,以全角模式运行所述半球谐振陀螺,获取全角半球谐振陀螺的所述幅值控制回路;
调整所述幅值控制回路中检测通道增益系数gx与gy,获取此时的幅值信号ac;
将扰动信号N(s)引入所述幅值控制回路中,基于预设转台转速运行所述半球谐振陀螺,获取若干组所述幅值信号ac。
进一步地,所述幅值信号ac的表达式为:
其中,ac为解算得到的幅值信号,a为椭圆参量,gx与gy均为检测通道增益系数,θ为驻波方位角。
进一步地,所述扰动-输出闭环传递函数ΦN(s)基于所述扰动信号N(s)引入所述幅值控制回路中获得。
进一步地,所述幅频特性模型包括横轴与纵轴;
所述横轴为外界输入旋转频率,所述纵轴为扰动信号N(s)的响应幅值。
进一步地,获取输入-输出控制系统的带宽频率ωRb包括:
识别所述幅频特性模型中预设位置对应的频率,获得扰动-输出控制系统的带宽频率ωNb;
将所述扰动-输出控制系统的带宽频率ωNb,近似为输入-输出控制系统的带宽频率ωRb。
进一步地,所述控制回路带宽的表达式为:
下面结合附图与具体实施方式对本发明作进一步详细描述;
如图2、图3与图4所述,以幅值控制系统为例,将全角半球谐振陀螺的控制系统化简为:以预设幅值a_setting为输入信号R(s),以解算得到的幅值信号ac为输出信号C(s)的传递函数形式,再进行化简得到闭环传递函数框图。
如图5,图6所述,当检测双通道的增益系数不一致时,会导致解算得到的幅值信号ac中存在与θ相关的扰动信号。因此,可以通过调整检测通道的增益系数gx与gy,主动将扰动信号N(s)引入到幅值控制回路中。进而得到引入扰动信号的控制系统闭环传递函数框图。
如图7,图8所述,扰动-输出控制系统与输入-输出控制系统具有相同的开环截止频率,因此,两个控制系统的带宽可以近似相等。可以通过绘制ΦN(s)的幅频特性曲线,识别扰动-输出控制系统的带宽频率,进而得到输入-输出控制系统的带宽。
以全角半球谐振陀螺的幅值控制回路为例,对于幅值控制回路的输入-输出传递函数ΦR(s)进行了描述,其特征在于:
全角半球谐振陀螺的控制系统框图如图2所示,该控制系统方案在本领域内属于公开内容,其中的信号调制解调与椭圆参数解算等方法不在此赘述。将幅值控制系统化简为:以预设幅值a_setting为输入信号R(s),以解算得到的幅值信号ac为输出信号C(s)的传递函数形式,如图3所示。
将图4中的①展开,并将②、③、④、⑤部分进行合并,得到输入-输出传递函数框图,如图3所示。
参考信号R(s)作用下的传递函数ΦR(s)为:
其幅频特性为:
输入-输出控制系统带宽的计算方法如下:
通过调整检测通道的增益系数gx与gy,主动将扰动信号引入到幅值控制回路;
当gx=gy=1时,理想全角半球谐振陀螺的解算方法如公式所示,ac=a,在解算过程中不引入新的误差。
而在调整检测通道的增益系数gx与gy后,解算公式可改写为公式。
将扰动信号N(s)引入到幅值控制回路中,如图6所示。
扰动信号N(s)作用下的传递函数ΦN(s):
其中,C(s)为输出信号,N(s)为扰动信号,G(s)为开环传递函数,τ为阻尼时间常数,s为微分算子,K为开环传递函数的增益系数,KP为比例控制系数,KI为积分控制系数,ΦN(s)为扰动-输出闭环传递函数;
其幅频特性为:
其中,G(jω)为开环传递函数,ω为复频域的信号角频率,j为虚数,s=jω;
扰动-输出控制系统带宽(即控制回路带宽)的计算方法如下:
其中,ωNb为扰动-输出控制系统的带宽频率。
分析开环传递函数截止频率的方法:
首先,分析输入-输出控制系统与扰动-输出控制系统的开环传递函数,两者具有相同的幅频特性,因而其截止频率也完全相同。而根据自动控制原理可知,控制系统的开环传递函数可以表征闭环控制系统的响应特性,而其截止频率也与闭环控制系统的带宽相近,因此,可以通过求取扰动-输出控制系统的带宽,近似得到了输入-输出控制系统的带宽。
输入-输出控制系统与扰动-输出控制系统的开环传递函数分别为G(s)与-G(s),两者具有相同的幅频特性,因而具有完全相同的截止频率ωc,如公式所示。由于开环截止频率与闭环控制系统的带宽相近,则可以得到如下结论:输入-输出控制系统的带宽频率、扰动-输出控制系统的带宽频率与输入-输出控制系统的截止频率三者近似相等,即ωRb≈ωc≈ωNb。
基于上述控制系统带宽相等的原理,通过求取扰动-输出控制系统的带宽,近似得到输入-输出控制系统的带宽。具体为:
步骤1:将半球谐振陀螺固联在单轴转台上,并以全角模式运行半球谐振陀螺。
步骤3:在单轴转台可实现的最大速率范围内均匀地设置转台转速,测试并记录多组椭圆参数a的解算结果ac,其波动的幅值即为扰动信号N(s)的响应幅值。
步骤4:将步骤3中的数据集绘制为扰动-输出闭环传递函数ΦN(s)的幅频特性曲线,其横轴为外界输入旋转频率,纵轴为扰动信号N(s)的响应幅值。
步骤5:通过步骤4中得到的幅频特性曲线,识别-3dB位置对应的频率,即为扰动-输出控制系统的带宽频率ωNb,如图7所示。
步骤6:通过步骤5中得到的扰动-输出控制系统的带宽频率ωNb,可以近似为输入-输出控制系统的带宽频率ωRb,如图8所示。
以上,仅为本申请较佳的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应该以权利要求的保护范围为准。
Claims (6)
1.一种用于测量全角半球谐振陀螺的控制回路带宽的方法,其特征在于,包括:
将扰动信号引入全角半球谐振陀螺的幅值控制回路中,获取所述幅值控制回路中若干组椭圆参数的幅值信号;
基于若干组所述幅值信号,获取扰动-输出闭环传递函数的幅频特性模型;
识别所述幅频特性模型中预设位置对应的频率,获取输入-输出控制系统的带宽频率,基于所述带宽频率获得所述控制回路带宽;
获取所述幅值控制回路中若干组椭圆参数的幅值信号包括:
将半球谐振陀螺固联在单轴转台上,以全角模式运行所述半球谐振陀螺,获取全角半球谐振陀螺的所述幅值控制回路;
调整所述幅值控制回路中检测通道增益系数,获取此时的幅值信号;
将所述扰动信号引入所述幅值控制回路中,基于预设转台转速运行所述半球谐振陀螺,获取若干组所述幅值信号;
所述扰动-输出闭环传递函数基于所述扰动信号引入所述幅值控制回路中获得;
所述扰动-输出闭环传递函数的表达式为:
其中,C(s)为输出信号,N(s)为扰动信号,G(s)为开环传递函数,τ为阻尼时间常数,s为微分算子,K为开环传递函数的增益系数,KP为比例控制系数,KI为积分控制系数,ΦN(s)为扰动-输出闭环传递函数。
4.根据权利要求1所述的用于测量全角半球谐振陀螺的控制回路带宽的方法,其特征在于,所述幅频特性模型包括横轴与纵轴;
所述横轴为外界输入旋转频率,所述纵轴为所述扰动信号的响应幅值。
5.根据权利要求1所述的用于测量全角半球谐振陀螺的控制回路带宽的方法,其特征在于,获取输入-输出控制系统的带宽频率包括:
识别所述幅频特性模型中预设位置对应的频率,获得扰动-输出控制系统的带宽频率;
将所述扰动-输出控制系统的带宽频率,近似为输入-输出控制系统的带宽频率。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210854986.3A CN115235444B (zh) | 2022-07-19 | 2022-07-19 | 一种用于测量全角半球谐振陀螺的控制回路带宽的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210854986.3A CN115235444B (zh) | 2022-07-19 | 2022-07-19 | 一种用于测量全角半球谐振陀螺的控制回路带宽的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115235444A CN115235444A (zh) | 2022-10-25 |
CN115235444B true CN115235444B (zh) | 2023-02-24 |
Family
ID=83673134
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210854986.3A Active CN115235444B (zh) | 2022-07-19 | 2022-07-19 | 一种用于测量全角半球谐振陀螺的控制回路带宽的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115235444B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115933409B (zh) * | 2023-01-06 | 2023-05-05 | 青岛哈尔滨工程大学创新发展中心 | 一种基于多物理场弱耦合的自适应调整时间步长的方法 |
CN116430713B (zh) * | 2023-04-18 | 2024-01-05 | 青岛哈尔滨工程大学创新发展中心 | 一种用于提高全角半球谐振陀螺的控制回路带宽的方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4839573A (en) * | 1986-08-18 | 1989-06-13 | Wise William L | Method and apparatus for feedback control loop bandwidth and phase margin regulation |
CN111578923A (zh) * | 2020-05-15 | 2020-08-25 | 中国人民解放军国防科技大学 | 一种谐振式陀螺闭环控制方法与系统 |
CN112327908A (zh) * | 2020-10-26 | 2021-02-05 | 上海航天控制技术研究所 | 一种适用于低舵效分离状态的稳定控制方法 |
CN112506040A (zh) * | 2020-11-16 | 2021-03-16 | 哈尔滨工程大学 | 一种全角半球谐振陀螺单通道控制系统及方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9099980B2 (en) * | 2013-05-06 | 2015-08-04 | Pratt & Whitney Canada Corp | Dynamically detecting resonating frequencies of resonating structures |
US9605964B2 (en) * | 2014-01-03 | 2017-03-28 | The Boeing Company | Gyro quadrature stabalization with demodulation phase error nulling |
WO2015107704A1 (ja) * | 2014-01-14 | 2015-07-23 | 三菱電機株式会社 | 半球共振型ジャイロ |
US10879869B2 (en) * | 2017-11-09 | 2020-12-29 | Socovar, Societe En Commandite | Microelectromechanical system resonator devices and oscillator control circuits |
-
2022
- 2022-07-19 CN CN202210854986.3A patent/CN115235444B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4839573A (en) * | 1986-08-18 | 1989-06-13 | Wise William L | Method and apparatus for feedback control loop bandwidth and phase margin regulation |
CN111578923A (zh) * | 2020-05-15 | 2020-08-25 | 中国人民解放军国防科技大学 | 一种谐振式陀螺闭环控制方法与系统 |
CN112327908A (zh) * | 2020-10-26 | 2021-02-05 | 上海航天控制技术研究所 | 一种适用于低舵效分离状态的稳定控制方法 |
CN112506040A (zh) * | 2020-11-16 | 2021-03-16 | 哈尔滨工程大学 | 一种全角半球谐振陀螺单通道控制系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN115235444A (zh) | 2022-10-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115235444B (zh) | 一种用于测量全角半球谐振陀螺的控制回路带宽的方法 | |
WO2021227013A1 (zh) | 固态谐振陀螺自校准方法及系统 | |
CN113899365B (zh) | 基于半球谐振陀螺检测通路非对称性参数辨识的驻波方位角测量方法 | |
CN110686662B (zh) | 一种可在线自校准的双模式差分谐振式陀螺仪系统 | |
CN114166242B (zh) | 一种半球谐振陀螺检测信号不均匀性的校准方法及系统 | |
CN115876182B (zh) | 一种半球谐振陀螺的电极误差建模方法 | |
CN108120581B (zh) | 旋转导弹俯仰动导数高速风洞试验装置及方法 | |
CN103767725B (zh) | 一种用于平衡ct机架的方法和装置 | |
CN107992063B (zh) | 基于变参数章动阻尼的变速倾侧动量轮进动控制方法 | |
CN113551660B (zh) | 一种电极角度存在误差时的半球谐振陀螺振型角获取方法 | |
CN115420269B (zh) | 谐振结构频率裂解辨识与修调方法及平台 | |
CN113447047A (zh) | 速率积分陀螺检测电极误差辨识方法、装置、系统及介质 | |
CN111578966A (zh) | 一种基于lms算法的半球谐振子特征参数辨识方法 | |
CN113252019A (zh) | 一种前向放大系数不一致时的半球谐振陀螺振型角获取方法 | |
CN101216313A (zh) | 基于光纤陀螺的多位置寻北方法 | |
CN106289209B (zh) | 一种适用于宽量程的陀螺仪控制方法和控制系统 | |
CN111089576A (zh) | 光纤陀螺实际输出值确定方法、光纤陀螺阀值测试方法 | |
JP2016130731A (ja) | 性能向上のための、コリオリ振動ジャイロスコープ(cvg)の再分配制御のための手法 | |
CN109724579A (zh) | 一种陀螺罗经标定方法、装置、计算设备及存储介质 | |
CN115824183A (zh) | 一种光纤陀螺的自校准方法及光纤陀螺 | |
CN116430713B (zh) | 一种用于提高全角半球谐振陀螺的控制回路带宽的方法 | |
CN104457791B (zh) | 一种静态条件下测量光纤陀螺带宽的方法 | |
CN114062312A (zh) | 一种tdlas气体检测中的锁相放大方法和系统 | |
CN114264318A (zh) | 一种闭环光纤陀螺固有频率测试方法和装置 | |
CN111006690A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |