CN111380561A - 一种基于多参数融合的微机电陀螺标度因数补偿方法 - Google Patents
一种基于多参数融合的微机电陀螺标度因数补偿方法 Download PDFInfo
- Publication number
- CN111380561A CN111380561A CN201811617310.2A CN201811617310A CN111380561A CN 111380561 A CN111380561 A CN 111380561A CN 201811617310 A CN201811617310 A CN 201811617310A CN 111380561 A CN111380561 A CN 111380561A
- Authority
- CN
- China
- Prior art keywords
- driving
- gyroscope
- scale factor
- micro
- closed
- 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
- 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
-
- 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/5776—Signal processing not specific to any of the devices covered by groups G01C19/5607 - G01C19/5719
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Signal Processing (AREA)
- Manufacturing & Machinery (AREA)
- Gyroscopes (AREA)
Abstract
本发明的目的是提供一种用于微机电陀螺标度因数的温度补偿方法,该方法通过测量开环检测模式下的影响微机电陀螺标度因数的主要参数,将其组成多元参数组,将各个参数进行函数加权对标度因数的全温变化曲线进行多元函数拟合,从而实现对陀螺标度因数的精确补偿。
Description
技术领域
本发明涉及了一种用于微机电陀螺标度因数的补偿方法,采用多参数融合补偿方法,属于微机电惯性传感器技术领域。
背景技术
微机电陀螺是用微电子工艺加工的特征尺寸在微米量级的器件,用于测量载体的角速度,其体积小、成本低、适于批量加工及易与ASIC集成,有着广泛的应用前景和迫切的市场需求,目前已成功应用于汽车、消费类电子等工业、民用领域以及制导武器等军用领域。
微机电振动式陀螺基于科里奥利力原理工作,通常有两个模态:驱动模态和检测模态。正常工作时,陀螺在驱动轴向上作闭环恒幅振动,当沿陀螺的敏感轴有角速率输入时,会在检测模态方向上产生一个正比于外界角速率输入的科里奥利力(简称科氏力),陀螺振动质量块在该科氏力作用下沿检测轴向振动,其位移变化可以通过电容拾取结构变为电容变化,再通过微小电容读出电路将电容变化量转换为电压变化量,最后通过同步解调以获得角速率信息。
标度因数是指单位角速率输入时所带来的陀螺输出,单位一般是mV/(°/s)或者LSB/(°/s),其温度稳定性是微机电陀螺的关键指标之一。为了获得较好的标度因数温度稳定性,要对陀螺的标度因数进行温度补偿,通常在全温范围内采集陀螺的标度因数以及对应的温度值,再利用最小二乘法对温度和标度因数进行拟合补偿。该温度补偿技术的关键在于实时而精确地获取陀螺敏感表头的温度信息,目前常用的方法是在陀螺表头附近安装温度传感器实时测量环境温度信息。该方法的优点是简单易行,其缺点是由于温度梯度的存在,温度传感器所获取的温度并不能真实反映陀螺表头的实际温度值,这会导致补偿效果变差。针对此问题文献:陈怀,张嵘,周斌,陈志勇,.微机械陀螺仪温度特性及补偿算法研究[J].传感器技术,2004,(10);满海鸥,肖定邦,吴学忠,陈志华,侯占强,.硅微陀螺模态频率温度特性的研究[J].传感技术学报,2009,(8);凤瑞,裘安萍,施芹,苏岩,.双质量硅微机械陀螺固有频率温度特性研究[J].南京理工大学学报,2013,(1)等分析了陀螺的驱动轴相位、频率与温度的关系,指出驱动轴谐振频率与温度成近似线性关系,因此可利用频率信息进行温度补偿,克服了外置温度传感器与陀螺表头温度不完全一致的缺点。由于陀螺的标度因数受两模态频差、解调相位误差、电路增益误差等影响,因此单一谐振频率或者温度传感器输出并不能完全反映陀螺标度因数变化的特性,因此补偿效果有限。
发明内容
本发明的目的是提供一种用于微机电陀螺标度因数的温度补偿方法,该方法通过测量开环检测模式下的影响微机电陀螺标度因数的主要参数,将其组成多元参数组,将各个参数进行函数加权对标度因数的全温变化曲线进行多元函数拟合,从而实现对陀螺标度因数的精确补偿。
具体地,开环工作方式下的高真空封装的微机电陀螺的标度因数可以表达为式(1),
其中,δ为与结构和前置电路相关的常数,R为陀螺驱动闭环控制回路中自动增益控制器(AGC)的控制参考电压,代表了驱动振动幅度,ωnd为驱动频率,ωns为检测模态谐振频率,Δω为两模态谐振频率的差值,θ为解调相位误差,Kd为解调增益。将式(1)对温度求导,同时考虑到两模态的谐振频率温度变化有较好的一致性,可得到标度因数的温度灵敏度如式(2)所示
式(2)说明影响陀螺标度因数的主要参数有驱动振动幅度R,模态频差Δω,解调增益Kd以及解调相位误差θ。通常电路解调增益Kd与温度具有强相关性,而温度可以用陀螺的驱动频率进行表达,因此标度因数的预测模型可以写为式(3)。
SFcal=P1(ωnd)+P2(R)+P3(Δω)+P4(θ) (3)
其中Pi(·)为加权函数,可以是线性函数、指数函数、幂函数或者其他函数,根据实际测试结果确定,通常可以采用线性加权函数,即,
SFcal=α0+α1ωnd+α2R+α3Δω+α4θ (4)
其中αi为加权系数,可用多元线性回归拟合的方法确定。
因此为实现微机电陀螺标度因数的精确补偿,本发明采取以下技术方案。采用基于多参数融合的微机电陀螺标度因数补偿方法,其特征在于:获取微机电陀螺的驱动频率、驱动振动幅度、模态频差和解调相位误差等四个参数的全温变化,为每个参数选定好加权函数,通过拟合算法,将陀螺全温范围内的标度因数同上述四个参数进行多元函数拟合得到标度因数估计值,再用某一温度点下的陀螺的零位输出除以该温度点下的标度因数估计值,完成微机电陀螺标度因数的全温补偿。
所述微机电陀螺的驱动频率为驱动模态闭环控制下,陀螺在驱动模态方向上的振动频率。
所述微机电陀螺的驱动振动幅度为驱动模态闭环控制下,陀螺在驱动模态方向上的前置电路输出电压幅度。
所述微机电陀螺的模态频差为陀螺驱动模态和检测模态谐振频率的差值。
所述微机电陀螺的解调相位误差为陀螺驱动闭环控制电路中驱动电压同驱动检测电压的相位之差。
所述加权函数可以为常值函数、线性函数、指数函数等任意函数,包含所需拟合的系数。
本发明由于采取以上技术方案,可以较为精确的预知不同温度点下的标度因数,避免了采用单一参数进行标度因数补偿所带来的温度迟滞以及拟合不精确等缺点,提高了标度因数的全温稳定性。
附图说明
图1为本发明所适用的微机电陀螺结构示意图。
图2为基于自激振荡驱动闭环的微机电陀螺测控电路方案示意图。
图3为针对自激振荡驱动闭环的微机电陀螺多参数融合标度因数补偿方法示意图
图4为基于锁相环的数字驱动闭环微机电陀螺测控电路方案示意图。
图5为针对基于锁相环的数字驱动闭环微机电陀螺多参数融合标度因数补偿方法示意图
具体实施方式
如图1所示,本发明所适用的微机电陀螺结构1一般由驱动结构3,可动谐振结构5、驱检拾取结构6和敏感拾取结构4构成。振动拾取结构4和6通常采用差分式电容式结构,主要有梳齿型电容结构和平行板型电容结构。2、7、8分别为驱动结构5、驱检拾取结构6和敏感拾取结构4的引出金属电极。可动谐振结构5产生振动,其位移变化量被驱检拾取结构6以及敏感拾取结构7获取,驱检拾取结构6以及敏感拾取结构7将获取到的位移变化量转变为电容变化量,并通过电极8和电极7输出。
下面列举两个个具体实施例对本发明进行更为详细的说明。
实施例1:
如图2和图3所示,本实施例的方法包括以下步骤:
1)将驱检拾取结构6的输出电极8连接一前置读出电路10得到驱动振动电压12,该驱动振动电压送入一滤波器13,进行移相操作,得到驱动相位信号14,其相位与驱动振动电压12相差90度。
2)将驱动振动电压12和驱动相位信号14同时连接至一自动增益控制器AGC15对信号12进行幅度及相位控制,得到驱动电压并连接至驱动电极2,构成自激闭环驱动,AGC15通过驱动参考电压16对驱动振动电压12的幅度进行动态调整,使得12的电压幅度等于R。通过该闭环控制,可以使微机电陀螺1在驱动模态方向上以其固有的谐振频率ωnd进行恒幅R振动。
3)将敏感拾取结构4的输出电极7连接一前置读出电路11得到科氏力振动电压17,将该电压连接一解调器18,同驱动信号2进行解调,将解调信号连接一滤波器19滤除高频成分得到角速率输出电压20。
4)将驱动振动电压12、驱动相位信号14、角速率输出信号20以及温度传感器201的输出信号202一同送入多元参融合补偿单元203,按照公式(4)进行标度因数预测并进行补偿,得到补偿后的角速率输出204。其中可以对驱动振动电压12和驱动相位信号14做FFT运算,分别得到幅度和、频率及相位信息,进而得谐振频率ωnd、驱动振动幅度R以及解调相位误差θ,模态频差Δω可通过温度传感器201的输出202进行拟合得到检测模态谐振频率ωns,进而得出频差。
实施例2:
如图4所示,本实施例的方法包括以下步骤:
1)设置两个前置读出电路10和11,使驱检拾取结构6的输出电极8连接前置读出电路10得到驱动振动电压12,使敏感拾取结构4的输出电极7连接前置读出电路11得到科氏力振动电压17,再将前置读出电路10和11的输出端分别连接模数转换器401和402,将模数转换器401和402连接一数字信号处理器400,得到驱动振动电压12和科氏力振动电压17的数字量化信号供数字信号处理器400进行数据处理。
2)在数字信号处理器中设置一同相解调器403,一正交解调器404,两滤波器405、406,加法器409和410,两个PID控制器411、412,一正弦波发生器415,一乘法器417。首先,将A/D转换器401输出端同时接入同相解调器403和正交解调器404。然后,将同相解调器403的输出端串联滤波器405得到解调相位误差信号407、将解调相位误差信号407连接加法器422并与相位控制信号409比较得到相位误差信号再送入PID控制器411得到相位控制信号413,将相位控制信号413连接一正弦波发生器415得到驱动相位信号416。同时,将正交解调器404的输出串联滤波器406得到驱动振动信号幅度408,将振动信号幅度408连接加法器423并与振动幅度参考信号410进行比较得到幅度误差信号再送入PID控制器412得到幅度控制信号414。将驱动相位信号416和幅度控制信号414同时连入乘法器417,并将乘法器417的输出端连接D/A转换器418的输入端,最后将D/A转换器418的输出端连接至至驱动电极2,构成数字闭环驱动。通过该闭环控制,可以使微机电陀螺1在驱动模态方向上以其固有的谐振频率ωnd进行恒幅振动。
3)将A/D转换器402输出端接入同相解调器419,然后,将同相解调器419的输出端串联滤波器420得到角速率输出信号421。
4)角速率输出信号421、解调相位误差信号407、驱动振动信号幅度408、相位控制信号413以及温度传感器502的输出信号503一同送入多元参融合补偿单元500,按照公式(4)进行标度因数预测并进行补偿,得到补偿后的角速率输出501。其中相位控制信号413可以表征驱动频率大小,解调相位误差信号407可以表征θ,驱动振动信号幅度408可以表征R。模态频差Δω可通过温度传感器502的输出503进行拟合得到检测模态谐振频率ωns,进而得出频差。
上述各实施例中,各部件的结构、设置位置及其连接都是可以有所变化的,在本发明技术方案的基础上,对个别部件进行的改进和等同变换,不应排除在本发明的保护范围之外。
Claims (7)
1.基于多参数融合的微机电陀螺标度因数补偿方法,其特征在于:获取微机电陀螺的驱动频率、驱动振动幅度、模态频差和解调相位误差等四个参数的全温变化,为每个参数选定好加权函数,通过拟合算法,将陀螺全温范围内的标度因数同上述四个参数进行多元函数拟合得到标度因数估计值,再用某一温度点下的陀螺的零位输出除以该温度点下的标度因数估计值,完成微机电陀螺标度因数的全温补偿。
2.如权利要求1所述的驱动频率,其特征在于:是驱动模态闭环控制下,陀螺在驱动模态方向上的振动频率。
3.如权利要求2所述的驱动模态闭环控制,其特征在于:可以是模拟闭环控制也可以是数字闭环控制,控制陀螺沿驱动模态方向上在其谐振频率处进行恒幅振动。
4.如权利要求1所述的驱动振动幅度,其特征在于:是驱动模态闭环控制下,陀螺在驱动模态方向上的前置电路输出电压幅度。
5.如权利要求1所述的模态频差,其特征在于:是陀螺驱动模态和检测模态谐振频率的差值。
6.如权利要求1所述的解调相位误差,其特征在于:是陀螺驱动闭环控制电路中驱动电压同驱动检测电压的相位之差。
7.如权利要求1所述的加权函数,其特征在于:可以为常值函数、线性函数、指数函数等任意函数,包含所需拟合的系数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811617310.2A CN111380561B (zh) | 2018-12-28 | 2018-12-28 | 一种基于多参数融合的微机电陀螺标度因数补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811617310.2A CN111380561B (zh) | 2018-12-28 | 2018-12-28 | 一种基于多参数融合的微机电陀螺标度因数补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111380561A true CN111380561A (zh) | 2020-07-07 |
CN111380561B CN111380561B (zh) | 2022-01-14 |
Family
ID=71214554
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811617310.2A Active CN111380561B (zh) | 2018-12-28 | 2018-12-28 | 一种基于多参数融合的微机电陀螺标度因数补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111380561B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113364315A (zh) * | 2021-05-08 | 2021-09-07 | 南昌大学 | 一种基于海鸥优化算法的三相逆变器控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2157425A (en) * | 1984-03-29 | 1985-10-23 | British Aerospace | Fibre interferometric sensors |
US4708479A (en) * | 1983-08-13 | 1987-11-24 | British Aerospace Plc | Fibre optic gyroscope with temperature compensation |
CN102353384A (zh) * | 2011-05-24 | 2012-02-15 | 北京大学 | 微机械陀螺带宽与标度因子的测量方法及系统 |
CN104567849A (zh) * | 2014-12-26 | 2015-04-29 | 东南大学 | 一种硅微机械线振动式陀螺及其带宽拓展方法 |
-
2018
- 2018-12-28 CN CN201811617310.2A patent/CN111380561B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4708479A (en) * | 1983-08-13 | 1987-11-24 | British Aerospace Plc | Fibre optic gyroscope with temperature compensation |
GB2157425A (en) * | 1984-03-29 | 1985-10-23 | British Aerospace | Fibre interferometric sensors |
CN102353384A (zh) * | 2011-05-24 | 2012-02-15 | 北京大学 | 微机械陀螺带宽与标度因子的测量方法及系统 |
CN104567849A (zh) * | 2014-12-26 | 2015-04-29 | 东南大学 | 一种硅微机械线振动式陀螺及其带宽拓展方法 |
Non-Patent Citations (4)
Title |
---|
A.A.TRUSOV. ET AL: "1 PPM precision self-calibration of scale factor in MEMS Coriolis vibratory gyroscopes", 《 2013 TRANSDUCERS & EUROSENSORS XXVII: THE 17TH INTERNATIONAL CONFERENCE ON SOLID-STATE SENSORS, ACTUATORS AND MICROSYSTEMS (TRANSDUCERS & EUROSENSORS XXVII)》 * |
DACHUAN LIU .ET AL: "Research on temperature dependent characteristics and compensation methods for digital gyroscope", 《2008 3RD INTERNATIONAL CONFERENCE ON SENSING TECHNOLOGY》 * |
崔健等: "基于增益在线辨识的微机电陀螺标度因数补偿技术研究", 《导航定位与授时》 * |
杨亮等: "高品质因数微机械陀螺的温度自补偿", 《光学精密工程》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113364315A (zh) * | 2021-05-08 | 2021-09-07 | 南昌大学 | 一种基于海鸥优化算法的三相逆变器控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111380561B (zh) | 2022-01-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111896026B (zh) | 固态谐振陀螺自校准方法及系统 | |
CN111578923B (zh) | 一种谐振式陀螺闭环控制方法与系统 | |
CN102353384B (zh) | 微机械陀螺带宽与标度因子的测量方法及系统 | |
CN111536993B (zh) | 一种振动陀螺电极角度误差的辨识与补偿方法及系统 | |
CN105571576B (zh) | 一种mems陀螺模态匹配电压自动测试方法 | |
CN101799479B (zh) | 用于转速传感器的振动补偿 | |
CN113551660B (zh) | 一种电极角度存在误差时的半球谐振陀螺振型角获取方法 | |
CN110108299B (zh) | 一种硅微机械陀螺仪标度因数在线自校准系统 | |
CN106482747B (zh) | 一种高精度陀螺仪的零偏温度补偿方法 | |
EP3460397B1 (en) | Driving circuit and method for a mems gyroscope and corresponding mems gyroscope | |
CN109813341A (zh) | 一种硅微机械陀螺驱动力耦合误差在线自校准系统 | |
CN105074384A (zh) | 简化校准的陀螺仪以及陀螺仪的简化校准方法 | |
CN109211275A (zh) | 一种陀螺仪的零偏温度补偿方法 | |
CN1764823B (zh) | 物理量测定装置 | |
CN112556827B (zh) | 一种基于激光干涉法的高加速度振动校准方法及装置 | |
US20090150029A1 (en) | Capacitive integrated mems multi-sensor | |
CN115479595A (zh) | 一种半球谐振陀螺分时复用参数辨识系统及方法 | |
CN111380561B (zh) | 一种基于多参数融合的微机电陀螺标度因数补偿方法 | |
CN103344228A (zh) | 摇动质量体声波固体波动微陀螺驱动与检测电路 | |
CN110987016A (zh) | 一种动力调谐陀螺挠性组件动态特性校准系统 | |
CN112964242B (zh) | 一种石英音叉陀螺表头机械耦合误差测试系统及测试方法 | |
CN104678126A (zh) | 基于寄生电阻的电容式微机械加速度计相移温度补偿方法 | |
CN111623759B (zh) | 一种加快微机电陀螺零偏稳定时间的方法 | |
CN107084745A (zh) | 陀螺仪自校准和陀螺仪质量块摆幅测量装置、方法 | |
Liu et al. | Research on temperature dependent characteristics and compensation methods for digital gyroscope |
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 |