PRECISION GYROSCOPE MODE-MATCHING INSENSITIVE TO RATE INPUT

Information

  • Patent Application
  • 20230304799
  • Publication Number
    20230304799
  • Date Filed
    April 05, 2023
    a year ago
  • Date Published
    September 28, 2023
    10 months ago
Abstract
A precision gyroscope which provides mode matching which is insensitive to rate input in response to continuously monitoring the split between the resonances of the drive and sense modes. A calibration signal, having at least one modulated term whose carrier is synchronous with the excitation in the drive resonator is utilized to modify the feedback signal in the sense resonator. The gyroscope thus does not suffer from corruption of, or from, the rate measurement; whereas the frequency of the calibration signal can be chosen independently of the bandwidth of the rate input.
Description
STATEMENT REGARDING FEDERALLY SPONSORED RESEARCH OR DEVELOPMENT

Not Applicable


NOTICE OF MATERIAL SUBJECT TO COPYRIGHT PROTECTION

A portion of the material in this patent document may be subject to copyright protection under the copyright laws of the United States and of other countries. The owner of the copyright rights has no objection to the facsimile reproduction by anyone of the patent document or the patent disclosure, as it appears in the United States Patent and Trademark Office publicly available file or records, but otherwise reserves all copyright rights whatsoever. The copyright owner does not hereby waive any of its rights to have this patent document maintained in secrecy, including without limitation its rights pursuant to 37 C.F.R. § 1.14.


BACKGROUND
1. Technical Field

The technology of this disclosure pertains generally to mode matching in gyroscopes, and more particularly to mode matching which is insensitive to rate input.


2. Background Discussion

Numerous mode-matched gyroscopes include a means for continuously measuring the difference of the resonant frequencies of the drive and sense resonators and then using further means, for instance electrostatic tuning, to adjust the resonant frequency of the drive mode or sense mode, or both, to force the difference to be zero.


However, accurately measuring the difference between resonant frequencies presents a challenge. In view of this difficulty some researchers try instead to extract the frequency split from the noise profile of the sense resonator. Unfortunately, this solution suffers from limited accuracy and tracking speed and therefore often fails to meet the requirements of precision gyroscopes. Other researchers attempt to extract the frequency split by measuring the amplitude or phase response of the sense mode resonator; however, angular rate directly affects the split measurement. A further approach is to inject a sinusoidal calibration signal into the sense resonator. Yet, since rate measurement and calibration occur simultaneously, care must be taken in this case to avoid interaction. Specifically, the calibration signal must not corrupt the rate measurement, and the extracted frequency split must not depend on the rate signal.


The present state of the art is to choose the frequency of the calibration signal such that it is outside the bandwidth of the rate signal. Unfortunately, this reduces the signal-to-noise ratio of the calibration and consequently the precision of the estimated frequency split.


Accordingly, a need exists for gyroscopes with improved mode matching. The present disclosure fulfills that need and provides additional benefits.


BRIEF SUMMARY

An apparatus and method for continuously monitoring the split between the resonances of the drive and sense modes in a precision gyroscope. While the disclosure utilizes a periodic calibration signal, it does not suffer from corruption of, or from, the rate measurement.


Consequently, the frequency of the calibration signal can be chosen independently of the bandwidth of the rate input and instead set by the required tracking bandwidth of the mode split estimate. The latter is typically dominated by environmental variations, such as temperature and on the order of 1 Hz or less in typical implementations.


Further aspects of the technology described herein will be brought out in the following portions of the specification, wherein the detailed description is for the purpose of fully disclosing preferred embodiments of the technology without placing limitations thereon.





BRIEF DESCRIPTION OF THE SEVERAL VIEWS OF THE DRAWING(S)

The technology described herein will be more fully understood by reference to the following drawings which are for illustrative purposes only:



FIG. 1 is a block diagram showing a gyroscope modeled as two coupled resonators, according to at least one embodiment of the present disclosure.



FIG. 2 is a block diagram of a sense resonator with position (force) feedback, according to at least one embodiment of the present disclosure.



FIG. 3 is a block diagram of a sense resonator with feedback, calibration signal and demodulator, according to at least one embodiment of the present disclosure.





DETAILED DESCRIPTION

1. SINGLE SENSE AXIS GYROSCOPE



FIG. 1 illustrates an example embodiment 10 of a gyroscope with a single sense axis can by modeled as two coupled resonators 14 and 22 capable of vibration in orthogonal axes x and y with resonant frequencies ωx and ωy, quality factors Qx and Qy, and spring constants kx, and ky, respectively. An excitation force Fx(t) 12 is coupled to drive resonator 14, whose velocity {dot over (x)}(t) 16 is output, and leads to Coriolis force 18 (proportional to {dot over (x)}(t)) which provides drive signal Fc(t) 20 into sense mode resonator 22 having sense output y(t) 24.


In many implementations, the modes are dedicated as drive x and sense y, respectively. The electromechanical transfer functions |Hx(s=jω)| and |Hy(s=jω)| of the drive and sense mode resonators have high-Q band-pass characteristics around the resonance frequencies of ωx and ωy


Accordingly, the frequency responses for the x and y resonators are given by:











H
x

(
s
)

=


s

k
x


·

1

1
+

s


ω
x



Q
x



+


(

s

ω
x


)

2








(
1
)











H
y

(
s
)

=


1

k
y


·

1

1
+

s


ω
y



Q
y



+


(

s

ω
y


)

2








The drive mode x is excited, typically using a feedback oscillator circuit, omitted from FIG. 1 for simplicity, to a sinusoidal motion at its resonant frequency ωx with constant displacement or velocity amplitude.


An angular rate input Ωz(t) about the third orthogonal z axis results in a force, usually called Coriolis force 18, at the input of sense mode y that is proportional to the velocity {dot over (x)}(t) 16, resulting at a vibration at the output of the sense resonator, y, with amplitude proportional to Ωz(t). Coriolis force is a coupling from drive to sense mode with the gain of 2mαz·Ωz (t) where m is modal mass of the suspended structure having two degree-of-freedom (DOF) and αz is the angular gain (also known as slip factor or Bryan's factor) of the transducer. In typical gyroscope implementations the amplitude of the vibrations y(t) of the sense resonator are small. Then the Coriolis force at the input of the drive resonator is negligible and has been omitted from the diagram.


Provided that the resonant frequencies of the x and y modes are equal, i.e., ωxy, the amplitude of the vibration at the output of the sense resonator y is amplified by its quality factor Qy. Typically, Qy is large (for example in excess of 1000), translating into significantly enhanced sensitivity and a commensurate increase in rate measurement accuracy that is less susceptible to errors such as noise.


For high quality factor Qy, the amplitude of vibration at the output of the sense resonator can be large, resulting in nonlinearity and other errors that impair the accuracy of the rate measurement.



FIG. 2 illustrates an example embodiment 30 of feedback for the sense resonator. Most implementations use feedback around the sense resonator. The Coriolis force Fc(t) 32 is summed 34 with feedback Ffb(t) 36 as input to sense resonator Hy(s) 38. The signal amplitude y(t) 40 at the output of sense resonator is compared 44 to the desired amplitude Ŷ 42, which is typically zero. The position signal 46 is converted to the feedback force Ffb(t) 36 through electromechanical controller 48 and this feedback force is applied to the input of the resonator to null the vibration at the output of the sense resonator. The controller block typically includes the transduction of position to electrical signal, analog/digital signal acquisition and control, and the transduction of electrical signal to force. The position feedback zeroes out the position y(t). Other implementations instead null the velocity {dot over (y)}(t) at the output of the sense resonator. The method for mode-matching described below applies to both cases.


The above cited increased sensitivity by a factor Qy is contingent on the resonant frequencies of the sense and drive mode resonators, ωx and ωy, being equal. For full benefit, the matching must be better than 1/Qy, for example (ωx−ωy)/ωx<<1/Qy, which usually far exceeds the fabrication accuracy.


3. CONTINUOUS TUNING GYROSCOPE



FIG. 3 illustrates an example embodiment 50 of feedback, calibrations and demodulation from the sense resonator. Similar to what was described for FIG. 2, an excitation force Fc(t) 52 is summed 54 with feedback Ffb(t) 56, the sum of which is input to sense resonator Hy(s) 58. The signal amplitude at the output of sense resonator y(t) 60 is compared 64 to a calibration input Ycal(t) 62 with output 66 directed to controller 68 which generates feedback force Ffb(t) 56 that is applied to the input of the resonator to null the vibration at the output of the sense resonator. A demodulator 70 is shown receiving the output from controller 68 and generating quadrature outputs 72.


The solution to the matching issue is to continuously tune ωx, ωy or both. Doing so requires an accurate estimate of the difference, Δωxyx−ωy. Since in practice Δωxy often varies, for example due to environmental variations such as temperature, pressure, humidity, or package strain, the estimation has to be performed continuously while the gyroscope is in operation, as in measuring angular rate.


3.1. TWO TONE CALIBRATION


A calibration signal Ycal(t) is added to the output of the sense resonator (not the output of the whole system), as shown in FIG. 3. As an example, the derivation shown below assumes a calibration signal consisting of two tones at frequencies ωcal1 and ωcal2:






Y
cal(t)=Ŷcal1·cos(ωxt+Θerr)sin(ωcal1t) +Ŷcal2·sin(ωxt+Θerr)sin(ωcal2t).   (2)


It should be noted that both tones are modulated with carriers sin(ωxt+Θerr) and cos(ωxt+Θerr) that are synchronous with drive mode oscillation {dot over (x)}(t)={circumflex over (X)}ωx·sin(ωxt) . Θerr represents an arbitrary but constant phase shift and accounts for processing delay. For simplicity, Ŷcal1cal2cal without loss of generality to implementations of the present disclosure.


While the analysis below assumes sinusoidal waveforms, other periodic signals may be utilized, such as square, triangle, and sawtooth waves and other waveforms that are modulated with carriers that are synchronous with the drive mode oscillation. Likewise, calibration signals with only one or more than two tones can be utilized without departing from the teachings of the present disclosure.


The analyses below assume amplitude modulated calibration terms, but it will be appreciated that any argument of the calibration waveforms, such as amplitude, phase, and/or frequency, can be modulated to obtain the benefits from the disclosed calibration technique.


The feedback force Ffb(t) can be interpreted as in-phase and quadrature components, Fi(t) and Fq(t), corresponding to the Coriolis and quadrature forces, respectively. They are computed from Ffb(t) as follows:






F
i(t)=2Ffb(t)·sin(ωxt)






F
q(t)=2Ffb(t)·cos(ωxt)   (3)


Fi(t) and Fq(t) are demodulated with the calibration signal carriers sin(ωcal1t), sin(ωcal2t) and their quadrature, cos(ωcal1t), cos(ωcal2t). Each demodulator output is passed through a low-pass filter with bandwidth typically less than the calibration frequencies to remove the images at 2ωcal1 and 2ωcal2 , respectively. After filtering, the results are:






F
i0_1=2Fi(t)sin(ωcal1t)=4Ffb(t)·sin(ωxt)sin(ωcal1t)






F
i90_1=2Fi(t)cos(ωcal1t)=4Ffb(t)·sin(ωxt)cos(ωcal1t)






F
q0_1=2Fq(t)sin(ωcal1t)=4Ffb(t)·cos(ωxt)sin(ωcal1t)






F
q90_1=2Fq(t)cos(ωcal1t)=4Ffb(t)·cos(ωxt)cos(ωcal1t)






F
i0_2=2Fi(t)sin(ωcal2t)=4Ffb(t)·sin(ωxt)sin(ωcal2t)






F
i90_2=2Fi(t)cos(ωcal2t)=4Ffb(t)·sin(ωxt)cos(ωcal2t)






F
q0_2=2Fq(t)sin(ωcal2t)=4Ffb(t)·cos(ωxt)sin(ωcal2t)






F
q90_2=2Fq(t)cos(ωcal2t)=4Ffb(t)·cos(ωxt)cos(ωcal2t)   (4)


Taking into account force feedback and substituting Ycal(t) yields:













F

q

0

_

1


=


2




Y
^

cal

·

k
x

·

ω
x

-
1


·

(



Δω
xy

·

cos

(

Θ
err

)


+



ω
y


2


Q
y



·

sin

(

Θ
err

)



)










F

q

90

_

1


=


2




Y
^

cal

·

k
x

·

ω
x

-
1


·

ω

cal

1


·

sin

(

Θ
err

)










F

q

0

_

2


=


2




Y
^

cal

·

k
x

·

ω
x

-
1


·

(




ω
y


2


Q
y



·

cos

(

Θ
err

)


-


Δω
xy

·

sin

(

Θ
err

)



)










F

q

90

_

2


=


2




Y
^

cal

·

k
x

·

ω
x

-
1


·

ω

cal

2


·

cos

(

Θ
err

)










(
5
)







It should be noted that these signals do not contain the Coriolis force Fc(t) and hence do not depend on angular rate Ωz.


First the phase error Θerr is obtained:










Θ
err

=


tan

-
1


(



F

q

90

_

1



F

q

90

_

2



·


ω

cal

2



ω

cal

1




)





(
6
)







Once the phase error is known, Δωxy and Qy can be found as follows:













Δω
xy

=






F

q

0

_

1


·

cos

(

Θ
err

)


-


F

q

0

_

2


·

sin

(

Θ
err

)






F

q

0

_

1


·


ω

cal

2



ω

cal

1



·

sin

(

Θ
err

)


+


F

q

0

_

2


·

cos

(

Θ
err

)




·

ω

cal


2










Q
y

=






F

q

90

_

1


·


ω

cal

2



ω

cal

1



·

sin

(

Θ
err

)


+


F

q

90

_

2


·

cos

(

Θ
err

)






F

q

0

_

1


·

sin

(

Θ
err

)


+


F

q

0

_

2


·

cos

(

Θ
err

)




·


ω
y


2


ω

cal

2












(
7
)







Equation (6) can also be used to force the phase error to zero by tuning the phase of the calibration signal. Equation (7) becomes with Θerr=0:













Δω
xy

=



F

q

0

_

1



F

q

90

_

2



·

ω

cal


2










Q
y

=



F

q

90

_

2



F

q

0

_

1



·


ω
y


2


ω

cal

2












(
8
)







Although not required for mode-matching, the extracted quality factor Qy of the sense resonator may be useful, such as for monitoring transducer degradation or bias error correction in situations where the bias error is dominated by damping.


Angular rate is obtained from the amplitude of Coriolis force {circumflex over (F)}c(t) of the in-phase component Fi(t) of the feedback force. For simplicity, without loss of generality it is assumed here that Θerr=0.











F
i

(
t
)

=






F
^

c

(
t
)




Coriolis


force


+

2



Y
^

cal



k
x



ω
x

-
1






(




ω
y


2


Q
y



·

sin

(


ω

cal


1



t

)


+


ω

cal


1




cos

(


ω

cal


1



t

)



)




Calibration


tones


at



ω

cal


1





-

2



Y
^

cal



k
x



ω
x

-
1






(



Δω
xy



sin

(


ω

cal


2



t

)


+


ω

cal


2




cos

(


ω

cal


2



t

)



)




Calibration


tones


at



ω

cal


2










(
9
)







Accordingly, Fi(t) equals the Coriolis force plus the calibration tones at the calibration frequencies ωcal1 and ωcal2. These tones can be estimated accurately using Equation (5) and subtracted from Fi(t) to arrive at just the Coriolis force, {circumflex over (F)}c(t):












F
^

c

(
t
)

=



F
i

(
t
)

-


F

q

0

_

2




sin

(


ω

cal


1



t

)


-


F

q

90

_

2





cos

(


ω

cal


1



t

)

·


ω

cal


1



ω

cal


2





+


F

q

0

_

1




sin

(


ω

cal


2



t

)


+


F

q

90

_

1





cos

(


ω

cal


2



t

)

·


ω

cal


2



ω

cal

1










(
10
)







Using this equation, the amplitude of the Coriolis force can be obtained simultaneously with and independent of the calibration signal.


Angular rate Ωz(t) can also be extracted from {circumflex over (F)}c(t)=2mωx{circumflex over (X)}αz·Ωz(t) accurately using Fq0_2 as follows.











Ω
z

(
t
)

=





F
^

c

(
t
)


F

q

90

_

2



·



Y
^

cal


X
^


·

1

α
z


·

ω

cal


2







(
11
)







3.2. SINGLE TONE CALIBRATION


Two tone-calibration, described above, completely removes the calibration signal from the measured amplitude of the Coriolis force, {circumflex over (F)}c(t). However, unlike two-tone calibration, which suppresses leakage of the calibration into the measured rate output, single-tone calibration may require compromises in the choice of the frequency and amplitude of the calibration signal. The analysis below shows how to achieve accurate mode-matching with single-tone calibration and the possible penalty of the accuracy of the rate measurement result.


The calibration signal used is






Y
cal(t)=Ŷcal sin(ωcalt)cos(ωxt)   (12)


A sinusoidal signal is used in this example. It should also be appreciated that just as in two-tone calibration, other signal shapes may be alternatively utilized without departing from teachings of the present disclosure, for example square waves and so forth.


The feedback force Ffb(t) can be interpreted as in-phase and quadrature components, Fi(t) and Fq(t), corresponding to the Coriolis and quadrature forces, respectively. They are computed from Ffb(t) as follows:






F
i(t)=2Ffb(t)·sin(ωxt)






F
q(t)=2Ffb(t)·cos(ωxt)   (13)


Angular rate and the estimated frequency split Δωxy are obtained by demodulating Fi(t) and Fq(t) with the calibration signal carrier sin(ωcalt) and its quadrature cos(ωcalt). The outputs are passed through a low-pass filter with bandwidth typically less than ωcal. After filtering the following is obtained:






F
i0=2Fi(t)sin(ωcalt)=4Ffb(t)·sin(ωxt)sin(ωcalt)






F
i90=2Fi(t)cos(ωcalt)=4Ffb(t)·sin(ωxt)cos(ωcalt)






F
q0=2Fq(t)sin(ωcalt)=4Ffb(t)·cos(ωxt)sin(ωcalt)






F
q90=2Fq(t)cos(ωcalt)=4Ffb(t)·cos(ωxt)cos(ωcalt)   (14)


Taking into account force feedback and substituting Ycal(t) yields:










F

i

0


=


2




Y
ˆ

cal

·

k
x

·

ω
x

-
1


·


ω
y


2


Q
y





+

2



F
c

(
t
)



sin

(


ω
cal


t

)







(
15
)










F

i

9

0


=


2




Y
ˆ

cal

·

k
x

·

ω
x

-
1


·

ω
cal



+

2



F
c

(
t
)



cos

(


ω
cal


t

)










F

q

0


=

2




Y
ˆ

cal

·

k
x

·

ω
x

-
1


·

Δω

x

y











F

q

9

0


=

0
.





The in-phase quadrature force Fq0 is proportional to Δωxy and independent of the Coriolis force, Fc(t) . Analogous to two-tone calibration, it can be used as the input of a feedback controller that modifies ωx, ωy or both to accurately force Fq0, and implicitly Δωxy, to zero. Unlike other approaches to mode-matching that use sinusoidal calibration signals, this technique does not impose any restriction on the bandwidth of the rate input or the frequency of the calibration signal, ωcal. The advantage comes from modulating the calibration signal in-phase with the drive oscillation cos(ωxt).


Angular rate is obtained from the Coriolis force term Fc(t) in the in-phase component Fi(t) of the feedback force:











F
i

(
t
)

=






F
^

c

(
t
)






Coriolis




force




+

2



Y
ˆ

cal



k
x



ω
x

-
1






(




ω
y


2


Q
y




sin


(


ω
cal


t

)


+


ω
cal



cos

(


ω
cal


t

)



)




Calibration


tones


at



ω
cal









(
16
)







As with two-tone calibration, feedforward cancellation can be used in principle to remove the tones and get {circumflex over (F)}c(t), not corrupted by the calibration signal:












F
ˆ

c

(
t
)

=



F
i

(
t
)

-

2



Y
ˆ

cal



k
x




ω
x

-
1


(




ω
y


2


Q
y





sin

(


ω
cal


t

)


+


ω
cal



cos

(


ω
cal


t

)



)







(
17
)







It should be appreciated that this expression depends on the spring constant kx of the drive mode resonator and the amplitude Ŷcal of the calibration signal. These are challenging to estimate with sufficient precision without choosing ωcal to be outside the bandwidth of the rate input or limiting Ŷcal, both of which limit the precision of mode-matching. In those situations, two-tone calibration may be preferable.


The aforementioned expressions and techniques are in terms of forces applied to, or generated by, the gyroscope transducer. Implementations typically will utilize proxies available in the circuit, such as measured voltages or currents (either analog or digital) to represent the same information. The equations presented here can be rewritten in terms of these proxies without loss of generality or departing from the teachings of the present disclosure.


4. GENERAL SCOPE OF THE EMBODIMENTS

Embodiments of the present technology may be described herein with reference to flowchart illustrations of methods and systems according to embodiments of the technology, and/or procedures, algorithms, steps, operations, formulae, or other computational depictions, which may also be implemented as computer program products. In this regard, each block or step of a flowchart, and combinations of blocks (and/or steps) in a flowchart, as well as any procedure, algorithm, step, operation, formula, or computational depiction can be implemented by various means, such as hardware, firmware, and/or software including one or more computer program instructions embodied in computer-readable program code. As will be appreciated, any such computer program instructions may be executed by one or more computer processors, including without limitation a general purpose computer or special purpose computer, or other programmable processing apparatus to produce a machine, such that the computer program instructions which execute on the computer processor(s) or other programmable processing apparatus create means for implementing the function(s) specified.


Accordingly, blocks of the flowcharts, and procedures, algorithms, steps, operations, formulae, or computational depictions described herein support combinations of means for performing the specified function(s), combinations of steps for performing the specified function(s), and computer program instructions, such as embodied in computer-readable program code logic means, for performing the specified function(s). It will also be understood that each block of the flowchart illustrations, as well as any procedures, algorithms, steps, operations, formulae, or computational depictions and combinations thereof described herein, can be implemented by special purpose hardware-based computer systems which perform the specified function(s) or step(s), or combinations of special purpose hardware and computer-readable program code.


Furthermore, these computer program instructions, such as embodied in computer-readable program code, may also be stored in one or more computer-readable memory or memory devices that can direct a computer processor or other programmable processing apparatus to function in a particular manner, such that the instructions stored in the computer-readable memory or memory devices produce an article of manufacture including instruction means which implement the function specified in the block(s) of the flowchart(s). The computer program instructions may also be executed by a computer processor or other programmable processing apparatus to cause a series of operational steps to be performed on the computer processor or other programmable processing apparatus to produce a computer-implemented process such that the instructions which execute on the computer processor or other programmable processing apparatus provide steps for implementing the functions specified in the block(s) of the flowchart(s), procedure (s) algorithm(s), step(s), operation(s), formula(e), or computational depiction(s).


It will further be appreciated that the terms “programming” or “program executable” as used herein refer to one or more instructions that can be executed by one or more computer processors to perform one or more functions as described herein. The instructions can be embodied in software, in firmware, or in a combination of software and firmware. The instructions can be stored local to the device in non-transitory media, or can be stored remotely such as on a server, or all or a portion of the instructions can be stored locally and remotely. Instructions stored remotely can be downloaded (pushed) to the device by user initiation, or automatically based on one or more factors.


It will further be appreciated that as used herein, that the terms processor, hardware processor, computer processor, central processing unit (CPU), and computer are used synonymously to denote a device capable of executing the instructions and communicating with input/output interfaces and/or peripheral devices, and that the terms processor, hardware processor, computer processor, CPU, and computer are intended to encompass single or multiple devices, single core and multicore devices, and variations thereof.


From the description herein, it will be appreciated that the present disclosure encompasses multiple implementations of the technology which include, but are not limited to, the following:


A force-feedback gyroscope apparatus, comprising: a first resonator as a drive resonator having an x-mode excited at its resonant frequency; a second resonator as a sense resonator having a y-mode which is driven by receiving a Coriolis force signal from the output of said first resonator; wherein said second resonator has a feedback signal which combines the y-mode output signal with a calibration signal that is synchronous with the excitation in the x-mode and modulated at one or more calibration frequencies within the bandwidth of the angular rate input.


A force-feedback gyroscope apparatus, comprising: a first resonator as a drive resonator having an x-mode excited at its resonant frequency; a second resonator as a sense resonator having a y-mode which is driven by receiving a Coriolis force signal from the output of said first resonator; wherein said second resonator has a feedback signal which combines the y-mode output signal with a calibration signal that is synchronous with the excitation in the x-mode and modulated at one or more calibration frequencies within the bandwidth of the angular rate input; and wherein the calibration signal, Ycal(t) is the sum of two or more periodic modulated signals with calibration frequencies ωcal1 and ωcal2 and carriers which are modulated in-phase and quadrature with the x-mode displacement and within the bandwidth of the angular rate input.


A method of mode matching a force-feedback gyroscope, comprising: exciting a first resonator, drive resonator, in an x-mode at its resonant frequency; performing sensing on a second resonator, sense resonator, having a y-mode which is driven by receiving a Coriolis force signal from the output of said first resonator; and combining a feedback signal from a y-mode output signal of said second resonator with at least one calibration signal that is synchronous with the excitation in the x-mode.


A force-feedback gyroscope with an x-mode and a y-mode, wherein the x-mode is excited at its resonant frequency, and wherein a calibration signal that is synchronous with the excitation in the x-mode is added to the y-mode.


The apparatus or method of any preceding implementation, wherein the calibration signal, Ycal(t), is the sum of two periodic signals with calibration frequencies ωcal1 and ωcal2 and carriers which are modulated in-phase and quadrature with the x-mode displacement.


The apparatus or method of any preceding implementation, wherein said calibration signal Ycal(t) is generated in response to the relation: Ŷcal1·cos(ωxt+Θerr)sin(ωcal1t)°Ŷcal2·sin(ωxt+Θerr)sin (ωcal2t); and wherein Ŷcal1 is a first calibration input, ωx is the tone frequency of the x-mode of said first resonator, t is time, ωcal1 is a first calibration tone frequency and ωcal2 is the second calibration tone, and θerr represents an arbitrary but constant phase shift and accounts for processing delay.


The apparatus or method of any preceding implementation, further comprising: a demodulator coupled to the feedback signal Ffb(t) of said sense resonator; and said demodulator configured for demodulating in-phase and quadrature components Fi(t) and Fq(t) of feedback signal Ffb(t) and outputting in-phase signals and quadrature signals at 0 and 90 degrees, as Fi0, Fi90, Fq0, and Fq90 for one or more calibration frequencies.


The apparatus or method of any preceding implementation, further comprising: a demodulator coupled to the feedback signal Ffb(t) of said sense resonator; and wherein said demodulator is configured for demodulating in-phase and quadrature components Fi(t) and Fq(t) of feedback signal Ffb(t) and outputting in-phase signals and quadrature signals at 0 and 90 degrees, are determined at two calibration frequencies ωcal1 and ωcal2 as Fi0_1, Fi90_1, Fq0_1, Fq90_1, Fi0_2, Fi90_2, Fq0_2, and Fq90_2.


The apparatus or method of any preceding implementation, further comprising determining phase error Θerr by measuring the ratio between 90 ° phase shifted responses of the quadrature channel to the first and second calibration signals.


The apparatus or method of any preceding implementation, wherein said determining of the phase error Θerr is given by








tan

-
1


(



F


q

90_


1



F

q

90

_

2



·


ω

cal

2



ω

cal

1




)

.




The apparatus or method of any preceding implementation, wherein said phase error Θerr is nulled using feedback.


The apparatus or method of any preceding implementation, wherein the difference of resonant frequencies Δωxy of the x-mode and y-mode, and the y-mode quality factor Qy are estimated by measuring the response of the quadrature channel to the first and second calibration signals.


The apparatus or method of any preceding implementation, wherein the difference of resonant frequencies Δωxy of the x-mode and y-mode, and the y-mode quality factor Qy are estimated as follows:







Δω
xy

=





F

q

0

_

1


·

cos

(

Θ

e

r

r


)


-


F

q

0

_

2


·

sin

(

Θ
err

)






F

q

90

_

1


·


ω

cal

2



ω

cal

1



·

sin

(

Θ
err

)


+


F

q

90

_

2


·

cos

(

Θ
err

)




·

ω

cal

2










Q
y

=





F

q

90

_

1


·


ω

cal

2



ω

cal

1



·

sin

(

Θ
err

)


+


F

q

90

_

2


·

cos

(

Θ

e

r

r


)






F

q

0

_

1


·

sin

(

Θ

e

r

r


)


+


F

q

0

_

2


·

cos

(

Θ

e

r

r


)




·



ω
y


2


ω

cal

2




.






The apparatus or method of any preceding implementation, wherein the estimate Δωxy is nulled using feedback.


The apparatus or method of any preceding implementation, wherein the Coriolis force term {circumflex over (F)}c(t) is independent of the calibration signal, and determined by the cancellation of the error tones in the rate channel using the measured response of the quadrature channel to calibration signals, whereby Coriolis force amplitude is obtained simultaneously, and independent from, the calibration signal.


The apparatus or method of any preceding implementation, wherein the Coriolis force term {circumflex over (F)}c(t) is determined as








F
i

(
t
)

-


F

q

0

_

2




sin

(


ω

cal

1



t

)


-


F

q

90

_

2





cos

(


ω

cal

1



t

)

·


ω

cal

1



ω

cal

2





+


F

q

0

_

1




sin

(


ω

cal

2



t

)


+


F

q

90

_

1





cos

(


ω

cal

2



t

)

·



ω

cal

2



ω

cal

1



.







The apparatus or method of any preceding implementation, further comprising determining an angular rate Ωz(t) is extracted accurately from the Coriolis force term by estimating the gain between the angular rate and the final output, also referred to as scale factor, and sensitivity of a force-rebalance gyroscope using the measured response of the quadrature channel to the calibration signal applied at the sense mode resonator output.


The apparatus or method of any preceding implementation, further comprising determining an angular rate 106z(t) as










F
ˆ

c

(
t
)


F

q

90

_

2



·



Y
ˆ

cal


X
ˆ


·

1

α
z


·


ω

cal

2


.





The apparatus or method of any preceding implementation, wherein the calibration signal comprises a single tone at frequency ωcal modulated with a carrier that has a constant phase relationship with the motion in the x-mode.


The apparatus or method of any preceding implementation, wherein the difference of resonant frequencies Δωxy of the x-mode and y-mode is nulled by minimizing the force Fq0.


The apparatus or method of any preceding implementation, wherein the difference of resonant frequencies Δωxy of the x-mode and y-mode is nulled by setting Fq0 to 0 as follows:








F

i

0


=


2




Y
ˆ

cal

·

k
x

·

ω
x

-
1


·


ω
y


2


Q
y





+

2



F
c

(
t
)



sin

(


ω
cal


t

)




;








F

i

9

0


=


2




Y
ˆ

cal

·

k
x

·

ω
x

-
1


·

ω
cal



+

2



F
c

(
t
)



cos

(


ω
cal


t

)




;








F

q

0


=

2




Y
ˆ

cal

·

k
x

·

ω
x

-
1


·

Δω

x

y





;
and







F

q

9

0


=

0
.





The apparatus or method of any preceding implementation, wherein the Coriolis force term {circumflex over (F)}c(t) is estimated by the cancellation of the error tones due to the applied calibration signal using the pre-characterized or predicted system parameters.


The apparatus or method of any preceding implementation, wherein the Coriolis force term {circumflex over (F)}c(t) is estimated by








F
i

(
t
)

-

2



Y
ˆ

cal



k
x





ω
x

-
1


(




ω
y


2


Q
y





sin

(


ω
cal


t

)


+


ω
cal



cos

(


ω
cal


t

)



)

.






The apparatus or method of any preceding implementation, wherein the calibration signal, Ycal(t), is the sum of two or more modulated signals in which at least one of the amplitude, phase, or frequency arguments are modulated at different calibration frequencies with carriers having different phase relationships with respect to the drive mode displacement.


The apparatus or method of any preceding implementation, wherein the calibration signal is added to the output of the y-mode.


The apparatus or method of any preceding implementation, wherein the calibration signal is the sum of two sinusoids with calibration frequencies ωcal1 and ωcal2 and carriers modulated in-phase and quadrature with the x-mode displacement, respectively as shown in Equation (2).


The apparatus or method of any preceding implementation, wherein the phase error in the system is estimated using Equation (6).


The apparatus or method of any preceding implementation, wherein the estimate of the phase error is nulled using feedback.


The apparatus or method of any preceding implementation, wherein the difference of resonant frequencies Δωxy of the x-mode and y-mode and the y-mode damping Qy are estimated using Equations (7).


The apparatus or method of any preceding implementation, wherein the estimate Δωxy is nulled using feedback.


The apparatus or method of any preceding implementation, wherein the Coriolis force term independent of the calibration signal is derived from Equation (10).


The apparatus or method of any preceding implementation, wherein angular rate is extracted accurately from the Coriolis force term as shown in Equation (11).


The apparatus or method of any preceding implementation, wherein the calibration signal is a single tone at frequency ωcal modulated with a carrier that has a constant phase relationship with the motion in the x-mode.


The apparatus or method of any preceding implementation, wherein the difference of resonant frequencies Δωxy of the x-mode and y-mode is nulled by minimizing the force Fq0 in Equation (15).


The apparatus or method of any preceding implementation, wherein the Coriolis force term is estimated using Equation (17).


Each and every embodiment of the technology described herein, as well as any aspect, component, or element of any embodiment described herein, and any combination of aspects, components or elements of any embodiment described herein.


As used herein, term “implementation” is intended to include, without limitation, embodiments, examples, or other forms of practicing the technology described herein.


As used herein, the singular terms “a,” “an,” and “the” may include plural referents unless the context clearly dictates otherwise. Reference to an object in the singular is not intended to mean “one and only one” unless explicitly so stated, but rather “one or more.”


Phrasing constructs, such as “A, B and/or C”, within the present disclosure describe where either A, B, or C can be present, or any combination of items A, B and C. Phrasing constructs indicating, such as “at least one of” followed by listing a group of elements, indicates that at least one of these group elements is present, which includes any possible combination of the listed elements as applicable.


References in this disclosure referring to “an embodiment”, “at least one embodiment” or similar embodiment wording indicates that a particular feature, structure, or characteristic described in connection with a described embodiment is included in at least one embodiment of the present disclosure. Thus, these various embodiment phrases are not necessarily all referring to the same embodiment, or to a specific embodiment which differs from all the other embodiments being described. The embodiment phrasing should be construed to mean that the particular features, structures, or characteristics of a given embodiment may be combined in any suitable manner in one or more embodiments of the disclosed apparatus, system or method.


As used herein, the term “set” refers to a collection of one or more objects. Thus, for example, a set of objects can include a single object or multiple objects.


Relational terms such as first and second, top and bottom, and the like may be used solely to distinguish one entity or action from another entity or action without necessarily requiring or implying any actual such relationship or order between such entities or actions.


The terms “comprises,” “comprising,” “has”, “having,” “includes”, “including,” “contains”, “containing” or any other variation thereof, are intended to cover a non-exclusive inclusion, such that a process, method, article, or apparatus that comprises, has, includes, contains a list of elements does not include only those elements but may include other elements not expressly listed or inherent to such process, method, article, or apparatus. An element proceeded by “comprises . . . a”, “has . . . a”, “includes . . . a”, “contains . . . a” does not, without more constraints, preclude the existence of additional identical elements in the process, method, article, or apparatus that comprises, has, includes, contains the element.


As used herein, the terms “approximately”, “approximate”, “substantially”, “essentially”, and “about”, or any other version thereof, are used to describe and account for small variations. When used in conjunction with an event or circumstance, the terms can refer to instances in which the event or circumstance occurs precisely as well as instances in which the event or circumstance occurs to a close approximation. When used in conjunction with a numerical value, the terms can refer to a range of variation of less than or equal to ±10% of that numerical value, such as less than or equal to ±5%, less than or equal to ±4%, less than or equal to ±3%, less than or equal to ±2%, less than or equal to ±1%, less than or equal to ±0.5%, less than or equal to ±0.1%, or less than or equal to ±0.05%. For example, “substantially” aligned can refer to a range of angular variation of less than or equal to ±10°, such as less than or equal to ±5°, less than or equal to ±4°, less than or equal to ±3°, less than or equal to ±2°, less than or equal to ±1°, less than or equal to ±0.5°, less than or equal to ±0.1°, or less than or equal to ±0.05°.


Additionally, amounts, ratios, and other numerical values may sometimes be presented herein in a range format. It is to be understood that such range format is used for convenience and brevity and should be understood flexibly to include numerical values explicitly specified as limits of a range, but also to include all individual numerical values or sub-ranges encompassed within that range as if each numerical value and sub-range is explicitly specified. For example, a ratio in the range of about 1 to about 200 should be understood to include the explicitly recited limits of about 1 and about 200, but also to include individual ratios such as about 2, about 3, and about 4, and sub-ranges such as about 10 to about 50, about 20 to about 100, and so forth.


The term “coupled” as used herein is defined as connected, although not necessarily directly and not necessarily mechanically. A device or structure that is “configured” in a certain way is configured in at least that way, but may also be configured in ways that are not listed.


Benefits, advantages, solutions to problems, and any element(s) that may cause any benefit, advantage, or solution to occur or become more pronounced are not to be construed as a critical, required, or essential features or elements of the technology describes herein or any or all the claims.


In addition, in the foregoing disclosure various features may be grouped together in various embodiments for the purpose of streamlining the disclosure. This method of disclosure is not to be interpreted as reflecting an intention that the claimed embodiments require more features than are expressly recited in each claim. Inventive subject matter can lie in less than all features of a single disclosed embodiment.


The abstract of the disclosure is provided to allow the reader to quickly ascertain the nature of the technical disclosure. It is submitted with the understanding that it will not be used to interpret or limit the scope or meaning of the claims.


It will be appreciated that the practice of some jurisdictions may require deletion of one or more portions of the disclosure after that application is filed. Accordingly the reader should consult the application as filed for the original content of the disclosure. Any deletion of content of the disclosure should not be construed as a disclaimer, forfeiture or dedication to the public of any subject matter of the application as originally filed.


The following claims are hereby incorporated into the disclosure, with each claim standing on its own as a separately claimed subject matter.


Although the description herein contains many details, these should not be construed as limiting the scope of the disclosure but as merely providing illustrations of some of the presently preferred embodiments. Therefore, it will be appreciated that the scope of the disclosure fully encompasses other embodiments which may become obvious to those skilled in the art.


All structural and functional equivalents to the elements of the disclosed embodiments that are known to those of ordinary skill in the art are expressly incorporated herein by reference and are intended to be encompassed by the present claims. Furthermore, no element, component, or method step in the present disclosure is intended to be dedicated to the public regardless of whether the element, component, or method step is explicitly recited in the claims. No claim element herein is to be construed as a “means plus function” element unless the element is expressly recited using the phrase “means for”. No claim element herein is to be construed as a “step plus function” element unless the element is expressly recited using the phrase “step for”.

Claims
  • 1. A force-feedback gyroscope apparatus, comprising: a first resonator as a drive resonator having an x-mode excited at its resonant frequency;a second resonator as a sense resonator having a y-mode which is driven by receiving a Coriolis force signal from the output of said first resonator; andwherein said second resonator has a feedback signal which combines the y-mode output signal with a calibration signal that is synchronous with the excitation in the x-mode, and modulated at one or more calibration frequencies within the bandwidth of the angular rate input.
  • 2. The gyroscope apparatus of claim 1, wherein the calibration signal, Ycal(t), is the sum of two periodic signals with calibration frequencies ωcal1 and ωcal2 and carriers which are modulated in-phase and quadrature with the x-mode displacement.
  • 3. The gyroscope apparatus of claim 2, wherein said calibration signal) Ycal(t) is generated in response to the relation: Ŷcal1·cos(ωxt+Θerr)sin(ωcal1t)+·Ŷcal2·sin(ωxt+Θerr)sin(ωcal2t); andwherein Ŷcal1 is a first calibration input, ωx is the tone frequency of the x-mode of said first resonator, t is time, ωcal1 is a first calibration tone frequency and ωcal1 is the second calibration tone, and Θerr represents an arbitrary but constant phase shift and accounts for processing delay.
  • 4. The gyroscope apparatus of claim 3, further comprising: a demodulator coupled to the feedback signal Ffb(t) of said sense resonator; andwherein said demodulator is configured for demodulating in-phase and quadrature components Fi(t) and Fq(t) of feedback signal Ffb(t) and outputting in-phase signals and quadrature signals at 0 and 90 degrees, as Fi0, Fi90, Fq0, and Fq90, for one or more calibration frequencies.
  • 5. The gyroscope apparatus of claim 3, further comprising: a demodulator coupled to the feedback signal Ffb(t) of said sense resonator; andwherein said demodulator is configured for demodulating in-phase and quadrature components Fi(t) and Fq(t) of feedback signal Ffb(t) and outputting in-phase signals and quadrature signals at 0 and 90 degrees, are determined at two calibration frequencies ωcal1 and ωcal2 as Fi0_1, Fi90_1, Fq0_1, Fq90_1, Fi0_2, Fi90_2, Fq0_2, and Fq90_2.
  • 6. The gyroscope apparatus of claim 5, further comprising determining phase error Θerr by measuring the ratio between 90° phase shifted responses of the quadrature channel to the first and second calibration signals.
  • 7. The gyroscope apparatus of claim 6, wherein said determining of the phase error Θerr is given by
  • 8. The gyroscope apparatus of claim 6, wherein said phase error Θerr is nulled using feedback. 9. The gyroscope apparatus of claim 6, wherein a difference of resonant frequencies Δωxy of the x-mode and y-mode, and a y-mode quality factor Qy are estimated by measuring the response of the quadrature channel to the first and second calibration signals.
  • 10. The gyroscope apparatus of claim 9, wherein the difference of resonant frequencies Δωxy of the x-mode and y-mode, and the y-mode quality factor Qy are estimated as follows:
  • 11. The gyroscope apparatus of claim 9, wherein the estimate Δωxy is nulled using feedback.
  • 12. The gyroscope apparatus of claim 5, wherein the Coriolis force term {circumflex over (F)}c(t) is independent of the calibration signal, and determined by the cancellation of the error tones in the rate channel using the measured response of the quadrature channel to calibration signals, whereby Coriolis force amplitude is obtained simultaneously, and independent from, the calibration signal.
  • 13. The gyroscope apparatus of claim 12, wherein the Coriolis force term {circumflex over (F)}c(t) is determined as
  • 14. The gyroscope apparatus of claim 12, further comprising determining an angular rate Ωz(t) is extracted accurately from the Coriolis force term by estimating the gain between the angular rate and the final output, also referred to as scale factor, and sensitivity of a force-rebalance gyroscope using the measured response of the quadrature channel to the calibration signal applied at the sense mode resonator output.
  • 15. The gyroscope apparatus of claim 14, further comprising determining an angular rate Ωz(t) as
  • 16. The gyroscope apparatus of claim 4, wherein the calibration signal comprises a single tone at frequency ωcal modulated with a carrier that has a constant phase relationship with the motion in the x-mode.
  • 17. The gyroscope apparatus of claim 16, wherein the difference of resonant frequencies Δωxy of the x-mode and y-mode is nulled by minimizing the force Fq0.
  • 18. The gyroscope apparatus of claim 17, wherein the difference of resonant frequencies Δωxy of the x-mode and y-mode is nulled by setting Fq0 to 0 as follows:
  • 19. The gyroscope apparatus of claim 16, wherein the Coriolis force term {circumflex over (F)}c(t) is estimated by the cancellation of the error tones due to the applied calibration signal using the pre-characterized or predicted system parameters.
  • 20. The gyroscope apparatus of claim 19, wherein the Coriolis force term {circumflex over (F)}c(t) is estimated by
  • 21. The gyroscope apparatus of claim 1, wherein the calibration signal,) Ycal(t), is the sum of two or more modulated signals in which at least one of the amplitude, phase, or frequency arguments are modulated at different calibration frequencies with carriers having different phase relationships with respect to the drive mode displacement.
  • 22. A force-feedback gyroscope apparatus, comprising: a first resonator as a drive resonator having an x-mode excited at its resonant frequency;a second resonator as a sense resonator having a y-mode which is driven by receiving a Coriolis force signal from the output of said first resonator;wherein said second resonator has a feedback signal which combines the y-mode output signal with a calibration signal that is synchronous with the excitation in the x-mode, and modulated at one or more calibration frequencies within the bandwidth of the angular rate input; andwherein the calibration signal, Ycal(t) is the sum of two or more periodic modulated signals with calibration frequencies ωcal1 and ωcal2 and carriers which are modulated in-phase and quadrature with the x-mode displacement and modulated at one or more calibration frequencies within the bandwidth of the angular rate input.
  • 23. A method of mode matching a force-feedback gyroscope, comprising: exciting a first resonator, drive resonator, in an x-mode at its resonant frequency;performing sensing on a second resonator, sense resonator, having a y-mode which is driven by receiving a Coriolis force signal from the output of said first resonator; andcombining a feedback signal from a y-mode output signal of said second resonator with at least one calibration signal that is synchronous with the excitation in the x-mode.
CROSS-REFERENCE TO RELATED APPLICATIONS

This application claims priority to, and is a 35 U.S.C. § 111(a) continuation of, PCT international application number PCT/US2021/055244 filed on Oct. 15, 2021, incorporated herein by reference in its entirety, which claims priority to, and the benefit of, U.S. provisional patent application Ser. No. 63/093,190 filed on Oct. 17, 2020, incorporated herein by reference in its entirety. Priority is claimed to each of the foregoing applications. The above-referenced PCT international application was published as PCT International Publication No. WO 2022/082018 A1on Apr. 21, 2022, which publication is incorporated herein by reference in its entirety.

Provisional Applications (1)
Number Date Country
63093190 Oct 2020 US
Continuations (1)
Number Date Country
Parent PCT/US2021/055244 Oct 2021 US
Child 18130999 US