Gyroscopic measurement method and sensor
20250297858 · 2025-09-25
Inventors
Cpc classification
G01C19/56
PHYSICS
G01C19/5776
PHYSICS
International classification
G01C19/5776
PHYSICS
Abstract
The present invention relates to a sensor (10) comprising a housing (12) and a vibrating element (15) apt to vibrate relative to the housing (12), comprising: an initialization (410), to provide a pilot amplitude (x.sub.max), a detection amplitude (y.sub.max), an adjustment command (T.sup.th) of predetermined spectral signature, and a calibration angular speed (.sub.cal); a calibration (420), comprising the servoing to the pilot amplitude and to the detection amplitude of the vibrations of the vibrating element (15) along the direction (x) of the pilot mode and the direction (y) of the detection mode, and simultaneously the exertion of a first stable force (F.sub.y,phase,supp.sup.app) configured not to disturb the measurement of the sensor (10) from the adjustment command (T.sup.th), as well as the application of a second force (F.sub.y,quad.sup.app) determined on the basis of the spectral signature of the adjustment command so as to cause a rotation of the direction of the pilot mode, an instantaneous angular speed ((t)) of the housing (12) being imposed as equal to the calibration angular speed (.sub.cal), and the determination of a reference angular speed (.sub.ref); an acquisition (430), analogous to the calibration but with a free instantaneous angular speed ((t)); a determination (440) of a measured instantaneous angular speed (.sub.mes(t)).
Claims
1. A gyroscopic measurement method by means of a sensor comprising a housing and a vibrating element apt to vibrate relative to the housing in a vibration plane simultaneously along a direction of a pilot mode and along a direction of a detection mode different from the direction of the pilot mode, the method comprising the following steps: initialization, during which a pilot amplitude, a detection amplitude, an adjustment command with a predetermined spectral signature, and a calibration angular speed are provided; calibration, comprising: i) servoing to the pilot amplitude a first amplitude of forced sinusoidal vibrations of the vibrating element along the direction of the pilot mode, ii) simultaneously, exerting a first stable force on the vibrating element configured so as not to disturb the measurement of the sensor from the adjustment command, and servoing to the detection amplitude a second amplitude of vibrations of the vibrating element along the direction of the detection mode, iii) simultaneously, exerting a second force on the vibrating element along the direction of the detection mode and in phase quadrature with the first force, the second force being determined on the basis of a third force which estimates the force actually exerted to servo the second amplitude, and of the spectral signature of the adjustment command and being configured to cause a rotation of the direction of the pilot mode relative to the housing, an instantaneous angular speed of the housing with respect to a sensitive axis being imposed and equal to the calibration angular speed during i), ii) and iii); iv) determining a reference angular speed from the calibration angular speed and from measurements of the vibrations of the vibrating element during iii); an acquisition step, which comprises i), ii) iii) of the calibration with a free instantaneous angular speed; determination of a measured instantaneous angular speed of the housing with respect to the sensitive axis from measurements of the vibrations of the vibrating element during the acquisition step, and of the reference angular speed.
2. A gyroscopic measurement method by means of a sensor comprising a The method of gyroscopic measurement according to claim 1, wherein for the calibration, the first force is exerted on the vibrating element, along the direction of the detection mode and in phase with the vibrations of the vibrating element along the direction of the pilot mode.
3. The method according to claim 1, wherein the calibration angular speed is zero.
4. The method according to claim 1, wherein the detection amplitude is zero.
5. The method according to claim 1, wherein determining the second force during the calibration and during the acquisition comprises filtering the third force which estimates the force actually exerted to servo the second amplitude.
6. The method according to claim 1, wherein the first force is exerted by means of an electrostatic device configured to exert a force directly proportional to a position of the vibrating element along the direction of the pilot mode and according to the adjustment command.
7. The method according to claim 1, wherein adjustment command is of the form:
8. The method according to claim 1, wherein a first adjustment command is provided during a first time interval and a second adjustment command which is opposite to the first adjustment command is provided during a second time interval, such that the direction of the pilot mode relative to the housing rotates in a first direction during the first time interval and in a direction opposite to the first direction during the second time interval.
9. A gyroscopic sensor comprising: a housing; a vibrating element apt to vibrate relative to the housing in a vibration plane simultaneously along a direction of a pilot mode and along a direction of a detection mode different from the direction of the pilot mode; a first servo module configured to receive a pilot amplitude and to servo a first amplitude of forced sinusoidal vibrations of the vibrating element along the direction of the pilot mode to a predetermined pilot amplitude; a second servo module configured to: a) exert on the vibrating element a first stable force configured so as not to disturb the measurement of the sensor from an adjustment command a spectral signature of which is predetermined, b) servo, to a predetermined detection amplitude, a second amplitude of vibration of the vibrating element along the direction of the detection mode, and c) exert a second force on the vibrating element, along the direction of the detection mode and in phase quadrature with the first force, the second force being configured to cause a rotation of the direction of the pilot mode relative to the housing, the second force being determined on the basis of a third force which is an estimate of the force actually exerted to servo the second amplitude and of the spectral signature of the adjustment command; a measurement module configured to generate measurements of the vibrations of the vibrating element along the direction of the pilot mode and the direction of the detection mode and to exchange data with the first servo module and with the second servo module; a determination module configured to exchange data with the measurement module and with the first and second servo modules and to determine: i) a reference angular speed on the basis of a predetermined calibration angular speed and on the basis of measurements of the vibrations of the vibrating element transmitted by the measuring module in a calibration mode for which an instantaneous angular speed of the housing with respect to a sensitive axis is imposed and equal to the calibration angular speed, and ii) a measured instantaneous angular speed of the housing with respect to the sensitive axis from measurements of the vibrations of the vibrating element in an acquisition mode wherein the instantaneous angular speed is free and from the reference angular speed.
10. The gyroscopic sensor according to claim 9, wherein the first servo module and the second servo module comprise electrostatic means of excitation.
11. A computer program comprising instructions that cause a gyroscopic sensor comprising: a housing; a vibrating element apt to vibrate relative to the housing in a vibration plane simultaneously along a direction of a pilot mode and along a direction of a detection mode different from the direction of the pilot mode; a first servo module configured to receive a pilot amplitude and to servo a first amplitude of forced sinusoidal vibrations of the vibrating element along the direction of the pilot mode to a predetermined pilot amplitude; a second servo module configured to: a) exert on the vibrating element a first stable force configured so as not to disturb the measurement of the sensor from an adjustment command a spectral signature of which is predetermined, b) servo, to a predetermined detection amplitude, a second amplitude of vibration of the vibrating element along the direction of the detection mode, and c) exert a second force on the vibrating element, along the direction of the detection mode and in phase quadrature with the first force, the second force being configured to cause a rotation of the direction of the pilot mode relative to the housing, the second force being determined on the basis of a third force which is an estimate of the force actually exerted to servo the second amplitude and of the spectral signature of the adjustment command; a measurement module configured to generate measurements of the vibrations of the vibrating element along the direction of the pilot mode and the direction of the detection mode and to exchange data with the first servo module and with the second servo module; a determination module configured to exchange data with the measurement module and with the first and second servo modules and to determine: i) a reference angular speed on the basis of a predetermined calibration angular speed and on the basis of measurements of the vibrations of the vibrating element transmitted by the measuring module in a calibration mode for which an instantaneous angular speed of the housing with respect to a sensitive axis is imposed and equal to the calibration angular speed, and ii) a measured instantaneous angular speed of the housing with respect to the sensitive axis from measurements of the vibrations of the vibrating element in an acquisition mode wherein the instantaneous angular speed is free and from the reference angular speed to perform the method according to claim 1.
Description
BRIEF DESCRIPTION OF THE SEVERAL VIEWS OF THE DRAWING(S)
[0071] The invention will be clearer upon reading the following description, given only as an example, but not limited to, and making reference to the drawings wherein:
[0072]
[0073]
[0074]
[0075]
[0076]
[0077]
[0078]
[0079]
DETAILED DESCRIPTION OF THE DISCLOSURE
[0080] The Coriolis effect gyroscopic sensor 10, referred to by the abbreviation CVG hereinafter, according to the invention is described with reference to
[0081] The CVG 10 includes a housing 12 and a vibrating element 15 apt to vibrate with respect to the housing 12.
[0082] The CVG 10 is for example produced in the form of a micro electromechanical sensor (MEMS) system. The vibrating element 15 and the housing 12 are then cut from a silicon or quartz block by micromachining and the vibrating element 15 is vibrated using an electrical method. Such arrangement makes it possible to minimize the overall size and/or the manufacturing cost of the CVG 10.
[0083] Three axes X, Y, Z of the space coordinate frame XYZ of a frame of reference (XYZ, t) attached to the housing 12 are shown in
[0084] The CVG 10 is configured to measure an instantaneous angular speed (t) of the sensor relative to the axis Z, which is thus the axis of sensitivity (or, equivalently, the sensitive axis) of the CVG 10.
[0085] To this end, the vibrating element 15 comprises a test mass M, apt to vibrate in plane XY along two directions x and y, with a natural angular frequency .sub.0x, respectively .sub.0y close to .sub.0x.
[0086] Hereinafter, it is considered that the direction x is the direction of the pilot mode and that the direction y is the direction of the detection mode.
[0087] As can be seen in
[0088] The test mass M is apt to vibrate along the direction x of the pilot mode and the direction y of the detection mode, with a resonance angular frequency close to .sub.0x.
[0089] The CVG 10 includes a first servo module 20 apt to servo a characteristic amplitude of vibrations of the vibrating element 15 to a predetermined non-zero pilot amplitude x.sub.max, the vibrating element 15 vibrating in a sinusoidal regime forced to the resonance angular frequency along the direction x of the pilot mode, from measurement data of the position of the vibrating element in the direction x of the pilot mode.
[0090] The first servo module 20 comprises usual means for servoing (or equivalently controlling) the amplitude of the vibrations of the vibrating element 15 according to the pilot mode. Said means are not shown in detail in the figures. Same are e.g. the control means described in document EP2960625.
[0091] As an example, which will be referred to hereinafter as reference example, the first servo module 20 comprises an electrostatic device 20A configured to exert a first force F.sub.x,ass, along the direction x of the pilot mode, on the vibrating element 15. The first force F.sub.x,ass is then proportional to a first amplitude command.
[0092] The electrostatic device 20A and the test mass M of the vibrating element 15 form, as an example, a set of interdigitated combs, as shown in
[0093] In the case of
[0096] In general, the voltage V.sub.exc,x has the form V.sub.exc,x (t)=V.sub.0x+V.sub.1x cos (t). Thereby, the force actually applied to the test mass M is, after filtering the 2 angular frequencies terms, has the form:
[0097] The constant term of the force is not used hereinafter, since only the last term allows the test mass M to oscillate. In other words, the non-sinusoidal terms are either filtered naturally or filterable by an appropriate filtering stage.
[0098] Finally, it should be understood that the electrostatic device 20A can be configured by a person skilled in the art to exert a first force F.sub.x,ass of angular frequency substantially equal to the natural angular frequency .sub.0x of the vibrating element 15 according to the pilot mode, from a suitably chosen amplitude command, to obtain the servoing of the amplitude of the vibrations of the vibrating element 15 to the pilot amplitude x.sub.max.
[0099] The first servo module 20 comprises in the reference example a processor or a programmable logic circuit (such as a Field Programmable Gate Array, FPGA), configured to manage the servoing of the first amplitude command, as well as a proximity board configured to inject the first amplitude command signal into the electrostatic device 20A.
[0100] The processor or the programmable logic circuit is advantageously configured to manage the servoing of the angular frequency of the vibrations of the vibrating element 15 along the direction x of the pilot mode, e.g. to the resonance angular frequency .
[0101] The CVG 10 includes second servo module 25 apt to control (or equivalently servo) a characteristic amplitude of vibrations of the vibrating element 15 along the direction Y of the detection mode to a detection amplitude y.sub.max, the vibrating element 15 vibrating in a forced sinusoidal regime along the direction y of the detection mode at the resonance angular frequency , from measurement data of the position of the vibrating element along the direction y of the detection mode.
[0102] To this end, the second servo module 25 may comprise control means similar to the means of the first servo module 20 (not shown in detail).
[0103] Thereby, in the reference example, the second servo module 25 comprises an electrostatic device 25A configured to exert on the vibrating element 15 a second force F.sub.y,phase,ass, the direction of which is the direction y of the detection mode, in phase with the vibrations along the direction x of the pilot mode. The second force F.sub.y, phase, ass is then proportional to a second amplitude command, on the principle described for the first servo module 20.
[0104] The second servo module 25 comprises, in the reference example, a processor or a programmable logic circuit (such as a Field Programmable Gate Array, FPGA) configured to manage the servoing of the second amplitude command. The second servo module 25 further comprises a proximity board configured to inject the second amplitude command signal into the electrostatic device 25A.
[0105] The processor or the programmable logic circuit is in the reference example is the same as the one of the first servo module 20. Such arrangement is advantageous without being mandatory.
[0106] The processor or the programmable logic circuit is advantageously configured to manage the control of the angular frequency of the vibrations of the vibrating element 15 along the direction y of the detection mode, e.g. to the resonance angular frequency .
[0107] In the reference example, the proximity board is the same as the board of the first servo module 20. Such arrangement is advantageous without being mandatory.
[0108] The second servo module 25 comprises an adjustment control unit 26 apt to receive an adjustment command T.sup.th and to exert from the adjustment command T.sup.th an additional force F.sub.y,phase,supp.sup.app, the direction of which is the direction y of the detection mode, in phase with the vibrations of the vibrating element 15 along the direction x of the pilot mode.
[0109] The spectral signature of the adjustment command T.sup.th, i.e. the expansion thereof into a Fourier series, is known. The coefficients T.sub.1 to T.sub.n (n being a strictly positive integer) of equation (a) hereinafter are thus known.
[0110] To this end, the adjustment control unit 26 may comprise an electrostatic device 26A configured to actually exert an additional force F.sub.y,phase,supp.sup.app of the form F.sub.y,phase,supp.sup.app=T.sup.app x in response to the adjustment command T.sup.th, x being the position of the test mass M along the direction of the pilot mode.
[0111] Typically, the electrostatic device 26A is a trimming comb polarized with a very stable polarizing voltage V.sub.T and apt to exert a force along the direction of the detection mode, this force being directly proportional to the position x of the test mass M along the direction of the pilot mode and proportional to the square of the polarizing voltage V.sub.T. The expression directly proportional means herein that it is not necessary to measure or reconstruct the position x of the test mass M along the direction of the pilot mode, the force exerted by the trimming comb adjusting spontaneously to said position.
[0112] Typically, a force F exerted by means of the trimming comb is given by equation (b) hereinafter, where K denotes a gain that depends only on the geometric characteristics of the trimming comb:
[0113] Such force is obtained from the physical design of the trimming comb without the need to estimate the position x of the test mass. This force is hence indeed directly proportional to x.
[0114] It should be noted that the physical principle is entirely different from a force F.sub.AA which would be obtained, as in prior art devices, by means of an excitation comb along the direction of the pilot mode, which would be given by equation c):
[0115] where {circumflex over (x)} is an estimator of the position x of the test mass and not the actual position x of the test mass.
[0116] The trimming comb is a quadrature trimming comb, i.e. a comb involving a coupling between the pilot mode and the detection mode.
[0117] Alternatively, the trimming comb is a frequency trimming comb, i.e. a physical device configured to modify at least one of the natural angular frequencies of the test mass M along the directions x and/or y.
[0118] The servoing of the amplitude of the vibrations of the vibrating element 15 along the direction y of the detection mode is carried out by the second servo module 25 in the presence of the additional force F.sub.Y,phase,supp.sup.app actually applied.
[0119] The second servo module 25 is also configured to actually exert a third force F.sub.y,quad.sup.app on the vibrating element 15, having the direction along the direction y of the detection mode and in phase quadrature with the additional force F.sub.y,phase,supp.sup.app, on the basis of a spectral signature of the adjustment command T.sup.th and of an estimate F.sub.y,phase,ass.sup.est of the second force F.sub.y,phase,ass.sup.app actually exerted by the second servo module 25 to servo the characteristic amplitude of the vibrations of the vibrating element 15 along the direction y of the detection mode in the presence of the additional force F.sub.Y,phase,supp.sup.app in two cases of movement of the sensor 10: [0120] a first case, for which the instantaneous angular speed (t) of the housing 12 with respect to the sensitive axis Z of the sensor 10 in the inertial frame of reference is imposed, to a value equal to a predetermined angular calibration velocity .sub.cal, and [0121] a second case, for which the instantaneous angular speed (t) is free to established under the effect of the movement of the housing 12, this movement being in particular linked to the movement of a device on which the CVG 10 is implemented, and during which the instantaneous angular speed (t) is thus unknown a priori and is to be determined. In the second case, the instantaneous angular speed is thus not imposed, more particularly at the predetermined calibration angular speed .sub.cal, unlike in the first case.
[0122] The first and second servo modules 20, 25 are configured to exchange data with a measurement module 30 of the CVG 10, for the servoing of the vibrations of the vibrating element 15.
[0123] The measurement module 30 is apt to generate measurements of the vibrations of the vibrating element 15 along the directions x of the pilot mode and y of the detection mode and apt to exchange information with the first servo module 20 and with the second servo module 25.
[0124] In particular, the measurement module 30 is apt to measure the position x(t) (y(t), respectively) of the vibrating element 15 and/or the speed dx/dt(t) (dy/dt(t), respectively) and/or the acceleration d.sup.2x/.sup.dt 2(t) (d.sup.2y/dt.sup.2(t), respectively along the direction x (along the direction y, respectively).
[0125] To this end, the measurement module 30 comprises, in the reference example, but not limited to, electrostatic means of detection 30A along the direction x of the pilot mode and electrostatic detection means 30B along the direction y of the detection mode.
[0126] Advantageously, the electrostatic means of detection 30A and 30B each form, with the test mass M, a set of interdigitated combs, on the geometrical principle shown in
[0127] In the reference example, the proximity board is advantageously configured to amplify the signals detected by the measurement module 30 and to transmit the amplified signals to the processor or to the programmable logic circuit.
[0128] The measurement module 30 is also configured to exchange data with a determination module 35 of the CVG 10.
[0129] The determination module 35 is apt to exchange information not only with the measurement module 30 but also with the first and second servo modules 20, 25.
[0130] The determination module 35 is apt to determine a reference angular speed .sub.ref from the calibration angular speed .sub.cal as well as from measurements of the vibrations of the vibrating element 15 transmitted by the measurement module 30 to the first and second servo modules 20, 25 in the first case of movement of the sensor 10.
[0131] The determination module 35 is apt to determine, in the second case of movement of the sensor 10, an instantaneous measured angular speed .sub.mes(t), which is an estimator of the angular speed (t) sought, on the basis of measurements of the vibrations of the vibrating element 15 transmitted by the measurement module 30 to the first and second servo modules 20, 25 and of the reference angular speed .sub.ref.
[0132] The method 400 according to the invention will now be described with reference to
[0133] The method 400 comprises an initialization step 410, a calibration step 420, an acquisition step 430 and a determination step 440 of the measured instantaneous angular speed .sub.mes(t).
[0134] The initialization step 410 comprises: [0135] a) the supply to the first servo module 20 of the non-zero pilot amplitude x.sub.max to which the amplitude characteristic of the forced sinusoidal vibrations of the vibrating element 15 along the direction x of the pilot mode has to be servoed, [0136] b) the supply to the second servo module 25 of the detection amplitude y.sub.max to which the characteristic amplitude of the vibrations of the vibrating element 15 along the direction y of the detection mode has to be servoed, [0137] c) the supply to the adjustment control unit 26 of the adjustment command T.sup.th, the spectral signature of which is known, and [0138] d) the supply to the determination module 35 of the angular calibration speed .sub.cal.
[0139] The detection amplitude y.sub.max is e.g. zero.
[0140] The initialization step 410 is followed by the calibration step 420 during which:
[0141] i) the characteristic amplitude of the vibrations of the vibrating element 15 vibrating in forced sinusoidal mode along the direction x of the pilot mode is servoed to the non-zero pilot amplitude x.sub.max by means of the first servo module 20. For this purpose, the first servo module 20 receives measurements of the vibrations of the vibrating element 15 along the direction x of the pilot mode, from the measurement module 30.
[0142] ii) simultaneously, the additional force F.sub.y,phase,supp.sup.app, the direction of which is the direction y of the detection mode and in phase with the vibrations of the vibrating element 15 along the direction x, is exerted by the adjustment control unit 26 on the basis of the adjustment command T.sup.th, and the characteristic amplitude of the vibrations of the vibrating element 15 along the direction y of the detection mode is servoed to the detection amplitude y.sub.max by means of the second servo module 25. For this purpose, the second servo module 25 receives measurements of the vibrations of the vibrating element 15 along the direction y of the detection mode and along the direction x of the pilot mode, from the measurement module 30.
[0143] iii) the second servo module 25 determines the third force F.sub.y,quad.sup.app to be exerted on the vibrating element 15, along the direction y of the detection mode and in phase quadrature with the additional force F.sub.y,phase,supp.sup.app, on the basis of an estimate F.sub.y,phase,ass.sup.est of the second force F.sub.y,phase,ass.sup.app actually exerted by the second servo module 25 to control the characteristic amplitude of the vibrations of the vibrating element 15 along the direction y in the presence of the additional force F.sub.y,phase,supp app. The third force F.sub.y,quad.sup.app is, as will be seen later, configured to control a rotation of the directions x, y of the pilot and detection modes with respect to the housing 12.
[0144] iv) the second servo module 25 commands the exercise of the third force F.sub.y,quad.sup.app the operating conditions of i) and ii) being maintained: the characteristic amplitude of the vibrations of the vibrating element 15 vibrating in forced sinusoidal mode along the direction x of the pilot mode is servoed to the non-zero pilot amplitude x.sub.max by means of the first servo module 20, and the characteristic amplitude of the vibrations of the vibrating element 15 along the direction y is served to the detection amplitude y.sub.max in the presence of the additional force F.sub.y,phase,supp.sup.app actually applied.
[0145] v) the determination module 35 determines the reference angular speed (ref on the basis of the calibration angular speed .sub.cal as well as of the measurements of the vibrations of the vibrating element 15 transmitted by the measurement module 30 to the first and second servo modules 20, 25, during iv).
[0146] In the example, the additional force F.sub.y,phase,supp.sup.app is exerted along the direction y of the detection mode and in phase with the vibrations of the vibrating element 15 along the direction x.
[0147] More generally, the additional force is exerted by means of a device allowing to obtain a stable amplitude. In addition, the additional force is configured so as not to disturb the measurement made by the sensor.
[0148] More generally, the additional force is exerted by means of a device allowing to obtain a stable amplitude. Advantageously, said device is configured to exert an additional force the amplitude of which is constant at an accuracy of 10 ppm or less, i.e. the relative variations in amplitude of which are less than or equal to 1/100,000.
[0149] In addition, the additional force is configured so as not to disturb the measurement made by the sensor.
[0150] The calibration step 420 is followed by an acquisition step 430 reproducing steps i), ii), iii) and iv) of the calibration step, except that for the acquisition step 430, the instantaneous angular speed (t) of the housing 12 with respect to the sensitive axis Z of the sensor 10 in the inertial frame of reference is not imposed. The movement of the sensor 10 thus corresponds, for the acquisition step 430, to the second case of movement described hereinabove.
[0151] At the end of the acquisition step 430, the determination step 440 is implemented by means of the determination module 35: the determination module 35 determines the measured instantaneous angular speed .sub.mes(t), which is an estimator of the instantaneous angular speed (t) of the housing 12, on the basis of the measurements of the vibrations of the vibrating element 15 transmitted by the measurement module 30 to the first and second servo modules 20, 25 during the acquisition step 430 and on the basis of the reference angular speed .sub.ref determined at the calibration step 420.
[0152] In order to better understand the method 400 according to the invention, the theory underlying the control of an alternating rotation with a zero time-average of the coordinate frame xyZ attached to the directions x, y of the pilot and detection modes with respect to the coordinate frame XYZ attached to the housing is described hereinafter.
[0153] In order to simplify the writing of the equations making it possible to understand the method of the prior art and the method 400 according to the invention, the vibrating element 15 is modeled hereinafter by a mass M suspended on a rigid frame C by means of two pairs of springs 15A, 15B of respective stiffnesses K.sub.x and K.sub.y, as shown in
[0154] Moreover, it is considered hereinafter that the stiffness constants and the natural angular frequencies of the vibrating element 15 are identical according to the pilot mode x and the mode y. In such particular case, it can thus be written that K.sub.x=K.sub.y=K and that .sub.0x=.sub.0y=.sub.0.
[0155] Such simplification should in no case be considered limiting for the operation of the sensor 10 according to the invention, since the following equations can be rewritten without any difficulty in the most general case.
[0156] In general, the trajectory of the mass M in forced sinusoidal regime is an ellipse in the coordinate frame XYZ.
[0157] The ellipse is reduced to a straight line segment of direction x of the pilot mode in the case where the amplitude of the vibrations according to the detection mode is servoed to a detection amplitude y.sub.max equal to zero.
[0158] Without making an assumption at this stage on the value of the detection amplitude y.sub.max, the position x of the mass M along the direction x of the pilot mode as a function of the date t is of the form x(t)=x.sub.max cos (t) and the position y of the mass M along the direction y of the detection mode as a function of the date t is of the form y(t)=y.sub.max sin (t).
[0159] If the direction x of the pilot mode with respect to the axis X of the coordinate frame XYZ attached to the housing 12 is identified by the angle shown in
[0160] wherein R() is the transformation matrix for changing from the coordinate frame xyZ to the coordinate frame XYZ:
I) Operating Equations Common to the Prior Art Method and to the Method 400 According to the Invention
[0161] In the prior art method shown in
[0162] The first time derivatives dX/dt and dY/dt of the coordinates X and Y of the mass M thus satisfy:
[0163] The second time derivatives d.sup.2X/dt.sup.2 and d.sup.2Y/dt.sup.2 of the X and Y coordinates of mass M verify:
[0164] In the sinusoidal regime forced to the angular frequency , if we neglect the terms that are not proportional to a positive integer power of the angular frequency in front of the other terms, equation 5 can be written in the simplified form of equation 6:
[0165] In the frame of reference of the housing 12, the mass M is subjected to the forces F.sub.tot,x and F.sub.tot,y exerted by the excitation devices 20A, 25A, respectively, to the restoring forces of the springs, and to a damping that is modeled by a fluid friction force along each of the directions x and y associated with a quality factor Q.
[0166] The damping matrix A of the vibrating element 15, taking into account damping anisotropies, has the form described in equation 7:
[0167] The stiffness matrix K1 of the vibrating element 15, taking into account stiffness anisotropies, has the form:
[0168] Moreover, when the frame of reference of the housing 12 has a rotational movement of component (t) along the direction Z with respect to the inertial frame of reference, the mass M, due to the non-zero relative speed thereof in the coordinate frame the housing 12, is subjected to a Coriolis inertial force in the coordinate frame of the housing 12.
[0169] Newton's second law applied to the mass M in the non-Galilean frame of reference the housing leads to the equation 9:
[0170] To simplify the writing of the equations, the damping anisotropies are neglected hereinafter, without thereof being limiting for the implementation of the method.
[0171] Neglecting damping anisotropies, equation 9, multiplied by R() and with the approximations of equation 5, is written as follows:
[0172] In the case where the amplitude y.sub.max of the vibrations according to the detection mode is servoed by y.sub.max=0, the equation 10 takes the form:
[0173] If along the x direction of the pilot mode, the terms in phase or phase opposition with the position x of the mass M from the terms in quadrature with this position are separated by decomposing F.sub.tot,x into:
[0174] the system of equations 13 is obtained:
[0175] The force F.sub.tot,x is the first force F.sub.x,ass exerted by the first servo module 20 for servoing, to the pilot amplitude, the amplitude of the vibrations according to the pilot mode.
[0176] Similarly, if one separates, along the direction y of the detection mode, the terms in phase or in phase opposition with the position x of the mass M from the terms in quadrature with said position, by decomposing F.sub.tot,y into:
[0177] the system of equations 15 is obtained:
[0178] The term F.sub.y,phase, of amplitude F.sub.y,phase,max, is managed by the second servo module 25 which receives the instruction to servo the amplitude of the vibrations according to the detection mode to Y.sub.max=0 and the term F.sub.y,quad, of amplitude F.sub.y,quad,max, is the third force imposed by the second servo module 25.
[0179] Equation 15(2) shows that in order to command the rotation of the coordinate frame xyZ relative to the coordinate frame XYZ, it is necessary to command the third force F.sub.y,quad of non-zero amplitude F.sub.y,quad,max, with the direction y of the detection mode and in phase quadrature with the vibrations of the mass M along the direction x of the pilot mode.
[0180] The directions x and y of the pilot and detection modes then rotate at an angular speed de/dt different from the instantaneous angular speed (t) and one can both: [0181] reduce or eliminate harmonic errors by controlling a rotation of the directions by periodically changing the direction of the third force F.sub.y,quad, and [0182] deduce the instantaneous angular speed (t) from the measurement of de/dt according to equation 16:
II) Prior Art Method
[0183] In the methods of the prior art, in order to obtain the third force F.sub.y,quad, the characteristics of the electric voltage V.sub.exc,y(t) to be applied to the electrostatic excitation device 25B are supplied to the second servo module 25, during a step which could be considered as an initialization step. Thereby, in particular, the amplitudes and pulses of the different components of the voltage V.sub.exc,y(t) which should be in phase quadrature with the position x of the mass M, are provided.
[0184] On the principle of equation 1, the electric voltage V.sub.exc,y(t) is typically of the form V.sub.exc,y (t)=V.sub.0y+V.sub.1y sin (t), so that the force F.sub.y,quad.sup.th theoretically applied to the mass M is proportional to the DC component V.sub.0y of the electric voltage V.sub.exc,y(t) and to a geometric factor g.sub.geom characteristic of the electrostatic excitation device 25B. In the case of the methods of the prior art, one theoretically commands:
[0185] This command step is represented by step 510 in
[0186] The scale factor between the commanded force F.sub.y,quad.sup.th and the command angular speed .sub.com is constant and denoted by C1.
[0187] Due to delays and gain errors of the electronic components and of the mechanical components, including detection errors on the position of the vibrating element, errors on voltages V.sub.0y. V.sub.1y, as well as errors on the sinusoidal signal sin (.sub.0t), the force F.sub.y,quad.sup.app actually applied to the test mass M differs at greater or lesser extent from the commanded force F.sub.y,quad.sup.th, both in amplitude and in phase.
[0188] We can model the difference between the amplitude F.sub.y,quad,max.sup.th of the commanded force and the amplitude F.sub.y,quad,max.sup.app of the force actually applied by:
[0189] where e(t) is a very unstable error term due to the many parameters of the electronic components and of the mechanical components that cause same and C2 denotes a constant scale factor.
[0190] Following the control step 510, the force F.sub.y,quad.sup.app is actually exerted during an acquisition step 520, which results in an effective rotation of the direction of the pilot mode in the frame of reference of the housing at an effective angular speed .sup.app different from the command angular speed .sub.com. The two angular speeds are linked by the following equation, where C3 denotes a constant scale factor:
[0191] In the measurement method of the prior art, the instantaneous angular speed measured is deduced from equation 16 and from the amplitude F.sub.y,quad,max.sup.th controlled for the third force F.sub.y,quad, which is supplied during the initialization step to the second servo device 25, according to the formula:
[0192] The effective instantaneous angular speed .sup.app, which would be deduced from equation 16 and from the amplitude F.sub.y,quad,max.sup.app actually obtained for the third force F.sub.y,quad if same were perfectly known (i.e. if all the error sources were perfectly controlled and known), has the expression:
[0193] The error made in the method of the prior art on angular speed therefore has the expression:
[0194] Hence, this error is a scale factor error. It should be understood that if the term e is not strictly constant in time, the error related to the scale factor does not have a zero-time average even if the time average of the commanded force F.sub.y, quad.sup.th is zero. Moreover, the error within a reversal period is all the greater as e(t) is large. Finally, even if the term e(t) was obtained by means of a calibration upstream of the measurement, because of the variety of causes of the error, it is not possible to consider that the calibration will remain correct over the shorter or longer term.
III) Method 400 According to the Invention
[0195] The method according to the invention aims to solve such technical problem, by exerting a third force F.sub.y,quad.sup.app of better controlled amplitude than in the methods of the prior art and by using another way of estimating the angular speed to be measured.
[0196] For the reason thereof, the amplitude of the third force is not provided in the form of a setpoint value that would be provided during the initialization step.
[0197] In the case of the method 400 according to the invention, during the acquisition step 430, the adjustment command T.sup.th is implemented by the adjustment control unit 26 of the second servo module 25, so that the additional force F.sub.y, phase, supp.sup.app, of intensity T.sup.app|x|, in phase with the position x of the mass M and having the direction y of the detection mode, is effectively imposed on the mass M. The servoing of the amplitude of the vibrations of the mass M along the direction y of the detection mode is carried out by the second servo module 25 in the presence of the additional force F.sub.Y,phase,supp.sup.app actually applied.
[0198] The acquisition step 430 is shown in detail in
[0199] The additional force F.sub.y,phase,supp.sup.app is actually exerted in an application sub-step 4301.
[0200] Because of the presence of the additional force, the system of equations 15 can thus be written for the method of the invention in the form of the system of equations 22:
[0201] with a constant value. For example, =0 if quadrature comb trimming combs are used, and =/2 if frequency comb trimming combs are used.
[0202] The force F.sub.y,phase,ass.sup.app which is effectively exerted by the second servo device 25 in phase with the position x of the mass M to implement the servoing of the vibrating element 15 along the direction y of the detection mode thus has the expression:
[0203] It can be seen that part of the force F.sub.y,phase,ass.sup.app intervenes to counter the additional force F.sub.y,phase,supp.sup.app applied by means of the injection of the adjustment command T.sup.th
[0204] During an estimation sub-step 4302 of the acquisition step 430, the servo device 25 estimates the force F.sub.y,phase,ass.sup.est to be controlled in order to actually exert the force F.sub.y,phase,ass.sup.app on the vibrating element 15 for the servoing thereof in the presence of the additional force F.sub.y,phase,supp.sup.app actually exerted by the adjustment control unit 26.
[0205] The force F.sub.y,phase,ass.sup.app is actually exerted during a first exercise sub-step 4303, in the presence of the additional force F.sub.y,phase,supp.sup.app.
[0206] The difference between the force F.sub.y,phase,ass.sup.app actually applied to exercise substep 4303 and the estimator F.sub.y,phase,ass.sup.est of the force to be controlled to exert said force, obtained in estimation sub-step 4302, can be modeled by equation 24:
[0207] The term (t) being much less than 1, one can still write, as was done in
[0208] or else:
[0209] It should be noted that the term T.sup.app cos (2+) x is present in the force F.sub.y,phase,ass.sup.app and in the estimator F.sub.y,phase,ass.sup.est of the method 400 (unlike the methods of the prior art) because of the injection of the adjustment command T.sup.th.
[0210] During an extraction sub-step 4304, the second servo device 25 extracts from the force F.sub.y,phase,ass.sup.est thus estimated at least one estimator T.sub.I.sup.est of an amplitude T.sub.I.sup.app of the harmonic decomposition of T.sup.app, based on the spectral signature of the adjustment command T.sup.th.
[0211] By way of non-limiting example, T.sup.th may be chosen to have the form:
[0212] wherein the angle denotes the angular position of the direction x of the pilot mode with respect to the reference axis X of the coordinate frame XYZ attached to the housing 12.
[0213] In such case, the mean value of the term T.sup.app cos(2+) over a period characteristic of the variations of the angle is equal to T.sub.2.sup.app/2, in such a way that it is possible to extract T.sub.2.sup.app from the estimated force F.sub.y,phase,ass.sup.est by the servo device 25 and to evaluate T.sub.2.sup.app, e.g. by filtering with an averaging filter.
[0214] It is also possible to use an odd-order harmonic. Such arrangement facilitates the separation of the component of interest from the physical signals. As an example, the terms T.sub.i of the spectral signature of the adjustment command T.sup.th may be constant, or else sinusoidal of the form T.sub.i=.sub.i cos (.sub.i t+.sub.i) where .sub.i, .sub.i and .sub.i are predetermined constants.
[0215] Then, during a control sub-step 4305, the processor of the servo device 25 commands the third force F.sub.y, quad.sup.th having the direction y of the detection mode but in phase quadrature with the additional force F.sub.y,phase,supp.sup.th.
[0216] As can be seen in
[0217] During a second sub-step of exercise 4306, the control of the third force F.sub.y,quad.sup.th results in the exercise of the third force F.sub.y,quad.sup.app actually applied.
[0218] Since the errors are the same in each of the sub-steps, the third force F.sub.y,quad.sup.app actually applied is in phase quadrature with the additional force F.sub.y,phase,supp.sup.app and thus ultimately effectively comprises a component proportional to each of the real harmonics T.sub.i.sup.app of T.sup.app used, the proportionality factor being constant and denoted by C.sub.5.
[0219] Equation 16 can then be rewritten as follows, wherein C.sub.6 is a constant scale factor:
[0220] The third force F.sub.y,quad.sup.app actually exerted thus has the effect of imposing an additional angular rotation speed on the coordinate frame of the wave, the additional angular speed being proportional to the amplitude T.sub.i.sup.app used.
[0221] It is important to understand that the error made between the second estimated force F.sub.y,phase,ass.sup.est and the second effectively exerted force F.sub.y,phase,ass.sup.app is the same as the error between the third commanded force F.sub.y,quad.sup.th and the third force effectively exerted F.sub.y,quad.sup.app the conversion chain being the same in both cases.
[0222] Consequently, if in the preliminary calibration step 420, the predetermined calibration angular speed .sub.cal has been imposed on the unit 12 with respect to the axis Z, with the same adjustment command T.sup.th, it is also known, the conversion chain remaining the same, that:
[0223] The additional angular speed .sup.app actually applied in the case of the method according to the invention is thus exactly the reference angular speed .sub.ref determined during the calibration step 420 and is not tainted by errors occurring in the method according to the prior art, as can be seen in
[0224] Thereby, all that remains is to determine the instantaneous angular speed (t) sought using the reference angular speed .sub.ref determined during the calibration step 420, according to equation 30:
[0225] Said equation does not at any time require an explicit calculation of the amplitude of the third applied force, due to the calibration step 420. The scale factor involved in the methods of the prior art is thus totally eradicated from the method 400.
[0226] The only errors that taint the measurement are the errors related to the implementation of the adjustment command T.sup.th, which should be as stable as possible between the calibration step 420 and the acquisition step 430.
[0227] More particularly, the electrostatic device 26A makes it possible, by the configuration thereof, to dispense with the measurement of the position of the mass M along the direction of the pilot mode and thus to generate an additional force F.sub.y, phase, supp.sup.app which is particularly stable.
[0228] To control such errors as well as possible, an electrostatic excitation device 26A is advantageously chosen, the geometry variations of which are as small as possible.
[0229] For the same purpose, a polarizing voltage source V.sub.T which is as stable as possible, is advantageously chosen.
[0230] Preferably, the polarizing voltage source V.sub.T comprises filtering means configured to eliminate the variable components of the voltage at the terminals thereof.
[0231] Advantageously, the instantaneous angular speed .sub.cal of the housing 12 with respect to the axis Z is zero during the calibration step 420. Such arrangement makes it possible to minimize the error on the angular speed .sub.mes determined in the determination step 440, in particular on the basis of equation 24.
[0232] Advantageously, a first adjustment command T.sup.th is provided during a first time interval t1 and a second adjustment command which is the opposite of the first adjustment command T.sup.th is provided during a second time interval t2, such that the direction (x) of the pilot mode relative to the housing rotates in a first direction during the first time interval t1 and in a direction opposite to the first direction during the second time interval t2.
[0233] Due to such arrangement, it is possible, by suitably choosing the first time interval t1 and the second time interval t2, to cancel the errors in the scale factor and to minimize the harmonic defects that taint the measurements.
[0234] Equivalently, during the control substep 4305, a first sign can be applied during a first time interval t1, so that the third commanded force F.sub.y, quad.sup.th has a first direction during the first time interval t1. The opposite sign can then be applied during a second time interval t2 so that the third commanded force F.sub.y,quad.sup.th has a direction opposite to the first direction during the second time interval t2.
[0235] In summary, the method 100 according to the invention has the following specificities.
[0236] Firstly, the rotation of the direction of the pilot mode is obtained by applying an angular speed whose amplitude is proportional to the amplitude of the additional force F.sub.y,phase,supp.sup.app which is very stable, unlike the methods of the prior art.
[0237] The additional force F.sub.y,phase,supp.sup.app can be obtained, in particular, by means of trimming combs, the stability of the additional force thus depending on the stability of the voltages used and the air-gaps of the trimming combs. The stability of the additional force F.sub.y,phase,supp.sup.app is thus much better controlled than the stability of a force obtained by means of a conventional precession command, which undergoes all the variations of the corresponding electronic components.
[0238] Secondly, the angular speed suppressed at the output to compensate for the precession control, i.e. the third force F.sub.y,quad.sup.app, is directly proportional to the amplitude of the additional stable force F.sub.y,phase,supp.sup.app injected at the input, and is not the angular speed associated with an electronically injected precession control, intrinsically unstable.
[0239] Thirdly, by playing on the signs of the adjustment command, it is possible to choose the direction of the third force F.sub.y, quad.sup.app and thereby to cause a rotation of the direction of the pilot mode in a first direction for a first period of time and in a second direction for a second period of time.
[0240] If the first duration and the second duration are properly chosen, the scaling factor errors can be eliminated precisely. Thereof is not the case in the methods of the prior art because of the instability of the scale factor.
[0241] It should be noted that the stable force injected at the input does not reduce the performance of the gyroscopic measurement device.