The present invention relates to Strapdown Navigation Technology. It finds particular application in conjunction with micro-electro-mechanical systems (MEMS) gyroscopes used as angular rate sensors in Inertial Measurement Units (IMU) and strapdown Inertial Navigation System (INS) for aircraft, missiles, land and underwater vehicles navigation, guidance and control and will be described with particular reference thereto. It will be appreciated, however, that the invention is also amenable to other applications.
The capabilities of the current photolithography processes and microfabrications techniques are inadequate when compared with the requirements for production of high performance MEMS inertial sensors. The resulting inherent imperfections in manufacturing of MEMS gyro sense elements mechanical structure significantly limit the performance, and robustness of MEMS gyroscopes. Because reliable MEMS gyroscopes require tight tolerances (e.g., picometer-scale), MEMS gyroscopes have proven challenging to fabricate and commercialize for high-performance.
The present invention provides a new and improved apparatus and method which addresses the above-referenced problems.
In one embodiment, a micro-gyro device for measuring rotational movement about an input axis includes a driving element generating a driving signal. A MEMS gyro includes a motor rotor and a motor assembly. The motor rotor receives the driving signal and oscillates about a motor axis at a frequency determined as a function of the driving signal. The motor assembly oscillates around a rate axis, which is orthogonal to the motor axis, as a function of the frequency of the motor rotor oscillation. A capacitance of the motor assembly changes as a function of the oscillation of the motor assembly. Driving element feedback circuitry, including a first band-pass filter, is between the motor rotor and the driving element. The driving element feedback circuitry causes the driving element to generate the driving signal as a function of an amplitude of the motor rotor oscillation for maintaining the amplitude of the motor rotor oscillation within a predetermined range. Output circuitry, including a second band-pass filter, produces an output signal as a function of the changing capacitance of the motor assembly. The first and second band-pass filters have central frequency phase characteristics not exceeding about 0.1°/Hz.
In the accompanying drawings which are incorporated in and constitute a part of the specification, embodiments of the invention are illustrated, which, together with a general description of the invention given above, and the detailed description given below, serve to exemplify the embodiments of this invention.
With reference to
The gyro driver 24 generates a driving signal that is electrically transmitted to combs 26 of the outer gimbal 20. In one embodiment, the driving signal has an excitation voltage frequency f of about 3.0 kHz. It is contemplated that the driving signal is a square wave applied at combs 26 spaced apart 90° around the outer gimbal 20. The outer motor rotor 20 oscillates around a drive axis Z in accordance with the driving signal. In the contemplated embodiment, the rotor 20 oscillates at a frequency 2f (e.g., about 6.0 kHz). Oscillation of the outer gimbal 20 causes the inner gimbal 22 to rock around an input axis X at an angular rate ω. When an angular rate ω acts around an input axis X, a Coriolis force proportional to the applied angular rate is transmitted from the motor rotor 20 to the inner gimbal 22 (motor assembly), thereby forcing the motor assembly 22 to rock with the same frequency (about 6.0 kHz) around an output axis Y.
A capacitive pick-off is disposed under the motor assembly 22 and converts oscillation of the motor assembly 22 around the X axis into an electrical signal proportional to the input angular rate. The electrical signal is transmitted to a preliminary amplifier 30 and filtered by first band-pass filter circuitry 32, which is discussed in more detail below. The amplified and filtered electrical signal is converted into DC voltage by a phase sensitive detector (PSD) 34. The DC voltage is buffered by an amplifier 36 and then converted into digital format by an analog-to-digital converter (ADC) 40. The digital signal is then converted into serial code by an interface circuitry 42. The gyro driver 24 controls an oscillation amplitude of the motor rotor 20 via a comb position sensor 44, which transmits a signal representing a position of one of the combs 26 to the gyro driver 24 via second band- pass circuitry 46, which is discussed in more detail below, and an amplifier 50. The position sensor 44 and second band-pass circuitry 46 provides a driving element feedback circuitry. The gyro driver 24 also includes phase-lock-loop (PLL,) circuitry (not shown), which uses the comb position signal to form the switching voltage frequency 2f in phase with the angular rate signal fed into the phase sensitive detector 34 through the amplifier 30 and the first band-pass filter circuitry 32.
Conventional 4-phase drive circuitry secures electrical cancellation of the drive frequency f on capacitive pick-off. Therefore, it is theoretically expected that the only 2f signal proportional to the applied angular rate ω presents in the pick-off output. In this case, the DC voltage output (U) of the phase sensitive detector 34 is described by the following equation:
U=K(U2fCOSφ+Uqsinφ) (1)
The excitation matching mode (electrical cancellation of the first harmonic of the drive frequency in pick-off circuitry) and the quadrature error due to inherent fabrication imperfections are two major challenges in MEMS gyro development. Since the employment of the phase-lock-loop circuitry in the gyro driver 24 maintains the phase shift φ=0 (zero), the quadrature error is reduced and/or minimized. However, the balancing/cancellation of drive circuitry to eliminate the first harmonic feedthrough into the capacitive pick-off is not achieved. Meanwhile, the presence of the first harmonic degrades signal to noise ratio (S/N), and results in restriction of the preliminary amplifier 30 gain, which is specifically crucial for a MEMS gyro operating in a closed-loop mode. Balancing of excitation circuitry by additional capacitive network is not accurate enough and is a highly time consuming process.
With reference to
For the second-order band-pass filter 52, the transfer function (Hs) is given by:
Using the formulas (3) presented above, a high-Q band-pass filter may be designed for a specific resonance frequency. Due to the manufacturing imperfection, the motor resonance frequency (said 3000 Hz) of the MEMS sensing element 12 is varying in the range of ±50 Hz, which corresponds to ±100 Hz variation in the second harmonic rate signal. A resonance frequency shift of ±25 Hz over temperature is an additional factor to consider. Thus, to minimize the phase shift φ which might be introduced by such a band-pass filter the bandwidth β should be at least 250 Hz, which is very challenging to achieve in combination with a high level of suppression (at least 15-20 times) in conventional open-loop gyro operation for first and third harmonics. For closed-loop operation gyros, where big gain is a crucial parameter to achieve desirable accuracy and wide frequency response band, even more effective suppression is desired.
At a 6000 Hz central frequency and a 62 Hz separation between resonance frequencies of filters connected in series, a band of about 250 Hz (see
The embodiments described above accommodate imperfections of the MEMS sensing element 12 manufactured by existing technology without following time consuming capacitive networks adjustment. This is achieved by implementation of the first and second band-pass filter circuitries 32, 46. In the embodiment illustrated in
In the example illustrated in
Including the two CBPFs 32, 46 with matching phase characteristics in the angular rate channel output circuitry 16 and the servo-electronics 14, respectively, reduce and/or minimize the gyro error due to the variation of the phase shift φ between the second harmonic rate signal and the switching voltage on the phase sensitive detector 34.
The illustrated embodiments include the MEMS gyro with the MEMS Coriolis force sensing element 12, the rate signal processing electronics 16 and the motor signal processing electronics 14 with first and second band-pass filter circuitries 32, 46 having matching phase characteristics, each including at least one high-Q band-pass filter. It is also contemplated that multi-cascaded high-Q band-pass filters are included in the first and second band-pass filter circuitries 32, 46. Unique amplitude and phase characteristics of the multi-cascade high-Q band-pass filters are achieved by connecting in series a number (e.g., four (4)) of high-Q band-pass filters 64, 66, 68, 70 with predetermined, incrementally spaced resonance frequencies.
The embodiments discussed above provide a MEMS gyro having an increased yield due to a wider tolerance for acceptable level of contamination of a rate signal by first, third, and higher harmonics. A DC bias shift in the rate signal is also reduced.
Experimental results including a CBPF investigation are illustrated in
While the present invention has been illustrated by the description of embodiments thereof, and while the embodiments have been described in considerable detail, it is not the intention of the applicants to restrict or in any way limit the scope of the appended claims to such detail. Additional advantages and modifications will readily appear to those skilled in the art. Therefore, the invention, in its broader aspects, is not limited to the specific details, the representative apparatus, and illustrative examples shown and described. Accordingly, departures may be made from such details without departing from the spirit or scope of the applicant's general inventive concept.
This application claims the benefit of U.S. Provisional Application No. 60/827,328, filed Sep. 28, 2006, which is hereby incorporated by reference.
Number | Date | Country | |
---|---|---|---|
60827328 | Sep 2006 | US |