CN110906920A - 一种抑制数字闭环光纤陀螺复位误差的方法 - Google Patents
一种抑制数字闭环光纤陀螺复位误差的方法 Download PDFInfo
- Publication number
- CN110906920A CN110906920A CN201911260667.4A CN201911260667A CN110906920A CN 110906920 A CN110906920 A CN 110906920A CN 201911260667 A CN201911260667 A CN 201911260667A CN 110906920 A CN110906920 A CN 110906920A
- Authority
- CN
- China
- Prior art keywords
- reset
- phi
- wave
- phase shift
- feedback
- 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
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/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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Power Engineering (AREA)
- Manufacturing & Machinery (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开了一种抑制数字闭环光纤陀螺复位误差的方法,该方法首先固定复位状态,定义阶梯波发生器,控制陀螺仅在固定复位状态下实现复位;通过对光纤陀螺中的阶梯波2π复位状态进行检测,只保留一对固定的复位状态,从而抑制了光纤陀螺中复位带来的误差。
Description
技术领域
本发明涉及一种光纤陀螺中阶梯斜波2π复位的计算方式,更具体的说是通过检测陀螺中的调制方波状态,控制陀螺阶梯斜波只能发生一种2π复位状态,从而抑制了光纤陀螺的复位误差。
背景技术
数字闭环光纤陀螺是一种测量角速度的仪器,广泛应用于导航、定位等惯性系统中。其主要包括光源、耦合器、Y波导、光纤环、光电探测器、数字处理电路,如图1所示。
数字闭环光纤陀螺实现原理基于Sagnac效应,光源发出光通过Y波导分成正反两束光波,在光纤环中传播一周后重新在Y波导处合光并发生干涉。光电探测器将光强转化为电压信号。为提高检测灵敏度,通常加入偏置方波调制φ0/2,如图2,当陀螺旋转时,输出变成一个与调制方波同频的方波信号,中心处理器将A/D模数芯片采集的信号做差,得到闭环控制的误差量,并通过第一个积分器产生反馈相移φFB;反馈相移φFB在经过第二次积分,产生数字阶梯波;最后阶梯波叠加调制方波通过D/A数模转换芯片,施加到Y波导上,实现陀螺转速跟踪及测量。同时由于阶梯波不能无限上升(一般通过阶梯波寄存器的自动溢出实现2π复位,为保证2π复位的准确性,通常还需反馈回路增益控制。参见文献:光纤陀螺原理及技术,张桂才。
陀螺的阶梯波寄存器在自动溢出时(即2π复位),调制方波存在两种状态,分别为+φ0/2和-φ0/2,故对应的存在4种复位状态,分别加以讨论。
复位状态1:阶梯波向上累加,即反馈相移φFB为正。当阶梯波寄存器自动溢出时的前一个时刻,叠加的调制方波为+φ0/2,自动溢出后一个时刻,叠加的调制方波为-φ0/2,溢出前后反馈波形变化为2π+φ0,如图3所示。
复位状态2:阶梯波向上累加,即反馈相移φFB为正。当阶梯波寄存器自动溢出时的前一个时刻,叠加的调制方波为-φ0/2,自动溢出后一个时刻,叠加的调制方波为+φ0/2,溢出前后反馈波形变化为2π-φ0,如图4所示。
复位状态3和4:阶梯波向下,即反馈相移φFB为负。原理与复位状态1和2相同,区别为溢出前后反馈波形变化(2π+φ0或2π-φ0),与复位状态1和2正好相反,不再详述。
由上可以看出,复位状态的反馈波形是一种突变状态,且每次陀螺复位导致的反馈波形各不相同。由于Y波导存在电压响应非理想的特性,不同的反馈电压将产生不同的相位响应,故导致陀螺复位时,陀螺光电探测器上的检测信号出现畸变,如图5及图7所示,导致反馈相位φFB与Sagnac相移φs出现偏差,从而产生了陀螺的复位误差。
发明内容
本发明的目的是提供一种抑制数字闭环光纤陀螺复位误差的方法,该方法通过对光纤陀螺中的阶梯波2π复位状态进行检测,只保留一对固定的复位状态,从而抑制了光纤陀螺中复位带来的误差。
本发明所采用的技术方案是提出一种抑制数字闭环光纤陀螺复位误差的方法,包括以下步骤:
S1、选定固定复位状态:选取原则是复位引起的相移尽可能的接近于非复位状态;因此将与非复位状态之间的相移小的复位状态,作为固定复位状态;上述固定复位状态为±(2π-φ0)复位状态;
S2、定义阶梯波发生器,控制陀螺仅在固定复位状态下实现复位;
S21、定义2π复位数字量为2n,对应阶梯波发生器step的位数为n+1位;
S22、实时监测方波调制信号,判断方波调制信号及反馈相移φFB的正负;
S23、当反馈相移φFB为正且方波调制信号为-φ0/2时(即当前状态为选定的固定复位状态),允许阶梯波发生器发生2π复位;或反馈相移φFB为负且方波调制信号为+φ0/2时(即当前状态为选定的固定复位状态),允许阶梯波发生器发生2π复位;
累加复位公式为:
φstep[n:0]={φstep[n-1]+φstep[n-1:0]}+φFB
其中,φstep[n-1]为阶梯波发生器的第n位,φstep[n-1:0]为阶梯波发生器的低n位,φFB为反馈相移;
S24、当反馈相移φFB为正且方波调制信号为+φ0/2时(即当前状态不为选定的固定复位状态),则不允许阶梯波发生器发生2π复位;或反馈相移φFB为负且方波调制信号为-φ0/2时(即当前状态不为选定的固定复位状态),则不允许阶梯波发生器发生2π复位;
阶梯波step继续累加,完成n+1位阶梯波累加,而阶梯波寄存器不发生溢出;直至符合步骤S23的条件,进行复位,累加复位公式为:
φstep[n:0]=φstep[n:0]+φFB;
其中,φstep[n:0]为阶梯波发生器的所有n+1位,φFB为反馈相移。
本发明的有益效果是:
本发明光纤陀螺的复位状态限定为一种,且选定的固定复位状态对应的复位引起的相移尽可能的接近于非复位状态;固定复位状态调制相位越接近非复位状态,与非复位状态±φ0相比,调制电压变化越小,从而有效的消除了陀螺的复位误差。
附图说明
图1为数字闭环光纤陀螺原理图;
图2为方波调制及输出信号;
图3为复位状态1;
图4为复位状态2;
图5为复位状态比较;
图6为本发明流程图;
图7为复位信号与检测信号。
具体实施方式
下面将结合附图对本发明作进一步详细说明。
本发明一种抑制数字闭环光纤陀螺复位误差的方法,实现过程如图6所示:
1、选定固定复位状态;
由技术背景中分析可知,当陀螺处于非复位状态时,施加给Y波导的调制信号为±φ0/2的方波;当陀螺处于复位状态时,施加给Y波导的调制信号为±(2π+φ0)和±(2π-φ0)四种复位状态;
陀螺中调制方波±φ0的幅值为π/2≤φ0<π,如图5所示。
由图5可知,±(2π-φ0)复位状态与非复位状态±φ0相比,调制电压变化较小,而且随着调制深度加深(φ0增大),复位状态调制相位越接近非复位状态。故可选择±(2π-φ0)为固定复位状态。
2、定义阶梯波发生器,将反馈相移φFB进行第二次累加积分,形成阶梯波,同时利用自身寄存器位数实现自动溢出(即2π复位)。若定义2π复位数字量为2n,在传统方法中,对应阶梯波发生器(step)的位数为n次,本发明为实现只在固定复位状态下复位,将阶梯波发生器(step)的位数定义为n+1次。
3、阶梯波累加积分,判断调制方波状态及反馈相移φFB的正负,采用不同的累加策略:
(a)当调制方波状态为-φ0/2且反馈相移φFB为正,或反馈相移φFB为负且方波调制信号为+φ0/2时,允许阶梯波发生器发生2π复位;此状态允许阶梯波发生器(step)发生2π复位即数字量为2n溢出,但由于阶梯波发生器(step)的位数定义为n+1次,需采取特殊处理,具体方法为:阶梯波(step)构造新变量,即阶梯波(step)的低n位保留,最高位用阶梯波(step)的第n位进行扩位,将该变量和φFB进行累加,,并赋值给阶梯波(step),从而实现了2n自动溢出,即正常复位状态,公式可表示为:
其中,φstep[n-1]为阶梯波发生器的第n位,φstep[n-1:0]为阶梯波发生器的低n位,φFB为反馈相移;
(b)当调制方波状态为+φ0/2反馈相移φFB为正,或反馈相移φFB为负且方波调制信号为-φ0/2时,此状态不允许阶梯波(step)发生2π复位,所以阶梯波(step)采用全部n+1位进行累加,故当阶梯波(step)数字量超过2n并不会发生溢出,而是继续向上或向下累加。直到满足a条件时,阶梯波累加策略变为(a),发生溢出,且2π复位数字量仍等于2n;
φstep[n:0]=φstep[n:0]+φFB
其中,φstep[n:0]为阶梯波发生器的所有n+1位,φFB为反馈相移。
Claims (1)
1.一种抑制数字闭环光纤陀螺复位误差的方法,其特征在于,包括以下步骤:
S1、选定固定复位状态:
将与非复位状态之间的相移小的复位状态,作为固定复位状态;所述固定复位状态为±(2π-φ0)复位状态;
S2、定义阶梯波发生器,控制陀螺仅在固定复位状态下实现复位;
S21、定义2π复位数字量为2n,对应阶梯波发生器step的位数为n+1位;
S22、实时监测方波调制信号,判断方波调制信号及反馈相移φFB的正负;
S23、当反馈相移φFB为正且方波调制信号为-φ0/2时,允许阶梯波发生器发生2π复位;或反馈相移φFB为负且方波调制信号为+φ0/2时,允许阶梯波发生器发生2π复位;
累加复位公式为:
φstep[n:0]={φstep[n-1]+φstep[n-1:0]}+φFB
其中,φstep[n-1]为阶梯波发生器的第n位,φstep[n-1:0]为阶梯波发生器的低n位,φFB为反馈相移;
S24、当反馈相移φFB为正且方波调制信号为+φ0/2时,则不允许阶梯波发生器发生2π复位;或反馈相移φFB为负且方波调制信号为-φ0/2时,则不允许阶梯波发生器发生2π复位;
阶梯波step继续累加,完成n+1位阶梯波累加,而阶梯波寄存器不发生溢出,直至符合步骤S23的条件,进行复位,累加复位公式为:
φstep[n:0]=φstep[n:0]+φFB;
其中,φstep[n:0]为阶梯波发生器的所有n+1位,φFB为反馈相移。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911260667.4A CN110906920B (zh) | 2019-12-10 | 2019-12-10 | 一种抑制数字闭环光纤陀螺复位误差的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911260667.4A CN110906920B (zh) | 2019-12-10 | 2019-12-10 | 一种抑制数字闭环光纤陀螺复位误差的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110906920A true CN110906920A (zh) | 2020-03-24 |
CN110906920B CN110906920B (zh) | 2021-05-14 |
Family
ID=69824115
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911260667.4A Active CN110906920B (zh) | 2019-12-10 | 2019-12-10 | 一种抑制数字闭环光纤陀螺复位误差的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110906920B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110906920B (zh) * | 2019-12-10 | 2021-05-14 | 西安航天精密机电研究所 | 一种抑制数字闭环光纤陀螺复位误差的方法 |
CN114111754A (zh) * | 2022-01-25 | 2022-03-01 | 西安中科华芯测控有限公司 | 消除复位误差的光纤陀螺闭环控制方法、系统及存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7336364B2 (en) * | 2005-11-29 | 2008-02-26 | Honeywell International, Inc. | Minimal bias switching for fiber optic gyroscopes |
CN204388859U (zh) * | 2015-02-12 | 2015-06-10 | 重庆华渝电气集团有限公司 | 一种光纤陀螺的光路结构 |
CN105571580A (zh) * | 2015-12-17 | 2016-05-11 | 北京航空航天大学 | 一种抑制光纤陀螺反馈驱动电路频繁复位的滞回方法 |
CN107063227A (zh) * | 2017-05-05 | 2017-08-18 | 重庆华渝电气集团有限公司 | 一种精确控制闭环光纤陀螺中2π电压参数的方法 |
CN109631871A (zh) * | 2018-12-09 | 2019-04-16 | 西安航天精密机电研究所 | 一种抑制光纤陀螺仪交叉耦合的随机调制及解调方法 |
CN109737946A (zh) * | 2018-12-28 | 2019-05-10 | 北京航空航天大学 | 高精度光纤陀螺四态调制中调制深度的自动调整方法 |
CN110006416A (zh) * | 2019-03-20 | 2019-07-12 | 北京航空航天大学 | 一种用于高精度光纤陀螺的方波调制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110906920B (zh) * | 2019-12-10 | 2021-05-14 | 西安航天精密机电研究所 | 一种抑制数字闭环光纤陀螺复位误差的方法 |
-
2019
- 2019-12-10 CN CN201911260667.4A patent/CN110906920B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7336364B2 (en) * | 2005-11-29 | 2008-02-26 | Honeywell International, Inc. | Minimal bias switching for fiber optic gyroscopes |
CN204388859U (zh) * | 2015-02-12 | 2015-06-10 | 重庆华渝电气集团有限公司 | 一种光纤陀螺的光路结构 |
CN105571580A (zh) * | 2015-12-17 | 2016-05-11 | 北京航空航天大学 | 一种抑制光纤陀螺反馈驱动电路频繁复位的滞回方法 |
CN107063227A (zh) * | 2017-05-05 | 2017-08-18 | 重庆华渝电气集团有限公司 | 一种精确控制闭环光纤陀螺中2π电压参数的方法 |
CN109631871A (zh) * | 2018-12-09 | 2019-04-16 | 西安航天精密机电研究所 | 一种抑制光纤陀螺仪交叉耦合的随机调制及解调方法 |
CN109737946A (zh) * | 2018-12-28 | 2019-05-10 | 北京航空航天大学 | 高精度光纤陀螺四态调制中调制深度的自动调整方法 |
CN110006416A (zh) * | 2019-03-20 | 2019-07-12 | 北京航空航天大学 | 一种用于高精度光纤陀螺的方波调制方法 |
Non-Patent Citations (2)
Title |
---|
SHITONG CHEN,等: "Research on the digital closed-loop control of Fiber optical gyroscope", 《INTERNATIONAL CONFERENCE ON COMPUTER AND AUTOMATION ENGINEERING》 * |
李如春,等: "数字调制谐振式光纤陀螺中阶梯波", 《中国激光》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110906920B (zh) * | 2019-12-10 | 2021-05-14 | 西安航天精密机电研究所 | 一种抑制数字闭环光纤陀螺复位误差的方法 |
CN114111754A (zh) * | 2022-01-25 | 2022-03-01 | 西安中科华芯测控有限公司 | 消除复位误差的光纤陀螺闭环控制方法、系统及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN110906920B (zh) | 2021-05-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111174773B (zh) | 一种多相调制解调的光纤陀螺多闭环算法 | |
CN109737946B (zh) | 高精度光纤陀螺四态调制中调制深度的自动调整方法 | |
CN108519079B (zh) | 一种双闭环光纤陀螺六态调制降低串扰的方法 | |
CN110906920B (zh) | 一种抑制数字闭环光纤陀螺复位误差的方法 | |
CN111220142B (zh) | 一种新型超高精度光纤陀螺仪的信号处理方法及装置 | |
US9518825B2 (en) | Suppression of lock-in effect due to a MIOC frequency response in a fiber-optic Sagnac interferometer | |
CN109443338B (zh) | 一种小型光纤陀螺的闭环控制系统 | |
JPH10300479A (ja) | 過変調を採用している光ファイバ・ジャイロスコープにおけるクロスカップリングを抑制するための方法および装置 | |
CN109931922B (zh) | 一种光纤陀螺启动快速自检测方法 | |
JP2008216256A (ja) | 光ファイバ・ジャイロスコープ振動誤差抑制の方法およびシステム | |
CN109696180B (zh) | 基于双电极y波导的超高精度光纤陀螺量化误差抑制方法 | |
CN115077510B (zh) | 一种基于交替振幅方波的干涉式光纤陀螺调制方法 | |
CN114111754B (zh) | 消除复位误差的光纤陀螺闭环控制方法、系统及存储介质 | |
CN115900772A (zh) | 一种提升集成光学陀螺随机游走系数的方法及系统 | |
CN113916212B (zh) | 一种适用于轻小型光纤陀螺的第二闭环控制方法 | |
CN116184815A (zh) | 消除光纤陀螺复位误差的闭环控制方法及系统 | |
CN113739782A (zh) | 一种光纤陀螺闭环控制方法、系统、电子设备及存储介质 | |
EP3760972B1 (en) | Fiber optic gyroscope control system using sub-tau modulation | |
CN113074713B (zh) | 一种光纤陀螺高动态控制方法 | |
CN113959427A (zh) | 基于新型调制的集成光学陀螺闭环反馈系数实时跟踪方法 | |
US8842286B2 (en) | Suppression of quantization noise in a fiber-optic sagnac interferometer | |
JPH11108669A (ja) | 光ファイバジャイロ | |
JP3343767B2 (ja) | 光ファイバジャイロ | |
CN110987010A (zh) | 一种信号干扰检测方法、计算机存储介质及计算机设备 | |
WO2000003202A1 (fr) | Gyroscope a fibre optique |
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 |