WO2015197030A1 - 校正陀螺仪传感器驱动幅度的方法和系统 - Google Patents

校正陀螺仪传感器驱动幅度的方法和系统 Download PDF

Info

Publication number
WO2015197030A1
WO2015197030A1 PCT/CN2015/082554 CN2015082554W WO2015197030A1 WO 2015197030 A1 WO2015197030 A1 WO 2015197030A1 CN 2015082554 W CN2015082554 W CN 2015082554W WO 2015197030 A1 WO2015197030 A1 WO 2015197030A1
Authority
WO
WIPO (PCT)
Prior art keywords
amplitude value
phase
preset
value
resonance phase
Prior art date
Application number
PCT/CN2015/082554
Other languages
English (en)
French (fr)
Inventor
吴骅刚
Original Assignee
无锡华润上华半导体有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 无锡华润上华半导体有限公司 filed Critical 无锡华润上华半导体有限公司
Priority to US15/321,958 priority Critical patent/US10466065B2/en
Priority to JP2016574441A priority patent/JP6395874B2/ja
Publication of WO2015197030A1 publication Critical patent/WO2015197030A1/zh
Priority to US16/673,634 priority patent/US10782148B2/en

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
    • 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
    • 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

Definitions

  • the invention relates to the technical field of microelectronic mechanical systems, and in particular to a method and system for correcting the driving amplitude of a gyro sensor.
  • MEMS Micro Electro Mechanical Systems
  • MEMS Micro Electro Mechanical Systems
  • MEMS Micro Electro Mechanical Systems
  • MEMS technology accelerometers and gyroscopes fabricated using MEMS technology have been widely used in the automotive field and consumer electronics.
  • the PZT (lead zirconate titanate) structure of the gyro sensor can be simulated by the resonant circuit of the RLC. It has a certain resonant frequency. In order to increase the bandwidth, the sinusoidal drive signal of the sensor needs to be divided into forced start-up and maintenance. The three phases of resonance and stop resonance enable the gyroscope to quickly resonate in response to an external trigger event. For an ideal resonant circuit, the driving time and amplitude of the above three stages can be known through the calculation of the formula. However, due to the process variation, non-scale or temperature-dependent characteristics of the sensor manufacturing process, simple formulas often deviate from the facts.
  • a conventional sensor drive detection architecture such as 100 includes a charge amplifier 101, an amplitude phase and angular velocity detector 102, an ADC (analog-to-digital converter) 103, a control module 104, and a DDS+DAC (digital to analog converter) 105.
  • the formula or look-up table module 106 needs to output three different amplitudes to the adjustable gain amplifier 107, so that the sinusoidal signal of the formula or look-up table module 106 is amplified by the adjustable gain amplifier 107 and then divided into forced
  • the sensor 301, the resonance 302, and the stop resonance 303 are driven to drive the sensor, as shown in FIG.
  • the time domain response of the sensor circuit amplitude can be integrated by the charge amplifier 101. To simulate.
  • G is the loop gain from the sensor to the charge amplifier
  • Q is the quality factor of the sensor
  • f is the resonant frequency of the sensor.
  • the ratio of the drive signal strength in the three stages of the 107 adjustable gain amplifier can be calculated as follows according to the resonance loop formula:
  • T1 is the time for forced start-up and T3 is the time for stopping resonance.
  • T1 is equal to T3.
  • Equations (1) and (2)(3) are inversely derived from the ideal RLC loop response signal model.
  • the driving amplitude calculated by using the formula or look-up table often cannot reach the amplitude required to maintain stable resonance, and affects the accuracy of angular velocity detection, especially when the gyroscope causes response attenuation due to the use cause or temperature influence.
  • Traditional method driving also reduces the sensitivity of the corresponding detection speed.
  • a correction gyroscope is also provided A system that drives the amplitude of the sensor.
  • a method of correcting the amplitude of a gyro sensor drive comprising:
  • Monitoring step obtaining an average amplitude value of a waveform of a first preset value that maintains a resonance phase
  • Correcting step if the average amplitude value is lower than the lowest target amplitude value, increasing the preset amplitude value of the maintaining resonance phase; if the average amplitude value is higher than the highest target amplitude value, lowering the maintaining resonance a preset amplitude value of the phase; adjusting a preset amplitude value of the stop resonance phase according to the preset amplitude value of the maintained resonance phase, and adjusting the preset amplitude value of the maintained resonance phase, unadjusted
  • the preset amplitude value of the forced start-up phase and the preset amplitude value of the adjusted stop resonance phase are applied to the next vibration period.
  • a method of correcting the amplitude of a gyro sensor drive comprising:
  • Monitoring step obtaining an average amplitude value of a waveform of a first preset value that maintains a resonance phase
  • Correction step if the average amplitude value is lower than the lowest target amplitude value, the preset amplitude value of the forced start-up phase is increased; if the average amplitude value is higher than the highest target amplitude value, the forced start-up is turned down a preset amplitude value of the phase; adjusting a preset amplitude value of the stop resonance phase according to the preset amplitude value of the forced start-up phase, and adjusting the preset amplitude value of the unrestricted maintaining resonance phase
  • the preset amplitude value of the subsequent forced start-up phase and the preset amplitude value of the adjusted stop resonance phase are applied to the next vibration period.
  • a system for correcting the amplitude of a gyro sensor drive comprising:
  • a monitoring module configured to acquire an average amplitude value of a waveform of a first preset value that maintains a resonance phase
  • a correction module configured to determine a magnitude relationship between the average amplitude value and a lowest target amplitude value and a highest target amplitude value; if the average amplitude value is higher than a highest target amplitude value, lowering a preset amplitude of the maintaining resonance phase a value; adjusting a preset amplitude value of the stop resonance phase according to the preset amplitude value of the maintained resonance phase, and adjusting the preset amplitude value of the maintained resonance phase, the unregulated forced start phase
  • the preset amplitude value and the preset amplitude value of the adjusted stop resonance phase are applied to the next vibration period.
  • a system for correcting the amplitude of a gyro sensor drive comprising:
  • a monitoring module configured to acquire an average amplitude value of a waveform of a first preset value that maintains a resonance phase
  • a correction module configured to determine a magnitude relationship between the average amplitude value and a lowest target amplitude value and a highest target amplitude value; if the average amplitude value is lower than a lowest target amplitude value, increase a preset amplitude value of the forced start-up phase And if the average amplitude value is higher than the highest target amplitude value, lowering the preset amplitude value of the forced start-up phase; adjusting the stop resonance phase according to the preset preset amplitude value of the forced start-up phase Presetting the amplitude value, and applying the unadjusted preset amplitude value of the maintaining resonance phase, the preset amplitude value of the adjusted forced start phase, and the preset amplitude value of the adjusted stop resonance phase to the next vibration cycle.
  • the above method and system for correcting the driving amplitude of the gyro sensor adjusts the magnitude of the driving signal (predetermined amplitude value) through the feedback of the sensor response amplitude signal (average amplitude value) during the sustaining resonance period to maintain the resonance period
  • the response amplitude is close to the same, maintaining the amplitude of the stable resonance and improving the accuracy of the angular velocity detection.
  • the index formula can be used in the software setting mode during the sensor calibration phase, and the response amplitude and driving amplitude obtained in the proofreading phase are recorded in the original non-volatile memory device of the chip, and the response range of the use phase is ensured after the correction. It is equivalent to the correction phase to maintain the consistency of angular velocity detection. At the same time, it can improve the deviation caused by the sensor itself or the subsequent production process, and increase the proportion of good products.
  • the algorithm of the present invention can be implemented using a state machine, and has an advantage in cost.
  • Figure 1 is a conventional sensor drive detection architecture diagram
  • FIG. 2 is a schematic diagram of a sensor drive detection architecture of an embodiment
  • Figure 3 is a schematic diagram of the vibration phase of the sensor
  • FIG. 4 is a flow chart of a method of correcting a driving amplitude of a gyro sensor according to an embodiment
  • Figure 5 is a block diagram of a system for correcting the drive amplitude of a gyro sensor in accordance with an embodiment.
  • FIG. 2 is a schematic diagram of a sensor drive detection architecture of an embodiment, including a charge amplifier 201, an amplitude phase and angular velocity detector 202, an ADC (analog-to-digital converter) 203, a control module 204, a DDS+DAC (digital-to-analog converter) 205, The amplitude correction module 206 and the adjustable gain amplifier 207 are used.
  • Figure 3 is a schematic diagram of the vibration phase of the sensor.
  • the forced start-up phase is the sinusoidal drive signal of the sensor from the start-up to the stable phase
  • the resonance phase is the stable phase of the sinusoidal drive signal of the sensor
  • the stop of the resonance phase is the steady-state stop of the sinusoidal drive signal of the sensor. stage.
  • the first predetermined value be N
  • the average amplitude value of the N waveforms in the latter portion of the sustain resonance phase 302 be SA
  • the average amplitude value of the N waveforms in the front portion of the sustain resonance phase 302 be DA.
  • the rear portion is the phase before the end of the resonance phase 302
  • the front portion is the phase after the start of the resonance phase 302.
  • SA is the average amplitude value of the last N waveforms in the resonance phase 302
  • DA is the average amplitude value of the first N waveforms in the resonance phase 302.
  • the N waveforms may be appropriately offset, even while maintaining any portion of the resonance phase 302.
  • the lowest target amplitude value is AMPL
  • the highest target amplitude value is AMPH
  • the best target amplitude value is AMPM.
  • the selection of AMPL and AMPH also needs to refer to the noise level of the system. (AMPH-AMPL)/2 is slightly larger than the noise value of the system. So that the adaptive algorithm tends to converge.
  • the preset amplitude value of the forced start-up phase 301 is A1
  • the preset amplitude value of the sustain resonance phase 302 is A2
  • the preset amplitude value of the stop resonance phase 303 is A3.
  • A1, A2, and A3 also indicate the actual drive amplitudes of the forced start-up phase 301, the sustain resonance phase 302, and the stop resonance phase 303, respectively.
  • A1, A2, and A3 satisfy the formula:
  • T1 is the time for forced start-up
  • T3 is the time to stop resonance
  • T1 is equal to T3.
  • FIG. 4 is a flow chart of a method of correcting the amplitude of a gyro sensor drive according to an embodiment.
  • a method of correcting the amplitude of a gyro sensor drive includes the steps of:
  • Step S401 Start calibration, and initialize AMPL, AMPM, AMPH, A1, A2, and A3.
  • Step S402 Acquire an average amplitude value SA of the last N waveforms of the maintaining resonance phase 302, and determine whether SA is lower than the lowest target amplitude value AMPL. If yes, go to step S403, if not, go to step S405.
  • Step S403 Increasing the preset amplitude value A2 of the maintaining resonance phase 302, and then obtaining A3 by adjusting the A2, the unadjusted A1, and the formula (4), and adjusting the unadjusted A1 and the adjusted A2.
  • the A3 is applied to the next vibration cycle.
  • A2 is a self-addition 1 process.
  • Step S404 It is judged whether the SA is not lower than the optimal target amplitude value AMPM. If yes, skip to step Step S408, if otherwise, skip to step S403. This determination step is performed in the next vibration period referred to in step S403.
  • Step S405 It is judged whether the SA is higher than the highest target amplitude value AMPH. If yes, go to step S406, if not, go to step S408.
  • Step S406 lowering the preset amplitude value A2 of the maintaining resonance phase 302, and then obtaining A3 by the adjusted A2, the unadjusted A1, and the formula (4), and adjusting the unadjusted A1 and the adjusted A2.
  • the A3 is applied to the next vibration cycle and continues to acquire the SA.
  • A2 is a self-reduction 1 process.
  • Step S407 It is judged whether the SA is not higher than the optimal target amplitude value AMPM. If yes, go to step S408, if not, go to step S406. This determination step is performed in the next vibration period referred to in step S406.
  • steps S403, S404 once the amplitude of SA is smaller than the preset low level (lowest target amplitude value) AMPL, it means that the driving amplitude (A2) of the sustaining resonance phase 302 may be too small, and A2 is incremented until the next cycle.
  • the SA amplitude can be greater than or equal to AMPM.
  • the amplitude of SA is larger than the preset high level (highest target amplitude value) AMPH in steps S406, S407, then A2 is decremented until the SA amplitude of the next period can be less than or equal to AMPM.
  • step S408 the rear-end response amplitude (average amplitude value of the last N waveforms) SA of the resonance phase 302 is maintained to be slowly approaching the AMPM, but the magnitude of the response due to the sustaining resonance phase 302 is also subjected to the forced-on-vibration phase 301.
  • the influence of the drive amplitude (A1) needs to be adjusted for the drive amplitude A1 of the forced start-up phase 301 so that the interval amplitude of the sustain resonance phase 302 is stabilized for the entire period.
  • steps S408, S409, S410, S411, S412, and S413 adjust A1 based on the average amplitude value DA of the first N waveforms of the sustain resonance phase 302.
  • Step S408 Acquire an average amplitude value DA of the first N waveforms of the maintaining resonance phase 302, and judge Whether the broken DA is lower than the lowest target amplitude value AMPL. If yes, go to step S409, if not, go to step S411.
  • Step S409 Increasing the preset amplitude value A1 of the forced start-up phase 301, and then obtaining A3 by adjusting the A1, the unadjusted A2, and the formula (4), and adjusting the adjusted A1 and the unadjusted A2.
  • the DA is continuously acquired.
  • A1 is a self-addition 1 process.
  • Step S410 It is judged whether the DA is not lower than the optimal target amplitude value AMPM. If yes, go to step S409, if not, go to step S414. This determination step is performed in the next vibration period referred to in step S409.
  • Step S411 It is judged whether the DA is higher than the highest target amplitude value AMPH. If yes, go to step S412, if not, go to step S414.
  • Step S412 The preset amplitude value A1 of the forced start-up phase 301 is turned down, then A3 is obtained by the lowered A1, the unadjusted A2, and the formula (4), and the adjusted A1, the unadjusted A2, and the adjustment are obtained. After the A3 is applied to the next vibration cycle, the DA is continuously acquired.
  • A1 is a self-reduction 1 process.
  • Step S413 It is judged whether the DA is not higher than the optimal target amplitude value AMPM. If yes, go to step S414, if not, go to step S412. This determination step is performed in the next vibration period referred to in step S412.
  • Step S415 The calibration is completed.
  • steps S409 and S410 sequentially increment A1 to increase the response of the DA until the DA is greater than or equal to the AMPM.
  • steps S412 and S413 will successively decrement A1 to reduce the response of DA until DA is less than or equal to AMPM.
  • step S414 Since the amplitudes of SA and DA are mutually influential in the process of adjusting A2 and A1, and are positively correlated, if the detection in step S414 cannot be performed, it is necessary to perform the correction again from step S402. Finally, the ideal A1, A2, and A3 driving amplitudes can be obtained and the resonance phase 302 can be maintained. The magnitude of the response approaches AMPM to maintain stable angular velocity detection.
  • the steps of adjusting SA and DA may be performed simultaneously, i.e., each of the vibration stages is synchronized to adjust SA and DA, and it is not necessary to adjust only one of SA or DA as in each of the vibration stages in this embodiment.
  • the optimal target amplitude value AMPM in steps S404, S410 can be replaced with the lowest target amplitude value AMPL, and the optimal target amplitude value AMPM of steps S407, S413 can be replaced with the highest target amplitude value of AMPH, that is, as long as the DA and SA are corrected.
  • the value is between AMPL and AMPH.
  • a system for correcting the amplitude of the gyro sensor drive including a monitoring module 510, a correction module 520, and a gyro sensor 530.
  • the monitoring module 510 should include at least the charge amplifier 201 and the amplitude phase and angular velocity detector 202 of FIG. 2
  • the correction module 520 should at least include the amplitude correction module 206 of FIG.
  • the monitoring module 510 is configured to: acquire an average amplitude value SA of the N waveforms of the latter portion of the resonance phase 302.
  • the correction module 520 is configured to: determine the magnitude relationship between the average amplitude value SA of the N waveforms in the rear portion of the resonance phase 302 and the minimum target amplitude value AMPL and the highest target amplitude value AMPH, and if the SA is lower than the AMPL, the adjustment is maintained.
  • the latter response amplitude (the average amplitude value of the last N waveforms) SA of the resonance phase 302 is slowly approached to the AMPM, but the magnitude of the response due to the sustain resonance phase 302 is also subjected to the forced start-up phase 301.
  • the influence of the drive amplitude (A1) needs to be adjusted for the drive amplitude A1 of the forced start-up phase 301 so that the interval amplitude of the sustain resonance phase 302 is stabilized for the entire period. Therefore, the system will later adjust A1 based on the average amplitude value DA of the first N waveforms of the sustain resonance phase 302.
  • the monitoring module 510 is further configured to: acquire an average amplitude value DA of the N waveforms of the front portion of the resonance phase.
  • the correction module 520 is further configured to: determine a magnitude relationship between an average amplitude value DA of the N waveforms of the front portion of the resonance phase 302 and a minimum target amplitude value AMPL and a highest target amplitude value AMPH; if the DA is lower than the AMPL, adjust The preset amplitude value A1 of the high forced start-up phase; if DA is higher than AMPH, the A1 is lowered; A3 is adjusted according to the adjusted A1, and the adjusted A1, unadjusted A2, and adjusted A3 are applied. The next vibration cycle.
  • the ideal A1, A2, A3 drive amplitudes can be obtained and the response amplitude of the sustain resonance phase 302 is maintained between the lowest target amplitude value AMPL and the highest target amplitude value AMPH to maintain stable angular velocity detection.
  • the steps of adjusting SA and DA may be performed simultaneously, that is, each of the vibration stages is synchronously adjusted to SA and DA, and it is not necessary to adjust only one of SA or DA as in each vibration stage in this embodiment, which may Accelerate convergence, it may oscillate, you need to set the adjustment measure.
  • steps in the flowchart of FIG. 4 are sequentially displayed as indicated by the arrows, these steps are not necessarily performed in the order indicated by the arrows. Except as explicitly stated herein, the execution of these steps is not strictly limited, and may be performed in other sequences. Moreover, at least some of the steps in FIG. 4 may include a plurality of sub-steps or stages, which are not necessarily performed at the same time, but may be executed at different times, and the order of execution thereof is not necessarily This may be performed in sequence, but may be performed alternately or alternately with other steps or at least a portion of the sub-steps or stages of the other steps.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Manufacturing & Machinery (AREA)
  • Gyroscopes (AREA)

Abstract

一种校正陀螺仪传感器驱动幅度的方法，主要通过在维持共振时段内，透过传感器响应幅值信号（平均振幅值）的反馈，来调整驱动信号（预设振幅值）的大小，使维持共振时段的响应幅度趋近一致，维持稳定共振的幅值。还提供了一种校正陀螺仪传感器驱动幅度的系统。

Description

校正陀螺仪传感器驱动幅度的方法和系统 技术领域
本发明涉及微电子机械系统技术领域，特别涉及一种校正陀螺仪传感器驱动幅度的方法和系统。
背景技术
MEMS(Micro Electro Mechanical Systems，微电子机械系统)是利用集成电路制造技术和微加工技术把微结构、微传感器、微执行器、控制处理电路甚至接口、通信和电源等制造在一块或多块芯片上的微型集成系统。随着MEMS技术的发展，利用MEMS技术制作的加速度传感器和陀螺仪已广泛用于汽车领域和消费电子领域。
PZT(锆钛酸铅)架构的陀螺仪传感器可以由RLC的共振回路来模拟，其具有一定的共振频率，在应用上为了增加频宽，需将传感器的正弦驱动信号分为强制起振、维持共振及停止共振三个阶段，使得陀螺仪能迅速的共振以响应外面的触发事件。对于一个理想的共振电路而言，可以透过公式的计算得知以上三个阶段的驱动时间点及幅度大小。但实际上由于传感器制造过程的工艺偏差、非对秤性或是随温度变化的特性，使得简单套用公式往往会偏离事实。
见图1，传统传感器驱动检测的架构如100，其中包括电荷放大器101、幅度相位及角速度检测器102、ADC(模数转换器)103、控制模块104、DDS+DAC(数模转换器)105、公式或查表模块106及可调增益放大器107。
其中为了增加传感器应用的带宽，公式或查表模块106需输出三个不同的幅值到可调增益放大器107，使得公式或查表模块106正弦信号经可调增益放大器107放大后分为强制起振301、维持共振302及停止共振303三个阶段来驱动传感器，见图3。
传感器回路幅值的时域响应经过电荷放大器101积分后可以用指数公式
Figure PCTCN2015082554-appb-000001
来模拟。
其中Y(t)及X(t)分别表示电荷放大器输出及传感器驱动的时域信号，G是从传感器到电荷放大器间的回路增益，Q值是传感器的品质因素，f是传感器的共振频率。
如果想要让电荷放电器输出在A2·G幅度时进行角速度检测，则在107可调增益放大器三个阶段的驱动信号强度比例可依共振回路公式计算如下：
强制起振:
Figure PCTCN2015082554-appb-000002
维持共振:A2＝A2    …(2)
停止共振:
Figure PCTCN2015082554-appb-000003
其中T1是强制起振的时间，T3是停止共振的时间，一般T1相等于T3。
公式(1)(2)(3)是在理想RLC回路响应信号模型的基础上反推得来，然而由于陀螺仪本身在制造上的偏差，往往会使其真正的响应偏离理想模型，所以单纯使用公式或查表所计算得到的驱动幅度往往无法达到维持稳定共振所需设定的幅度，而影响角速度侦测的精确度，特别是在陀螺仪因使用原因或温度影响造成响应衰减时，依传统方法驱动也会降低对应侦测速度的敏感性。
发明内容
基于此，有必要提供一种校正陀螺仪传感器驱动幅度的方法，该方法可以维持稳定共振的幅值，提高角速度侦测的精确度。还提供一种校正陀螺仪 传感器驱动幅度的系统。
一种校正陀螺仪传感器驱动幅度的方法，包括：
监测步骤：获取维持共振阶段的第一预设数值个波形的平均振幅值；
校正步骤：若所述平均振幅值低于最低目标振幅值，则调高所述维持共振阶段的预设振幅值；若所述平均振幅值高于最高目标振幅值，则调低所述维持共振阶段的预设振幅值；根据调节后的所述维持共振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将调节后的所述维持共振阶段的预设振幅值、未调节的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
一种校正陀螺仪传感器驱动幅度的方法，包括：
监测步骤：获取维持共振阶段的第一预设数值个波形的平均振幅值；
校正步骤：若所述平均振幅值低于最低目标振幅值，则调高强制起振阶段的预设振幅值；若所述平均振幅值高于最高目标振幅值，则调低所述强制起振阶段的预设振幅值；根据调节后的所述强制起振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将未调节的所述维持共振阶段的预设振幅值、调节后的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
一种校正陀螺仪传感器驱动幅度的系统，包括：
监测模块，用于获取维持共振阶段的第一预设数值个波形的平均振幅值；
校正模块，用于判断所述平均振幅值与最低目标振幅值和最高目标振幅值的大小关系；若所述平均振幅值高于最高目标振幅值，则调低所述维持共振阶段的预设振幅值；根据调节后的所述维持共振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将调节后的所述维持共振阶段的预设振幅值、未调节的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
一种校正陀螺仪传感器驱动幅度的系统，包括：
监测模块，用于获取维持共振阶段的第一预设数值个波形的平均振幅值；
校正模块，用于判断所述平均振幅值与最低目标振幅值和最高目标振幅值的大小关系；若所述平均振幅值低于最低目标振幅值，则调高强制起振阶段的预设振幅值；若所述平均振幅值高于最高目标振幅值，则调低所述强制起振阶段的预设振幅值；根据调节后的所述强制起振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将未调节的所述维持共振阶段的预设振幅值、调节后的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
上述校正陀螺仪传感器驱动幅度的方法和系统，在维持共振时段内，透过传感器响应幅值信号(平均振幅值)的反馈，来调整驱动信号(预设振幅值)的大小，使维持共振时段的响应幅度趋近一致，维持稳定共振的幅值，提高角速度侦测的精确度。
指数公式可以在传感器校对阶段以软件设定的方式使用，并将校对阶段所得到的响应幅值及驱动幅度记录在芯片原有的非挥发性记忆器件中，在校正后保证使用阶段的响应幅度与校正阶段相当，以维持角速度侦测的一致性。同时，可以改善传感器本身或后续生产流程所引起的偏差，增加良品的比例。在硬件成本上，本发明的算法可以使用状态机的方式来实施，于成本上也有优势。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他实施例的附图。
图1是传统传感器驱动检测架构图；
图2是一实施例的传感器驱动检测架构图；
图3是传感器振动阶段示意图；
图4是一实施例的校正陀螺仪传感器驱动幅度的方法的流程图；
图5是一实施例的校正陀螺仪传感器驱动幅度的系统的模块图。
具体实施方式
为了便于理解本发明，下面将参照相关附图对本发明进行更全面的描述。附图中给出了本发明的较佳实施例。但是，本发明可以以许多不同的形式来实现，并不限于本文所描述的实施例。相反地，提供这些实施例的目的是使对本发明的公开内容的理解更加透彻全面。
除非另有定义，本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的，不是旨在于限制本发明。本文所使用的术语“及/或”包括一个或多个相关的所列项目的任意的和所有的组合。
下面结合附图，对本发明的具体实施方式进行详细描述。
图2是一实施例的传感器驱动检测架构图，包括电荷放大器201、幅度相位及角速度检测器202、ADC(模数转换器)203、控制模块204、DDS+DAC(数模转换器)205、用幅度校正模块206及可调增益放大器207。
图3是传感器振动阶段示意图。
在下述描述中，强制起振阶段为传感器的正弦驱动信号从起振到稳定的阶段，维持共振阶段为传感器的正弦驱动信号的稳定阶段，停止共振阶段为传感器的正弦驱动信号从稳定到停止的阶段。
设第一预设数值为N，维持共振阶段302的后段部分的N个波形的平均振幅值为SA，维持共振阶段302的前段部分的N个波形的平均振幅值为DA。后段部分即维持共振阶段302结束前的阶段，前段部分即维持共振阶段302开始后的阶段。在本实施例中，SA为维持共振阶段302的后N个波形的平均振幅值，DA为维持共振阶段302的前N个波形的平均振幅值。当然在其他实施例中，N个波形可以适当偏移，甚至可以在维持共振阶段302任意部分。
最低目标振幅值为AMPL，最高目标振幅值为AMPH，最佳目标振幅值为AMPM，AMPL和AMPH的选定也需参照系统的噪声准位，(AMPH-AMPL)/2要略大于系统的噪声值以使自适应算法趋于收敛。
强制起振阶段301的预设振幅值为A1，维持共振阶段302的预设振幅值为A2，停止共振阶段303的预设振幅值为A3。为描述方便，A1、A2、A3也分别表示强制起振阶段301、维持共振阶段302、停止共振阶段303的实际驱动振幅。其中A1、A2、A3满足公式：
Figure PCTCN2015082554-appb-000004
Figure PCTCN2015082554-appb-000005
其中T1是强制起振的时间，T3是停止共振的时间，T1等于T3。从而得到公式：
A1＝A2+A3…(4)
图4是一实施例的校正陀螺仪传感器驱动幅度的方法的流程图。
一种校正陀螺仪传感器驱动幅度的方法，包括步骤：
步骤S401：开始校正，初始化AMPL、AMPM、AMPH、A1、A2、A3。
步骤S402：获取维持共振阶段302的后N个波形的平均振幅值SA，判断SA是否低于最低目标振幅值AMPL。若是则跳至步骤S403，若否则跳至步骤S405。
步骤S403：将维持共振阶段302的预设振幅值A2调高，然后通过调高的A2、未调节的A1和公式(4)得到A3，并将未调节的A1、调节后的A2、调节后的A3应用至下一振动周期。在本实施例中A2为自加1处理。
步骤S404：判断SA是否不低于最佳目标振幅值AMPM。若是则跳至步 骤S408，若否则跳至步骤S403。本判断步骤是在步骤S403中所称的下一振动周期中执行的。
步骤S405：判断SA是否高于最高目标振幅值AMPH。若是则跳至步骤S406，若否则跳至步骤S408。
步骤S406：将维持共振阶段302的预设振幅值A2调低，然后通过调节后的A2、未调节的A1和公式(4)得到A3，并将未调节的A1、调节后的A2、调节后的A3应用至下一振动周期，继续获取SA。在本实施例中A2为自减1处理。
步骤S407：判断SA是否不高于最佳目标振幅值AMPM。若是则跳至步骤S408，若否则跳至步骤S406。本判断步骤是在步骤S406中所称的下一振动周期中执行的。
在步骤S403、S404中，一旦SA的幅度比预设的低准位(最低目标振幅值)AMPL小，则表示维持共振阶段302的驱动振幅(A2)可能偏小，要递增A2直到下个周期的SA幅度能大于等于AMPM。同理在步骤S406、S407中如果SA的幅度比预设的高准位(最高目标振幅值)AMPH大，则递减A2直到下个周期的SA幅度能小于等于AMPM。
在校正方法进入步骤S408前，维持共振阶段302的后段响应幅度(后N个波形的平均振幅值)SA已经慢慢逼近AMPM，但是由于维持共振阶段302的响应幅度还受到强制起振阶段301驱动振幅(A1)的影响，需要针对强制起振阶段301的驱动振幅A1进行调整，才能使维持共振阶段302的区间幅度在整个期间持稳。后面步骤S408、S409、S410、S411、S412、S413将根据维持共振阶段302的前N个波形的平均振幅值DA来对A1进行调整。
当然，在其他实施例中，并不需要进入根据DA调整A1的步骤，因为传感器信号的检测更靠近维持共振阶段302后端，所以维持共振阶段302后端SA愈接近AMPM愈能够用来复原信号的检测，所以只需满足AMPL<＝SA<＝AMPH，即完成校正。
步骤S408：获取维持共振阶段302的前N个波形的平均振幅值DA，判 断DA是否低于最低目标振幅值AMPL。若是则跳至步骤S409，若否则跳至步骤S411。
步骤S409：将强制起振阶段301的预设振幅值A1调高，然后通过调高的A1、未调节的A2和公式(4)得到A3，并将调节后的A1、未调节的A2、调节后的A3应用至下一振动周期，继续获取DA。在本实施例中A1为自加1处理。
步骤S410：判断DA是否不低于最佳目标振幅值AMPM。若是则跳至步骤S409，若否则跳至步骤S414。本判断步骤是在步骤S409中所称的下一振动周期中执行的。
步骤S411：判断DA是否高于最高目标振幅值AMPH。若是则跳至步骤S412，若否则跳至步骤S414。
步骤S412：将强制起振阶段301的预设振幅值A1调低，然后通过调低的A1、未调节的A2和公式(4)得到A3，并将调节后的A1、未调节的A2、调节后的A3应用至下一振动周期，继续获取DA。在本实施例中A1为自减1处理。
步骤S413：判断DA是否不高于最佳目标振幅值AMPM。若是则跳至步骤S414，若否则跳至步骤S412。本判断步骤是在步骤S412中所称的下一振动周期中执行的。
步骤S414：判断是否满足AMPL＜＝SA<＝AMPH且AMPL<＝DA<＝AMPH。若是则跳至步骤S415，若否则跳至步骤S402。
步骤S415：校正完毕。
当DA的幅度小于AMPL，步骤S409、S410会逐次递增A1来增加DA的响应直到DA大于等于AMPM。同理当DA大于AMPH，步骤S412、S413会逐次递减A1来减少DA的响应直到DA小于等于AMPM。
因为在调整A2、A1的过程中，SA和DA的幅度是会相互影响的，并且成正相关，如果不能通过步骤S414的检测，需要重新由步骤S402开始再进行校正。最后可以得到理想的A1、A2、A3驱动幅度并使维持共振阶段302 的响应幅度逼近AMPM，以维持稳定的角速度检测。
在一些实施例中，调整SA和DA的步骤可以同时进行，即每一个振动阶段同步调节SA和DA，并不需要像本实施例中每一个振动阶段只调节SA或DA其中一个。
步骤S404、S410中的最佳目标振幅值AMPM可以换成最低目标振幅值为AMPL，步骤S407、S413的最佳目标振幅值AMPM可以换成最高目标振幅值为AMPH，即只要校正DA和SA的值处在AMPL和AMPH之间即可。
见图5，还公开了一种校正陀螺仪传感器驱动幅度的系统，包括监测模块510、校正模块520和陀螺仪传感器530。结合图2，在本实施例中，监测模块510至少应包括图2中的电荷放大器201和幅度相位及角速度检测器202，校正模块520至少应包括图2中的幅度校正模块206。
监测模块510用于：获取维持共振阶段302的后段部分的N个波形的平均振幅值SA。
校正模块520用于：判断维持共振阶段302的后段部分的N个波形的平均振幅值SA与最低目标振幅值AMPL和最高目标振幅值AMPH的大小关系，若SA低于AMPL，则调高维持共振阶段的预设振幅值A2；若SA高于AMPH，则调低A2；根据调节后的A2来调节停止共振阶段的预设振幅值A3，并将未调节的A1、调节后的A2、调节后的A3应用于下一振动周期。
随着逐渐通过SA校正A2，维持共振阶段302的后段响应幅度(后N个波形的平均振幅值)SA已经慢慢逼近AMPM，但是由于维持共振阶段302的响应幅度还受到强制起振阶段301驱动振幅(A1)的影响，需要针对强制起振阶段301的驱动振幅A1进行调整，才能使维持共振阶段302的区间幅度在整个期间持稳。所以系统在后面将根据维持共振阶段302的前N个波形的平均振幅值DA来对A1进行调整。
当然，在其他实施例中，并不需要进入根据DA调整A1的步骤，因为传感器信号的检测更靠近维持共振阶段302后端，所以维持共振阶段302后端SA愈接近AMPM愈能够用来复原信号的检测，所以只需满足AMPL<＝SA <＝AMPH，即完成校正。
所述监测模块510还用于：获取维持共振阶段的前段部分的N个波形的平均振幅值DA。
所述校正模块520还用于：判断维持共振阶段302的前段部分的N个波形的平均振幅值DA与最低目标振幅值AMPL和最高目标振幅值AMPH的大小关系；若DA低于AMPL，则调高强制起振阶段的预设振幅值A1；若DA高于AMPH，则调低A1；根据调节后的A1来调节A3，并将调节后的A1、未调节的A2、调节后的A3应用于下一振动周期。
最后可以得到理想的A1、A2、A3驱动幅度并使维持共振阶段302的响应幅度维持在最低目标振幅值AMPL和最高目标振幅值AMPH之间，以维持稳定的角速度检测。
在一些实施例中，调整SA和DA的步骤可以同时进行，即每一个振动阶段同步调节SA和DA，并不需要像本实施例中每一个振动阶段只调节SA或DA其中一个，这样既可能加快收敛，也可能会震荡，需要设置好调节的量度。
应该理解的是，虽然图4的流程图中的各个步骤按照箭头的指示依次显示，但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明，这些步骤的执行并没有严格的顺序限制，其可以以其他的顺序执行。而且，图4中的至少一部分步骤可以包括多个子步骤或者多个阶段，这些子步骤或者阶段并不必然是在同一时刻执行完成，而是可以在不同的时刻执行，其执行顺序也不必然是依次进行，而是可以与其他步骤或者其他步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
以上所述实施例仅表达了本发明的几种实施方式，其描述较为具体和详细，但并不能因此而理解为对本发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进，这些都属于本发明的保护范围。因此，本发明专利的保护范围应以所附权利要求为准。

Claims (13)

  1. 一种校正陀螺仪传感器驱动幅度的方法，其特征在于，包括：
    监测步骤：获取维持共振阶段的第一预设数值个波形的平均振幅值；
    校正步骤：若所述平均振幅值低于最低目标振幅值，则调高所述维持共振阶段的预设振幅值；若所述平均振幅值高于最高目标振幅值，则调低所述维持共振阶段的预设振幅值；根据调节后的所述维持共振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将调节后的所述维持共振阶段的预设振幅值、未调节的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
  2. 根据权利要求1所述的校正陀螺仪传感器驱动幅度的方法，其特征在于：
    所述监测步骤为：获取维持共振阶段的后段部分的第一预设数值个波形的平均振幅值；
    所述校正步骤为：若所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值低于所述最低目标振幅值，则调高所述维持共振阶段的预设振幅值；若所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值高于所述最高目标振幅值，则调低所述维持共振阶段的预设振幅值；根据调节后的所述维持共振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将调节后的所述维持共振阶段的预设振幅值、未调节的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
  3. 根据权利要求2所述的校正陀螺仪传感器驱动幅度的方法，其特征在于：
    所述校正步骤为：
    若所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值不高于所述最高目标振幅值且不低于所述最低目标振幅值时，获取维持共振阶段的前段部分的第一预设数值个波形的平均振幅值；
    若所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值低于所述最低目标振幅值，则调高所述维持共振阶段的预设振幅值；若所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值高于所述最高目标振幅值，则调低所述维持共振阶段的预设振幅值；
    根据调节后的所述维持共振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将调节后的所述维持共振阶段的预设振幅值、未调节的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期；
    调节后当所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值不高于所述最高目标振幅值且不低于所述最低目标振幅值时，获取维持共振阶段的前段部分的第一预设数值个波形的平均振幅值；
    若所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值低于所述最低目标振幅值，则调高所述强制起振阶段的预设振幅值；若所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值高于所述最高目标振幅值，则调低所述强制起振阶段的预设振幅值；
    根据调节后的所述强制起振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将未调节的所述维持共振阶段的预设振幅值、调节后的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
  4. 根据权利要求3所述的校正陀螺仪传感器驱动幅度的方法，其特征在于：
    所述调节后当所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值不高于所述最高目标振幅值且不低于所述最低目标振幅值时，获取维持共振阶段的前段部分的第一预设数值个波形的平均振幅值的步骤为：
    经所述调高所述维持共振阶段的预设振幅值后，若所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值不低于最佳目标振幅值，或者，经所述调低所述维持共振阶段的预设振幅值后，若所述维持共振阶段的后段 部分的第一预设数值个波形的平均振幅值不高于所述最佳目标振幅值，获取维持共振阶段的前段部分的第一预设数值个波形的平均振幅值；所述最佳目标振幅值不低于所述最低目标振幅值而不高于所述最高目标振幅值；
    经所述调高所述维持共振阶段的预设振幅值后，若所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值低于所述最佳目标振幅值，继续调高所述维持共振阶段的预设振幅值，并根据调节后的所述维持共振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将调节后的所述维持共振阶段的预设振幅值、未调节的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期；
    经所述调低所述维持共振阶段的预设振幅值后，若所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值高于所述最佳目标振幅值，继续调低所述维持共振阶段的预设振幅值，并根据调节后的所述维持共振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将调节后的所述维持共振阶段的预设振幅值、未调节的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
  5. 根据权利要求4所述的校正陀螺仪传感器驱动幅度的方法，其特征在于，所述根据调节后的所述强制起振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将未调节的所述维持共振阶段的预设振幅值、调节后的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期后，若经所述调高所述强制起振阶段的预设振幅值后，所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值不低于所述最佳目标振幅值，或者，经所述调低所述强制起振阶段的预设振幅值后，所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值不高于所述最佳目标振幅值，此时若所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值不高于所述最高目标振幅值且不低于所述最低目标振幅值，且所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值不高于所述最高目标振幅值且不低于所述最低目标振幅值，校正完毕；
    经所述调高所述强制起振阶段的预设振幅值后，若所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值低于所述最佳目标振幅值，继续调高所述强制起振阶段的预设振幅值，并根据调节后的所述强制起振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将未调节的所述维持共振阶段的预设振幅值、调节后的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期；
    经所述调低所述强制起振阶段的预设振幅值后，若所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值高于所述最佳目标振幅值，继续调低所述强制起振阶段的预设振幅值，并根据调节后的所述强制起振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将未调节的所述维持共振阶段的预设振幅值、调节后的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
  6. 根据权利要求1至5任一项所述的校正陀螺仪传感器驱动幅度的方法，其特征在于，最低目标振幅值和最高目标振幅值的差值的二分之一大于陀螺仪传感器的噪声值。
  7. 一种校正陀螺仪传感器驱动幅度的方法，其特征在于，包括：
    监测步骤：获取维持共振阶段的第一预设数值个波形的平均振幅值；
    校正步骤：若所述平均振幅值低于最低目标振幅值，则调高强制起振阶段的预设振幅值；若所述平均振幅值高于最高目标振幅值，则调低所述强制起振阶段的预设振幅值；根据调节后的所述强制起振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将未调节的所述维持共振阶段的预设振幅值、调节后的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
  8. 根据权利要求7所述的校正陀螺仪传感器驱动幅度的方法，其特征在于：
    所述监测步骤为：获取维持共振阶段的前段部分的第一预设数值个波形的平均振幅值；
    所述校正步骤为：若所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值低于所述最低目标振幅值，则调高所述强制起振阶段的预设振幅值；若所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值高于所述最高目标振幅值，则调低所述强制起振阶段的预设振幅值；根据调节后的所述强制起振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将未调节的所述维持共振阶段的预设振幅值、调节后的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
  9. 根据权利要求7至8任一项所述的校正陀螺仪传感器驱动幅度的方法，其特征在于，最低目标振幅值和最高目标振幅值的差值的二分之一大于陀螺仪传感器的噪声值。
  10. 一种校正陀螺仪传感器驱动幅度的系统，其特征在于，包括：
    监测模块，用于获取维持共振阶段的第一预设数值个波形的平均振幅值；
    校正模块，用于判断所述平均振幅值与最低目标振幅值和最高目标振幅值的大小关系；若所述平均振幅值高于最高目标振幅值，则调低所述维持共振阶段的预设振幅值；根据调节后的所述维持共振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将调节后的所述维持共振阶段的预设振幅值、未调节的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
  11. 根据权利要求10所述的校正陀螺仪传感器驱动幅度的系统，其特征在于：
    所述监测模块用于获取维持共振阶段的后段部分的第一预设数值个波形的平均振幅值；
    所述校正模块用于判断所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值与最低目标振幅值和最高目标振幅值的大小关系；若所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值低于所述最低目标振幅值，则调高所述维持共振阶段的预设振幅值；若所述维持共振阶段的后段部分的第一预设数值个波形的平均振幅值高于所述最高目标振幅值， 则调低所述维持共振阶段的预设振幅值；根据调节后的所述维持共振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将调节后的所述维持共振阶段的预设振幅值、未调节的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
  12. 一种校正陀螺仪传感器驱动幅度的系统，其特征在于，包括：
    监测模块，用于获取维持共振阶段的第一预设数值个波形的平均振幅值；
    校正模块，用于判断所述平均振幅值与最低目标振幅值和最高目标振幅值的大小关系；若所述平均振幅值低于最低目标振幅值，则调高强制起振阶段的预设振幅值；若所述平均振幅值高于最高目标振幅值，则调低所述强制起振阶段的预设振幅值；根据调节后的所述强制起振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将未调节的所述维持共振阶段的预设振幅值、调节后的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
  13. 根据权利要求12所述的校正陀螺仪传感器驱动幅度的系统，其特征在于：
    所述监测模块用于获取维持共振阶段的前段部分的第一预设数值个波形的平均振幅值；
    所述校正模块用于判断所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值和所述最低目标振幅值和最高目标振幅值的大小关系；若所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值低于所述最低目标振幅值，则调高所述强制起振阶段的预设振幅值；若所述维持共振阶段的前段部分的第一预设数值个波形的平均振幅值高于所述最高目标振幅值，则调低所述强制起振阶段的预设振幅值；根据调节后的所述强制起振阶段的预设振幅值来调节停止共振阶段的预设振幅值，并将未调节的所述维持共振阶段的预设振幅值、调节后的强制起振阶段的预设振幅值和调节后的停止共振阶段的预设振幅值应用于下一振动周期。
PCT/CN2015/082554 2014-06-26 2015-06-26 校正陀螺仪传感器驱动幅度的方法和系统 WO2015197030A1 (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
US15/321,958 US10466065B2 (en) 2014-06-26 2015-06-26 Method and system for correcting driving amplitude of gyro sensor
JP2016574441A JP6395874B2 (ja) 2014-06-26 2015-06-26 ジャイロセンサーの駆動振幅を校正する方法とシステム
US16/673,634 US10782148B2 (en) 2014-06-26 2019-11-04 Method and system for correcting driving amplitude of gyro sensor

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201410300802.4A CN105333886B (zh) 2014-06-26 2014-06-26 校正陀螺仪传感器驱动幅度的方法和系统
CN201410300802.4 2014-06-26

Related Child Applications (2)

Application Number Title Priority Date Filing Date
US15/321,958 A-371-Of-International US10466065B2 (en) 2014-06-26 2015-06-26 Method and system for correcting driving amplitude of gyro sensor
US16/673,634 Division US10782148B2 (en) 2014-06-26 2019-11-04 Method and system for correcting driving amplitude of gyro sensor

Publications (1)

Publication Number Publication Date
WO2015197030A1 true WO2015197030A1 (zh) 2015-12-30

Family

ID=54936986

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2015/082554 WO2015197030A1 (zh) 2014-06-26 2015-06-26 校正陀螺仪传感器驱动幅度的方法和系统

Country Status (4)

Country Link
US (2) US10466065B2 (zh)
JP (1) JP6395874B2 (zh)
CN (1) CN105333886B (zh)
WO (1) WO2015197030A1 (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001304866A (ja) * 2000-04-19 2001-10-31 Murata Mfg Co Ltd ジャイロ装置及びそのクロストーク低減方法
JP2003294449A (ja) * 2002-03-29 2003-10-15 Aisin Seiki Co Ltd 振動型角速度センサの駆動装置
JP2004294201A (ja) * 2003-03-26 2004-10-21 Denso Corp 振動型角速度センサ
CN101900554A (zh) * 2010-06-24 2010-12-01 西北工业大学 一种多表头陀螺数字化驱动及检测方法
CN102109345A (zh) * 2010-12-13 2011-06-29 谢元平 微机械陀螺数字信号处理方法与装置
CN102519444A (zh) * 2011-11-25 2012-06-27 上海交通大学 微固体模态陀螺的agc自激振荡驱动电路
CN102538774A (zh) * 2011-12-06 2012-07-04 上海交通大学 微固体模态陀螺闭环锁相稳幅驱动电路

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US2428351A (en) * 1943-01-22 1947-10-07 Sperry Gyroscope Co Inc Radio wave reflectivity indicating system
JPS6130128U (ja) 1984-07-24 1986-02-22 石川島芝浦機械株式会社 移動農機の変速装置
JPH0820258B2 (ja) * 1987-07-29 1996-03-04 日本電気ホームエレクトロニクス株式会社 振動ジャイロの駆動方法
JPH0731062B2 (ja) * 1992-02-10 1995-04-10 住友電気工業株式会社 ジャイロのオフセット補正方法及び装置
JP2004085314A (ja) * 2002-08-26 2004-03-18 Sumitomo Precision Prod Co Ltd 振動型ジャイロセンサ
JP4654668B2 (ja) * 2004-03-12 2011-03-23 パナソニック電工株式会社 ジャイロセンサおよびそれを用いたセンサ装置
CN1952601B (zh) * 2006-11-15 2011-04-13 北京航空航天大学 基于fpga的数字式光纤陀螺调制幅度调整装置
CN100449356C (zh) * 2007-01-22 2009-01-07 浙江大学 谐振腔光纤陀螺的三角波相位调制方法及其装置
CN100561241C (zh) * 2007-09-18 2009-11-18 浙江大学 光纤陀螺用的光电探测器幅频特性测试方法
JP5349199B2 (ja) * 2009-08-17 2013-11-20 株式会社ワコー 角速度センサ
JP3159045U (ja) * 2010-02-15 2010-05-06 株式会社ワコー 角速度センサ
KR101332055B1 (ko) * 2011-12-30 2013-11-22 삼성전기주식회사 자이로센서 구동회로 및 구동방법
EP2647952B1 (en) * 2012-04-05 2017-11-15 Fairchild Semiconductor Corporation Mems device automatic-gain control loop for mechanical amplitude drive
CN102928082B (zh) * 2012-11-06 2014-07-30 北京航空航天大学 一种消除调制幅度和光强波动影响的法拉第检测方法
JP6432113B2 (ja) 2014-11-18 2018-12-05 三星電子株式会社Ｓａｍｓｕｎｇ Ｅｌｅｃｔｒｏｎｉｃｓ Ｃｏ．，Ｌｔｄ． リチウム二次電池

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001304866A (ja) * 2000-04-19 2001-10-31 Murata Mfg Co Ltd ジャイロ装置及びそのクロストーク低減方法
JP2003294449A (ja) * 2002-03-29 2003-10-15 Aisin Seiki Co Ltd 振動型角速度センサの駆動装置
JP2004294201A (ja) * 2003-03-26 2004-10-21 Denso Corp 振動型角速度センサ
CN101900554A (zh) * 2010-06-24 2010-12-01 西北工业大学 一种多表头陀螺数字化驱动及检测方法
CN102109345A (zh) * 2010-12-13 2011-06-29 谢元平 微机械陀螺数字信号处理方法与装置
CN102519444A (zh) * 2011-11-25 2012-06-27 上海交通大学 微固体模态陀螺的agc自激振荡驱动电路
CN102538774A (zh) * 2011-12-06 2012-07-04 上海交通大学 微固体模态陀螺闭环锁相稳幅驱动电路

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
JIANG, QINGHUA ET AL.: "An Improved Drive Circuit for Vibratory Microgyroscopes", CHINESE JOURNAL OF SENSORS AND ACTUATORS, vol. 21, no. 3, 15 March 2008 (2008-03-15), pages 536 - 538, ISSN: 1004-1699 *
WANG, XIAOLEI ET AL.: "Design and Implementation of Digital Closed-loop Drive Control System of a MEMS Gyroscope", JOURNAL OF SOUTHEAST UNIVERSITY (ENGLISH EDITION, vol. 28, no. 1, 30 March 2012 (2012-03-30), pages 35 - 40, ISSN: 1003-7985 *

Also Published As

Publication number Publication date
US20170131116A1 (en) 2017-05-11
US10782148B2 (en) 2020-09-22
CN105333886B (zh) 2018-04-06
US10466065B2 (en) 2019-11-05
CN105333886A (zh) 2016-02-17
JP6395874B2 (ja) 2018-09-26
JP2017519215A (ja) 2017-07-13
US20200064152A1 (en) 2020-02-27

Similar Documents

Publication Publication Date Title
KR101881631B1 (ko) 물리적 파라미터를 측정하는 방법 및 그것을 구현하기 위한 전자 회로
US8915262B2 (en) Mass flow controller algorithm with adaptive valve start position
JP6894929B2 (ja) 振動検出及び振幅制御ループを備えるデジタル自動利得制御を有する集積回路水晶振動子
US9476790B2 (en) Pressure gauge calibration apparatus
CN105571778B (zh) 用于修正循环信号中的偏置漂移的算法
CN109995289B (zh) 基于模型参考自适应的永磁同步电机自抗扰控制优化方法
JP2014510472A (ja) マイクロフォン及び２つのバックプレート間で膜を位置決めする方法
JP6235505B2 (ja) 自動調整機能を有するエンコーダの信号処理装置
JP2019510439A (ja) Ｍｅｍｓマイクロフォンおよびｍｅｍｓマイクロフォンの自己較正のための方法
US9645029B2 (en) Force feedback loop for pressure sensors
JP2019121851A (ja) 回路装置、振動デバイス、電子機器及び移動体
WO2015197030A1 (zh) 校正陀螺仪传感器驱动幅度的方法和系统
JP2010054508A (ja) 閉ループ加速度計システムにおける振動整流誤差の削減システム及びその方法
EP3140999A1 (en) Mems microphone and method of operating a mems microphone
US9614513B2 (en) Vibration generation apparatus
WO2017016273A1 (zh) 加速度器
US20190173457A1 (en) Display driving circuit, calibration module, and associated calibration method
WO2018225366A1 (ja) 電子制御装置
US8907731B2 (en) Self-resonant circuit
CN113834970B (zh) 频率计测装置、微控制器和电子设备
KR101481645B1 (ko) 디지털 가버너 제어장치의 pid 게인의 오토튜닝 방법
CN111555690B (zh) 马达振动位移的控制方法、存储介质及电子设备
CN102607542B (zh) 微机械陀螺自适应补偿的方法及装置
WO2021102678A1 (zh) 振动控制方法、终端设备及存储介质
US20150020596A1 (en) Vibration generation apparatus

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 15812438

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2016574441

Country of ref document: JP

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 15321958

Country of ref document: US

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 15812438

Country of ref document: EP

Kind code of ref document: A1