CN110954082A - 一种光纤陀螺仪闭环控制中冲击滤波门限值的设定方法 - Google Patents
一种光纤陀螺仪闭环控制中冲击滤波门限值的设定方法 Download PDFInfo
- Publication number
- CN110954082A CN110954082A CN201811127506.3A CN201811127506A CN110954082A CN 110954082 A CN110954082 A CN 110954082A CN 201811127506 A CN201811127506 A CN 201811127506A CN 110954082 A CN110954082 A CN 110954082A
- Authority
- CN
- China
- Prior art keywords
- closed
- value
- loop
- threshold value
- impact
- 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.)
- Granted
Links
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/58—Turn-sensitive devices without moving masses
- G01C19/64—Gyrometers using the Sagnac effect, i.e. rotation-induced shifts between counter-rotating electromagnetic beams
-
- 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/58—Turn-sensitive devices without moving masses
- G01C19/64—Gyrometers using the Sagnac effect, i.e. rotation-induced shifts between counter-rotating electromagnetic beams
- G01C19/72—Gyrometers using the Sagnac effect, i.e. rotation-induced shifts between counter-rotating electromagnetic beams with counter-rotating light beams in a passive ring, e.g. fibre laser gyrometers
- G01C19/721—Details
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Electromagnetism (AREA)
- Power Engineering (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Optics & Photonics (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开了一种闭环控制回路中冲击滤波门限值的设定方法,包括以下步骤:第一步:确定冲击滤波的直接输入须满足的条件;第二步:确定外界极限冲击条件下的陀螺采样值与闭环回路内部门冲击滤波功能的直接输入值Xcj的关系;第三步:利用陀螺采样值计算A0t;第四步:建立门限值S的计算模型。本发明的优点是,通过建立数学模型,解决了外界极限冲击情况下,控制回路内部冲击滤波功能的门限值无法准确设定的难题。该方法适用于各型光纤陀螺,通用性强,可以根据不同型号应用需求准确设定控制回路内部的冲击滤波门限值,从而使陀螺控制软件可以在控制回路内部有效判别外界的极限冲击条件,确保陀螺正常工作。该方法具有较强的工程化实用性。
Description
技术领域
本发明属于一种光纤陀螺仪的冲击滤波门限值的设定方法,具体涉及一种闭环控制回路中冲击滤波门限值的设定方法。
背景技术
光纤陀螺是基于Sagnac效应实现角速度测量的装置。闭环光纤陀螺工作系统本身包括光路部分和电路及软件部分。光纤陀螺的光路部分是光纤陀螺的互易性结构部分,它将干涉后的光束送入探测器以便完成光电转换,即将干涉光信号所含的相位差信息转变为探测器输出电流的变化。光纤陀螺的电路及软件部分是光纤陀螺的信号检测和处理部分,它通过A/D、FPGA以及D/A的电路元器件将探测器输出的电信号经过软件控制处理转化为陀螺的输出信号和Y波导的相位调制信号反馈到光路,从而实现闭环回路。
陀螺软件控制处理通常采用数字相位阶梯波实现闭环回路的控制,在信号处理电路中将检测到的探测器电信号通过软件进行数字解调、然后进行冲击滤波、增益转换、消除死区等补偿措施得到闭环补偿后的相位误差信号、该信号经过数字积分后一方面经过向下抽样滤波器后转换为低采样率的数字量作为陀螺的角速度输出信号,另一方面经过第二次数字积分产生阶梯波,该阶梯波信号再与偏置调置信号相叠加后,经数模转换送入光路,作为闭环反馈到光路的输入信号,从而与光路一起形成闭环回路,完成角速度测量工作。
冲击滤波功能需要设置超门限值来保证极限情况下陀螺能够正常工作,但是由于冲击滤波功能处于闭环控制回路内部,闭环控制的采样输入值首先要经过光路再经过中值解调后才进入冲击滤波环节,因此冲击滤波功能的输入值是软件运行过程中的值,无法事先获知。从而,其门限值如何准确设定的问题一直困扰着设计人员。
发明内容
本发明的目的是提供一种闭环控制回路中冲击滤波门限值的设定方法,通过建立数学模型,解决外界极限冲击情况下,控制回路内部冲击滤波功能的门限值无法准确设定的问题。
本发明是这样实现的,一种闭环控制回路中冲击滤波门限值的设定方法,包括以下步骤:
第一步:确定冲击滤波的直接输入须满足的条件;
第二步:确定外界极限冲击条件下的陀螺采样值与闭环回路内部门冲击滤波功能的直接输入值Xcj的关系;
第三步:利用陀螺采样值计算A0t;
第四步:建立门限值S的计算模型。
所述的第一步为设闭环回路内部冲击滤波功能的直接输入为Xcj,门限值为S,则超门限值需要满足:
Xcj>S (1)
所述的第二步为设当前时刻陀螺采样值为Xt,中值解调中当前时刻中值为A0t,则:
Xcj=4*Xt-A0t (2)
所述的第三步为设某前一时刻陀螺采样值Xt-1,中值累加值为Abuffer,中值初值为Ac,中值解调中前一时刻中值为A0t-1,则:
Abuffer=(4*Xt-1-A0t-1)*256 (3)
A0t=Abuffer/256+Ac (4)
得到:
A0t=4*Xt-1-A0t-1+Ac (5)
由于控制程序可以运行在任何时刻,这里就假定控制程序初始运行部分,因此可以认为公式(5)中的
A0t-1=Ac (6)
将公式(6)代入公式(5),得到:
A0t=4*Xt-1 (7)
所述的第四步为将公式(7)代入第二步公式(2)和第一步公式(1)中,得到:
S<4*(Xt-Xt-1)
所述的第四步为,若外界极限冲击条件下,陀螺相邻两个时刻的采样值为1000,则冲击滤波功能的门限值应设定为4000。
本发明的优点是,通过建立数学模型,解决了外界极限冲击情况下,控制回路内部冲击滤波功能的门限值无法准确设定的难题。该方法适用于各型光纤陀螺,通用性强,可以根据不同型号应用需求准确设定控制回路内部的冲击滤波门限值,从而使陀螺控制软件可以在控制回路内部有效判别外界的极限冲击条件,确保陀螺正常工作。该方法具有较强的工程化实用性。
具体实施方式
下面结合具体实施例对本发明进行详细介绍:
一种闭环控制回路中冲击滤波门限值的设定方法,包括以下步骤:
第一步:确定冲击滤波的直接输入须满足的条件;
设闭环回路内部冲击滤波功能的直接输入为Xcj,门限值为S,则超门限值需要满足:
Xcj>S (1)
第二步:确定外界极限冲击条件下的陀螺采样值与闭环回路内部门冲击滤波功能的直接输入值Xcj的关系;
设当前时刻陀螺采样值为Xt,中值解调中当前时刻中值为A0t,则:
Xcj=4*Xt-A0t (2)
第三步:利用陀螺采样值计算A0t;
设某前一时刻陀螺采样值Xt-1,中值累加值为Abuffer,中值初值为Ac。中值解调中前一时刻中值为A0t-1,则:
Abuffer=(4*Xt-1-A0t-1)*256 (3)
A0t=Abuffer/256+Ac (4)
得到:
A0t=4*Xt-1-A0t-1+Ac (5)
由于控制程序可以运行在任何时刻,这里就假定控制程序初始运行部分,因此可以认为公式(5)中的
A0t-1=Ac (6)
将公式(6)代入公式(5),得到:
A0t=4*Xt-1 (7)
第四步:建立门限值S的计算模型。
将公式(7)代入第二步公式(2)和第一步公式(1)中,得到:
S<4*(Xt-Xt-1)
例如:若外界极限冲击条件下,陀螺相邻两个时刻的采样值为1000,则冲击滤波功能的门限值应设定为4000。
Claims (6)
1.一种闭环控制回路中冲击滤波门限值的设定方法,其特征在于:包括以下步骤:
第一步:确定冲击滤波的直接输入须满足的条件;
第二步:确定外界极限冲击条件下的陀螺采样值与闭环回路内部门冲击滤波功能的直接输入值Xcj的关系;
第三步:利用陀螺采样值计算A0t;
第四步:建立门限值S的计算模型。
2.如权利要求1所述的一种闭环控制回路中冲击滤波门限值的设定方法,其特征在于:所述的第一步为设闭环回路内部冲击滤波功能的直接输入为Xcj,门限值为S,则超门限值需要满足:
Xcj>S (1)。
3.如权利要求1所述的一种闭环控制回路中冲击滤波门限值的设定方法,其特征在于:所述的第二步为设当前时刻陀螺采样值为Xt,中值解调中当前时刻中值为A0t,则:
Xcj=4*Xt-A0t (2)。
4.如权利要求1所述的一种闭环控制回路中冲击滤波门限值的设定方法,其特征在于:所述的第三步为设某前一时刻陀螺采样值Xt-1,中值累加值为Abuffer,中值初值为Ac,中值解调中前一时刻中值为A0t-1,则:
Abuffer=(4*Xt-1-A0t-1)*256 (3)
A0t=Abuffer/256+Ac (4)
得到:
A0t=4*Xt-1-A0t-1+Ac (5)
由于控制程序可以运行在任何时刻,这里就假定控制程序初始运行部分,因此可以认为公式(5)中的
A0t-1=Ac (6)
将公式(6)代入公式(5),得到:
A0t=4*Xt-1 (7)。
5.如权利要求1所述的一种闭环控制回路中冲击滤波门限值的设定方法,其特征在于:所述的第四步为将公式(7)代入第二步公式(2)和第一步公式(1)中,得到:
S<4*(Xt-Xt-1)。
6.如权利要求1所述的一种闭环控制回路中冲击滤波门限值的设定方法,其特征在于:所述的第四步为,若外界极限冲击条件下,陀螺相邻两个时刻的采样值为1000,则冲击滤波功能的门限值应设定为4000。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811127506.3A CN110954082B (zh) | 2018-09-27 | 2018-09-27 | 一种光纤陀螺仪闭环控制中冲击滤波门限值的设定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811127506.3A CN110954082B (zh) | 2018-09-27 | 2018-09-27 | 一种光纤陀螺仪闭环控制中冲击滤波门限值的设定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110954082A true CN110954082A (zh) | 2020-04-03 |
CN110954082B CN110954082B (zh) | 2022-07-15 |
Family
ID=69967736
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811127506.3A Active CN110954082B (zh) | 2018-09-27 | 2018-09-27 | 一种光纤陀螺仪闭环控制中冲击滤波门限值的设定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110954082B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115855015A (zh) * | 2023-02-01 | 2023-03-28 | 中国船舶集团有限公司第七〇七研究所 | 一种解决光纤陀螺大角冲击的方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080079946A1 (en) * | 2006-09-29 | 2008-04-03 | Honeywell International, Inc. | Digital intensity suppression for vibration and radiation insensitivity in a fiber optic gyroscope |
US20100141953A1 (en) * | 2008-12-09 | 2010-06-10 | Northrop Grumman Guidance and Electronics Company Inc. | Automatic gain Control for fiber optic gyroscope deterministic control loops |
US20120239329A1 (en) * | 2011-03-15 | 2012-09-20 | University, Peking | Sagnac phase shift tracking method for fiber-optic gyroscopes |
CN103884358A (zh) * | 2014-03-31 | 2014-06-25 | 北京控制工程研究所 | 一种数字闭环光纤陀螺全回路检测与仿真测试系统 |
US20140318243A1 (en) * | 2013-04-26 | 2014-10-30 | Maxim Integrated Products, Inc. | Gyroscope Shock and Disturbance Detection Circuit |
CN106341099A (zh) * | 2016-08-10 | 2017-01-18 | 陕西华燕航空仪表有限公司 | 一种闭环光纤陀螺前放信号滤波电路及滤波方法 |
CN106885565A (zh) * | 2017-02-14 | 2017-06-23 | 北京航空航天大学 | 一种基于中值滤波的干涉式光纤陀螺输出信号附加零偏的抑制方法 |
-
2018
- 2018-09-27 CN CN201811127506.3A patent/CN110954082B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080079946A1 (en) * | 2006-09-29 | 2008-04-03 | Honeywell International, Inc. | Digital intensity suppression for vibration and radiation insensitivity in a fiber optic gyroscope |
US20100141953A1 (en) * | 2008-12-09 | 2010-06-10 | Northrop Grumman Guidance and Electronics Company Inc. | Automatic gain Control for fiber optic gyroscope deterministic control loops |
US20120239329A1 (en) * | 2011-03-15 | 2012-09-20 | University, Peking | Sagnac phase shift tracking method for fiber-optic gyroscopes |
US20140318243A1 (en) * | 2013-04-26 | 2014-10-30 | Maxim Integrated Products, Inc. | Gyroscope Shock and Disturbance Detection Circuit |
CN103884358A (zh) * | 2014-03-31 | 2014-06-25 | 北京控制工程研究所 | 一种数字闭环光纤陀螺全回路检测与仿真测试系统 |
CN106341099A (zh) * | 2016-08-10 | 2017-01-18 | 陕西华燕航空仪表有限公司 | 一种闭环光纤陀螺前放信号滤波电路及滤波方法 |
CN106885565A (zh) * | 2017-02-14 | 2017-06-23 | 北京航空航天大学 | 一种基于中值滤波的干涉式光纤陀螺输出信号附加零偏的抑制方法 |
Non-Patent Citations (6)
Title |
---|
付博等: "闭环光纤陀螺滤波算法的分析与改进", 《光学技术》 * |
姚琼等: "光纤陀螺光源误差及消除方法分析", 《激光杂志》 * |
姬伟等: "光纤陀螺信号数字滤波算法研究", 《压电与声光》 * |
姬伟等: "光纤陀螺信号误差分析与滤波算法的研究", 《传感技术学报》 * |
宋凝芳等: "数字闭环光纤陀螺振动误差分析", 《北京航空航天大学学报》 * |
霍炬等: "基于小波变换阈值法处理光纤陀螺信号噪声", 《中国惯性技术学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115855015A (zh) * | 2023-02-01 | 2023-03-28 | 中国船舶集团有限公司第七〇七研究所 | 一种解决光纤陀螺大角冲击的方法 |
CN115855015B (zh) * | 2023-02-01 | 2023-05-02 | 中国船舶集团有限公司第七〇七研究所 | 一种解决光纤陀螺大角冲击的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110954082B (zh) | 2022-07-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107389097B (zh) | 光纤陀螺Sagnac光纤环本征频率跟踪测量方法 | |
CN108168537B (zh) | 基于正交解调的谐振式光学陀螺的检测系统和方法 | |
CN109358501A (zh) | 自抗扰控制方法、控制器及精跟踪控制系统 | |
CN107505845B (zh) | 一种提高倾斜镜控制系统扰动抑制能力的控制方法 | |
CN109443338B (zh) | 一种小型光纤陀螺的闭环控制系统 | |
CN110375727B (zh) | 一种闭环光纤陀螺信号调制方法 | |
EP2778611A1 (de) | Unterdrückung des Lock-In-Effekts aufgrund eines MIOC-Frequenzgangs beim faseroptischen Sagnac-Interferometer | |
CN107356266A (zh) | 基于偶倍本征频率锯齿波调制的光纤陀螺本征频率测量方法 | |
CN105955027A (zh) | 一种基于多阶运动信息估计的前馈控制方法 | |
CN106979776B (zh) | 一种基于西格玛德尔塔调制的光纤陀螺的数字闭环控制方法 | |
CN111323047B (zh) | 一种基于加速度计的陀螺零位误差动态补偿方法 | |
CN110954082B (zh) | 一种光纤陀螺仪闭环控制中冲击滤波门限值的设定方法 | |
CN107390522A (zh) | 一种基于视觉跟踪的误差观测前馈控制方法 | |
US3899251A (en) | Apparatus and method for measuring the relative distance and optionally the relative velocity of an object | |
CN102183249B (zh) | 一种光纤陀螺仪的萨格奈克相移跟踪方法 | |
CN115128958A (zh) | 一种前馈改进Smith预估器的光电跟踪控制方法 | |
CN105571580A (zh) | 一种抑制光纤陀螺反馈驱动电路频繁复位的滞回方法 | |
CN103591946A (zh) | 一种可消除尖峰信号的干涉式光纤陀螺 | |
CN104713538B (zh) | 一种闭环光纤陀螺最小拍控制方法 | |
CN100561129C (zh) | 消除信号强度变化对光纤陀螺性能影响的方法 | |
CN112648991B (zh) | 一种闭环光纤陀螺仪的死区克服系统及其方法 | |
CN108801602A (zh) | 一种降低双光束光阱系统中低频噪声的装置和方法 | |
CN108919836A (zh) | 一种运动平台光电跟踪系统全频段扰动解耦方法 | |
CN103697877A (zh) | 一种电路方案的高精度闭环光纤陀螺光源相对强度噪声抑制方法 | |
CN109798885A (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 |