Gyroscope loop filter

Abstract

There is provided a method of sensing a rotation rate using a vibrating structure gyroscope, said gyroscope comprising an electronic control system comprising one or more control loops, wherein at least one of said control loops comprises a filter having a variable time constant, said method comprising the steps of: determining or estimating a characteristic of the vibrating structure of said gyroscope; and adapting or varying said time constant of said filter with the determined or estimated characteristic of said vibrating structure.

Claims

1. A method of sensing a rotation rate using a vibrating structure gyroscope, said gyroscope comprising an electronic control system comprising one or more control loops, wherein at least one of said control loops comprises a filter having a variable time constant, said method comprising the steps of: determining or estimating a natural bandwidth of the vibrating structure of said gyroscope; and adapting or varying said time constant of said filter so as to match and track the determined or estimated natural bandwidth of said vibrating structure, so as to provide a constant output bandwidth for the control loop.

2. The method as claimed in claim 1, wherein said step of determining or estimating a characteristic of said vibrating structure comprises measuring a temperature of said vibrating structure.

3. The method as claimed in claim 1, wherein said gyroscope comprises a primary axis and a secondary axis, and said control loop detects and/or controls motion on said secondary axis of said gyroscope.

4. The method as claimed in claim 3, further comprising causing said vibrating element to vibrate along said primary axis, and measuring the response of the vibrating element in said secondary axis so as to give a measure of the rotation rate of the gyroscope.

5. The method as claimed in claim 1, wherein said adapting or varying a time constant of said filter modifies an output or rate measurement bandwidth of said gyroscope.

6. The method as claimed in claim 1, wherein said filter or control loop comprises a transfer function comprising said characteristic of said vibrating structure.

7. The method as claimed in claim 6, wherein said transfer function is proportional to or otherwise correlated with said characteristic of said vibrating structure.

8. The method as claimed in claim 7, wherein Q is calculated using said characteristic of the vibrating structure.

9. The method as claimed in claim 6, wherein said transfer function is of the form: $\mathrm{TF}\left(s\right)=\frac{\frac{{\mathrm{AQ}}^{}s}{{}_n}+C}{B},$ where A, B and C are constants, .sub.n is the resonant frequency of the vibrating structure, s represents frequency and Q is an estimated Q-factor or estimated magnification factor of the vibrating structure.

10. The method as claimed in claim 1, further comprising determining an initial time constant based on an initial value of said characteristic, and wherein said adapting or varying said time constant comprises adapting or varying said initial time constant.

11. The method as claimed in claim 1, further comprising measuring a rotation rate of said gyroscope.

12. A system for sensing a rotation rate using a vibrating structure gyroscope, said gyroscope comprising an electronic control system comprising one or more control loops, wherein at least one of said control loops comprises a filter having a variable time constant, wherein said electronic control system is arranged and adapted to: determine a natural bandwidth of the vibrating structure of said gyroscope; and vary said time constant of said filter so as to match and track the determined natural bandwidth of said vibrating structure, so as to provide a constant output bandwidth for the control loop.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) Various embodiments will now be described, by way of example only, and with reference to the accompanying drawings in which:

(2) FIG. 1 shows a typical frequency response using a conventional Coriolis gyroscope loop filter;

(3) FIG. 2 shows an embodiment of a loop filter according to the disclosure; and

(4) FIGS. 3a-3c show frequency responses using the loop filter of FIG. 3 in a gyroscope according to the disclosure.

DETAILED DESCRIPTION

(5) A vibrating structure gyroscope for use in an inertial measurement unit (IMU) in accordance with the disclosure will now be described.

(6) Vibrating structure gyroscopes typically use the principles of the Coriolis effect to output a rotation rate, or otherwise detect rotational motion. A vibrating structure gyroscope may include a vibrating structure or sensor such as a vibrating element in the form of a mechanical resonator, such as a beam, tuning fork or ring resonator. The vibrating structure may be excited into resonance by an electromagnetic drive means, and may be fabricated using a microelectromechanical systems (MEMS) process. Other drive means may be employed, such as those including optical, thermal expansion, piezo-electric or electrostatic effects.

(7) The vibrating element may be caused to vibrate along a primary axis, and the response of the vibrating element in a secondary axis (which is different to the primary axis) during rotation may be used to give a measure of the rotation rate.

(8) One or more control loops may be used to activate the primary axis and adjust the amplitude and frequency of the drive signals in order to establish the primary axis motion at its resonant frequency.

(9) The primary axis response and the secondary axis response of the vibrating structure, such as a mechanical resonator in a spring-mass system, when considered around their resonant frequencies can each be described by the classical 2.sup.nd order transfer function as follows:

(10) $\begin{array}{cc}\mathrm{TF}\left(s\right)=\frac{{}_n^2}{s^2+\frac{{}_{n}s}{Q}+{}_n^2}& \left[1\right]\end{array}$
where s is the complex frequency used in Laplace transform notation, .sub.n is the natural frequency of the mechanical resonator and Q is the magnification factor.

(11) The resonant frequency of the secondary axis may be designed and adjusted to match the resonant frequency of the primary axis to a high degree of accuracy in which case the two transfer functions (for each of the primary and secondary axes) can be considered identical.

(12) As the system is operated at its natural resonant frequency (.sub.n) the response can be transformed to a baseband equivalent response by using the substitution s=j(.sub.n+co) where .sub.n is the natural resonant frequency and co is now the baseband (modulation) frequency of interest.

(13) The baseband equivalent transfer function of the resonator can thus be rewritten as:

(14) $\begin{array}{cc}\mathrm{TF}\left(s\right)=\frac{\frac{2\mathrm{Qs}}{{}_n}}{1+\frac{2Q}{{}_n}s}& \left[2\right]\end{array}$
which is a simple first order low pass filter with a time constant defined by 2Q/.sub.n and therefore a bandwidth defined by .sub.n/2Q.

(15) In an example .sub.n=100,000, Q=30,000 and the time constant may typically be 0.6 seconds and the bandwidth may be 1.66 rad/s, or more conveniently expressed as 0.26 Hz.

(16) The natural bandwidth of such a sensor may, then, be very low (0.26 Hz) and high performance, balanced systems may require an output bandwidth nearer 100 Hz. It has been found that some means of extending the bandwidth may be necessary, so that the output, or rate measurement bandwidth is larger than the natural bandwidth of the sensor.

(17) In this regard, the electronic control system of the gyroscope may comprise one or more separate control loops to preferably detect and control the motion on the secondary axis. These control loops may also be used to modify the output, or rate measurement bandwidth, so that it may be above the natural bandwidth of the sensor and in order to suit the system requirements (for example 100 Hz).

(18) A control loop of the electronic control system of the gyroscope is shown in FIG. 2, and may include one or more of a summing junction 12, a sensor or sensor head 14, loop filter 16, and integrator 20. The control loop may be for detecting and/or controlling motion on the secondary axis of the gyroscope. The actual angular rate may refer to the real motion that the gyroscope is trying to measure. This may also be termed input angular rate. The measured angular rate may refer to the estimate made by the gyroscope of the input angular rate, and may be referred to as the output angular rate.

(19) The components of the loop introduce various phase lags, which together with the phase lag produced by natural bandwidth of the sensor may require the inclusion of a phase lead to provide a stable loop. Therefore the loop filter 16 may be a phase lead filter.

(20) In accordance with the disclosure, the time constant of the loop filter 16 may be adapted or varied, preferably so as to match and track a characteristic, for example the natural bandwidth of the sensor or vibrating structure 14. The characteristic may also be or comprise frequency, Q-factor or temperature of the vibrating structure. This may advantageously provide a flat low frequency gain response and a constant, or temperature independent output bandwidth of the signal output from the control loop. In this manner, the disclosure preferably compensates for Q-factor and frequency variations, and minimises noise.

(21) The time constant of the loop filter 16 may initially be determined based on the natural bandwidth of the vibrating structure 14 calculated from knowledge of its resonant frequency and/or nominal Q-factor. The adaptation of the time constant may then be achieved by tracking the resonant frequency and/or the Q-factor of the vibrating structure in use.

(22) Both the resonant frequency and the Q-factor of the vibrating structure may vary significantly with its temperature. That is, there may exist a strong correlation between the resonant frequency and Q-factor of the vibrating structure with its temperature. This correlation is defined by a very simple relationship as follows:

(23) $\begin{array}{cc}Q\left(T\right)=\frac{Q_0}{1+\mathrm{QTC}\left(T-T_0\right)}& \left[3\right]\end{array}$
where Q(T) is the Q at any temperature T, QTC is the temperature coefficient of Q (generally a constant value of typically 0.006) , T.sub.0 is the reference temperature and Q.sub.0 is the nominal Q at this reference temperature.

(24) Conventionally the transfer function of a loop filter in the control loop may be determined by constants that are derived from the gyroscope and inertial measurement unit (IMU) design in order to achieve a given bandwidth and gain peaking.

(25) The present disclosure may improve on such arrangements by providing a transfer function for the loop filter of the closed loop that preferably adapts or varies with a determined or estimated characteristic of the vibrating structure in use, so as to adapt or vary the time constant of the loop filter in use. In one example, the transfer function TF(S) of the loop filter of the present disclosure may be represented as:

(26) $\begin{array}{cc}\mathrm{TF}\left(s\right)=\frac{\frac{2Q^{}s}{{}_n}+1}{\mathrm{Bs}+1}& \left[4\right]\end{array}$
where B is a constant, which may be derived from the gyroscope and inertial measurement unit (IMU) design, .sub.n is the resonant frequency of the vibrating structure, and Q is an estimated Q-factor or estimated magnification factor of the vibrating structure. Q may be a function based on one or more of the measured frequency, temperature and design parameters of the vibrating structure. In one example, Q takes the form of Q(T) in the relationship given above in equation [3].

(27) The time constant of the loop filter 16 may be adapted or varied, preferably so as to match and track the natural bandwidth of the vibrating structure, so as to preferably provide a constant output bandwidth for the control loop. This may have the benefit that the overall frequency response can then be optimised, for example made as large as possible, without compromising the noise and dynamic range of the system. This may minimise the effect of minor mismatches in the bandwidth of the vibrating structure and the frequency of the loop filter.

(28) FIG. 3a shows the effects of dynamically adjusting the time constant of the loop filter to match and track the natural bandwidth of the vibrating structure in accordance with the disclosure.

(29) FIG. 3b shows that there are no frequency variations across the low frequency range of interest. This can be compared to a conventional response, shown in FIG. 1, in which the time constant of the loop filter does not match and track the natural bandwidth of the vibrating structure.

(30) FIG. 3c shows the effects of dynamically adjusting the time constant of the loop filter to match and track the natural bandwidth of the vibrating structure in accordance with the disclosure, but with added gain compensation to provide a consistent second order response. The bandwidth and gain peaking may be adjusted using the parameters of the control loop.

(31) The present disclosure may address the frequency response of the control loop using the recognition that the frequency response of the vibrating structure of the gyroscope (which has a dominant effect) may be related to the Q-factor of the vibrating structure, and the further recognition that the Q-factor may vary strongly with temperature.

(32) The temperature of the vibrating structure may be measured with a suitable temperature sensor, or it may be estimated based on the frequency of the vibrating structure, which may enable a good estimate of the Q-factor of the vibrating structure in use.

(33) This estimate of the Q-factor may be used to calculate a time constant for a filter in the control loop so as to preferably compensate for the variation of the Q-factor of the vibrating structure over time. This improved time constant can then be used to improve or optimise the frequency response of the control loop or gyroscope.

(34) The Q-factor of the vibrating structure is correlated with resonant frequency and bandwidth and these could be referred to in place of Q-factor in the above discussion as well.

(35) Although certain embodiments have been described, it will be understood by those skilled in the art that various changes in form and detail may be made without departing from the scope of the disclosure as set forth in the accompanying claims.