Method for controlling the precession of a vibrating structure gyroscope
10852159 ยท 2020-12-01
Assignee
Inventors
- Pascal Debanne (Boulogne-Billancourt, FR)
- Arnaud Pinturaud (Boulogne-Billancourt, FR)
- Benjamin Deleaux (Boulogne-Billancourt, FR)
- Jean-Christophe Charlaix (Boulogne-Billancourt, FR)
Cpc classification
G01C19/56
PHYSICS
G01C19/5776
PHYSICS
International classification
G01C25/00
PHYSICS
G01C19/56
PHYSICS
Abstract
A method is proposed for controlling the precession of a gyroscope (1) comprising a support (2) and a resonator (3), the support (2) being mobile in a platform coordinate system and stationary in a measurement coordinate system, the method comprising the generation (101) of a first control signal suitable for rotating the resonator (3) with respect to the support (2) in two opposite directions of rotation during a first period, the method being characterized by the following steps: reception (104) of data (Tpm) on relative positioning between the measurement coordinate system and the platform coordinate system, calculation (105) of a second control signal to be generated during a second period on the basis of the first control signal and the relative-positioning data, the second control signal being chosen in such a way as to minimize an average of accumulated angular errors in the angular measurements acquired by the gyroscope during the entirety of the first and second period, the angular errors being expressed in the platform coordinate system.
Claims
1. A method for controlling the precession of a vibrating structure gyroscope comprising a support and a resonator, the support being mobile in a platform coordinate system and stationary in a measurement coordinate system, the method comprising the generation of a first control signal suitable for rotating a vibration of the resonator with respect to the support in two opposite directions of rotation during a first period, wherein: reception of data on relative positioning between the measurement coordinate system and the platform coordinate system, comprising a matrix for transition from the measurement coordinate system to the platform coordinate system, calculated at a reference time, calculation of a second control signal to be generated during a second period on the basis of the first control signal and the relative-positioning data, the second control signal being chosen in such a way as to minimize an average of accumulated angular errors in the angular measurements acquired by the vibrating structure gyroscope during the entirety of the first and second period, the angular errors being expressed in the platform coordinate system, the second precession signal being calculated under the hypothesis that the relative-positioning data is fixed from the reference time throughout the entire second period and under the hypothesis that said angular errors are constant throughout the entire second period.
2. The method according to claim 1, wherein the data on relative positioning during the first period is calculated by an inertial measurement unit using angular measurements previously provided by the vibrating structure gyroscope.
3. The method according to claim 1, wherein the calculation of the second control signal comprises the calculation of two times of change in direction of rotation during the second period.
4. The method according to claim 3, wherein the two times of change in direction of rotation are calculated using an interior point method.
5. The method according to claim 4, wherein the second control signal is a rectangular precession signal.
6. The method according to claim 1, wherein the first period and the second period have identical durations.
7. The method according to claim 1, comprising a calculation of at least one first correction coefficient representative of a scale-factor error that occurred during the first period, on the basis of the first control signal and the relative-positioning data, the second control signal being dependent on the first correction coefficient.
8. The method according to claim 7, comprising a calculation of at least one second correction coefficient representative of a harmonic drift of the second order, the second control signal being dependent on the second correction coefficient.
9. A non-transitory computer readable medium comprising program-code instructions for executing the steps of the method according to claim 1, when this program is executed by a control device.
10. A device for controlling precession for a vibrating structure gyroscope comprising a support mobile in a platform coordinate system and stationary in a measurement coordinate system, and a resonator mobile with respect to the support, the control device comprising: a generator configured to generate a first control signal suitable for rotating a vibration of the resonator with respect to the support in two opposite directions of rotation during a first period, wherein the control device comprises: an input for receiving data on relative positioning between the measurement coordinate system and the platform coordinate system, comprising a matrix for transition from the measurement coordinate system to the platform coordinate system, calculated at a reference time, a calculation unit configured to calculate, on the basis of the first control signal generated by the generator and the positioning data received via the input, a second control signal to be generated during a second period, the second control signal being chosen in such a way as to minimize an average of accumulated angular errors in angular measurements acquired by the gyroscope during the entirety of the first and second period, the angular errors being expressed in the platform coordinate system, the second precession signal being calculated under the hypothesis that the relative-positioning data is fixed from the reference time throughout the entire second period and under the hypothesis that said angular errors are constant throughout the entire second period.
11. A vibrating structure gyroscope comprising a support, a resonator mobile with respect to the support, and a control device according to claim 10.
12. A system comprising at least one vibrating structure gyroscope according to claim 11, and an inertial measurement unit comprising a unit for processing data, configured to produce the relative-positioning data from angular measurements provided by the or each vibrating structure gyroscope.
Description
DESCRIPTION OF THE DRAWINGS
(1) Other features, goals and advantages of the invention will be clear from the following description, which is purely illustrative and non-limiting, and which must be read in comparison to the appended drawings in which:
(2)
(3)
(4)
(5)
(6)
(7)
(8) In all of the drawings, similar elements have the same reference signs.
DETAILED DESCRIPTION OF THE INVENTION
(9) In reference to
(10) The resonator is fastened onto the support, but is capable of vibrating with respect to the support 2 in the way described in relation to
(11) The resonator 3 can, for example, have a hemispherical shape, in which case it is called a hemispherical resonator gyroscope (abbreviated as HRG). The resonator 3 is suitable for vibrating in a plane of vibration corresponding to the plane shown in
(12) The gyroscope also comprises a case 4 linked to a measurement reference frame defined by a measurement coordinate system. The case 4 houses the support 2 and the resonator 3. The case 4 comprises an output S.
(13) The vibrating structure gyroscope also comprises at least one vibration sensor 5 housed in the case 4, for example a plurality of sensors distributed about an axis normal to the plane of vibration of the resonator. The sensor 5 is suitable for measuring an electrical angle formed by the resonator 3 with respect to the support 2 and delivering, on an output S, angular measurements (for example angular positions or angular speeds) deduced from the electrical measurements of angle.
(14) The support 2 and the sensor 5 are rigidly connected to the case 4.
(15) The vibrating structure gyroscope 1 is connected to a control device 6 comprising an input E, a calculation unit 7 and a generator 8 of signals for controlling the precession of the gyroscope 1.
(16) The calculation unit 7 is or comprises at least one processor.
(17) The calculation unit 7 is connected to the input E and is configured to calculate a control rule.
(18) The generator 8 of commands is connected to the calculation unit 7. This generator 8 is configured to generate a signal for controlling precession over a given period of time, on the basis of a control rule established by the calculation unit 7.
(19) The control device 6 also comprises a buffer memory 9, to which the calculation unit 7 has reading and writing access.
(20)
(21) The inertial measurement unit can also comprise (or be coupled to) other inertial sensors, for example at least one accelerometer.
(22) The processing unit 11 of the inertial measurement unit 10 is connected to an output S of the vibrating structure gyroscope 1 and to the control device 6.
(23) The processing unit 11 comprises, for example, at least one processor.
(24) The inertial measurement unit 10 and the gyroscope 1 are typically on board a carrier (not illustrated), such as an aircraft or a ship.
(25) The carrier is mobile in a predetermined geographic reference frame. This geographic reference frame is defined by a geographic coordinate system comprising for example: an origin O centered on a predetermined point of the body of the carrier, and an axis x pointing towards the North Pole, an axis y pointing west, and an axis z pointing towards the sky in such a way that the coordinate system (O, x, y, z) is direct orthonormal.
(26) The inertial unit is configured to implement location calculations in an arbitrary coordinate system, called platform coordinate system, the orientation of which with respect to the geographic coordinate system is known and with a small range of variation in comparison to the range of the movements of the carrier in the geographic coordinate system. This platform coordinate system, maybe for example the geographic coordinate system.
(27) The origin of the measurement coordinate system can be the same as that of the platform coordinate system. In this case, the three axes of the measurement coordinate system are simply mobile in rotation with respect to the three axes of the platform coordinate system when the carrier is moving.
(28) Hereinafter, it is assumed that the case 4 of the gyroscope 1 is stationary with respect to the inertial measurement unit, and that they are consequently linked to the same measurement coordinate system, which is attached to the structure of the carrier (this rigidly connected nature is illustrated in
(29) The processing unit 11 of the inertial measurement unit 10 is configured to receive measurements expressed in the measurement coordinate system, coming from at least one vibrating structure gyroscope 1, and more precisely from its vibration sensor 5. Inertial sensors other than the vibrating structure gyroscope 1 can also be connected to the unit 11, for example accelerometers (not illustrated), in order to provide this unit 11 with corresponding inertial measurements.
(30) In a manner known per se, the processing unit 11 of the inertial measurement unit is configured to establish a navigation solution in the platform coordinate system on the basis of received measurements, expressed in the measurement coordinate system. The processing unit 11 combines the measurements received from the inertial sensors with a kinematic model of the carrier, in such a way as to produce the navigation solution.
(31) The processing unit 11 of the inertial measurement unit 10 is also suitable for calculating data on relative positioning between the platform coordinate system and the measurement coordinate system, on the basis of the measurements provided by the inertial sensor(s) and/or the navigation solution.
(32) Method for Controlling a Vibrating Structure Gyroscope
(33) A control method implemented by the control device 6 in order to control the precession of the plane of vibration of the resonator 3 of the vibrating structure gyroscope 1 will now be described in reference to the flow chart illustrated in
(34) It is initially assumed that data representative of a first control rule having a duration T1 has been previously memorized in the buffer memory 9.
(35) The generator 8 generates a first control signal according to the first control rule memorized, during a first period having a duration T1 (step 101). During the first period, this first control signal rotates a vibration of the resonator 3 in two opposite directions of rotation. In other words, the nodes and anti-nodes of the vibration of the resonator move about an axis of the resonator, under the effect of this first control signal.
(36) By convention, the first period is considered to correspond to the time interval [tT1, t], where t is a reference time.
(37) During the first period of time [tT1, t], the sensor 5 measures the electrical angle of the resonator 3 with respect to the support 2. The sensor 5 delivers, on the output S of the gyroscope, at least one angular measurement in the measurement coordinate system (step 102).
(38) The inertial measurement unit 10 thus receives angular measurements provided by the gyroscope 1 during the first period [tT1, t].
(39) The processing unit 11 of the inertial measurement unit 10 calculates a navigation solution in the platform coordinate system on the basis of the angular measurements provided by the vibrating structure gyroscope 1, or even measurements provided by other inertial sensors. This calculation typically comprises an integration of the angular measurements provided by the vibrating structure gyroscope 1.
(40) The processing unit 11 of the inertial measurement unit also calculates data on relative positioning between the platform coordinate system and the measurement coordinate system using the inertial measurements (step 103). For example, this relative-positioning data comprises a matrix Tpm for transition between the measurement coordinate system and the platform coordinate system. The calculation of this positioning data is well known in the field of inertial measurement units.
(41) The data on relative positioning between the platform coordinate system and the measurement coordinate system is received by the calculation unit 7 of the control device 6, via the input E of the control device 6 (step 104).
(42) The calculation unit 7 of the control device 6 then calculates a second control rule for generating a second control signal during a second period of time to come (step 105).
(43) The second control rule is calculated on the basis of the first rule, memorized by the buffer memory 9 as well as the relative-positioning data Tpm received.
(44) The second control rule is calculated over a period having a duration T2, which can be chosen, for example, to be equal to T1 in order to simplify an iterative implementation of the method.
(45) The second period is chosen as being a horizon [t, t+T2], in order for the resonator 3 to be controlled continuously. Here, the reference time t thus designates a time at which the second control signal begins to be generated by the generator 8.
(46) In a non-conventional way different from the method of precession proposed in document FR2937414 A1, the second control rule (on the basis of which the second control signal is generated) is chosen at the reference time t in such a way as to minimize accumulated angular errors in the angular measurements acquired by the gyroscope during a time interval [tT1, t+T2], these angular errors being expressed in the platform coordinate system. This interval covers the first period [tT1, t], (over), during which the first signal for controlling precession was generated, and a second period [t, t+T2] (to come), during which the second control signal will be generated.
(47) The minimization of the angular errors can typically be carried out under the hypothesis that the parameters of errors of the sensor are constant over the period [tT1, t+T2]. Indeed, these parameters are unknown, but their effects on the angular error can be predicted via a model over the first and second period: during the first, the effects are observed, during the second, a command is generated in such a way the angular error over the two periods is minimized.
(48) Since no angular measurement during this second period to come is yet available, the angular measurements of this second period are estimated by the calculation unit 7 in order to produce the second control rule.
(49) The generator 8 then effectively generates the second control signal during the second period [t, t+T2] on the basis of the second control rule calculated by the calculation unit 7 (step 106). Just like the first control signal, the second control signal is suitable for rotating the vibration of the resonator 3 in two opposite directions.
(50) Data representative of the second control rule is then memorized in the buffer memory 9 (step 107).
(51) The aforementioned steps are repeated in successive iterations, each iteration having its own reference time, and with regard to two control rules: a control rule memorized in the buffer memory 9 and produced in a previous iteration (the first control rule), and another control rule calculated during the current cycle by the calculation unit 7 on the basis of: the control rule applied over the first period and memorized, and relative-positioning data received from the inertial measurement unit during the first period.
(52) The reference times of the iterations of the method are, for example, chosen as having the form t+kT, with k being an integer, in order to produce a continuous signal for controlling precession.
(53) The steps implemented by the elements of the control device (in particular the calculation unit 7 and the generator 8) can be executed via a computer program product comprising program-code instructions. The calculation unit 7 and the generator 8 are thus configured to implement such a computer program product.
(54) Embodiment with Three Gyroscopes
(55) In a specific embodiment that is not at all limiting, three hemispherical resonator gyroscopes operating in parallel are connected to the control device 6 and to the inertial measurement unit 10. Each gyroscope is dedicated to angular measurement with regard to a respective axis of the measurement coordinate system, and each accelerometer is dedicated to the measurement of acceleration along a respective axis of the measurement coordinate system.
(56) In reference to
(57) In this embodiment, two phases repeated in a loop can be distinguished: a first phase aiming to evaluate, at a time t, the impact on the attitudes of the equipment, of each error, assumed to be constant, of the gyroscope for a past horizon [tT1, t] and, assuming that these errors are constant for the horizon to come [tT1,t], establish the precession commands that allow the errors in attitudes at the time t+T2 to be cancelled out.
(58) The impact of the errors of the gyroscope on the attitudes of the carrier in the platform coordinate system over the period [tT1, t] is quantified, for each error of the gyroscope, by these correction coefficients.
(59) The correction coefficients comprise first coefficients representative of the impact, on the errors in attitude in the platform coordinate system, of a measurement error of each rate gyro proportional to the control of precession, called scale-factor error here, that occurred during the first period.
(60) The first coefficients associated with the scale-factor error k.sub.i of the vibrating structure gyroscope having the index i are grouped together in a three-dimensional vector, noted as [Ck.sub.i(t, tT1].sub.p.
(61) Each component of the vector of correction coefficients [Ck.sub.i(t, tT1].sub.p represents the error in attitude along each axis of the platform coordinate system p, as is recalled by the index p of the expression, induced by a scale factor unit error k.sup.i of the gyro i that occurred during the first period. The vectors of first coefficients [Ck.sub.i(t, tT1].sub.p of each of the 3 rate gyros 1, 2 and 3 can be calculated according to the following formula:
(62)
Where: T.sub.pm( ) is the matrix for transition from the measurement coordinate system [m] to the geographic coordinate system [p], calculated at the reference time , Cp.sub.i is the first control rule representative of the first control signal generated during the first period corresponding to the interval [tT1, t], associated with the gyroscope having the index i.
(63) Optionally, the correction coefficients associated with a gyroscope having the index i comprise second coefficients representative of the impact on the errors in attitude, in the platform coordinate system, of a measurement error of each rate gyro i proportional to the cosine of the electrical angle, called cosine harmonic drift error here.
(64) The second coefficients associated with the gyroscope having the index i can be grouped together in the form of a three-dimensional vector, noted as [C cos.sub.i(t, tT1].sub.p. Each component of the vector of correction coefficients [C cos.sub.i(t, tT1].sub.p represents the error in attitude along each axis of the platform coordinate system p, as is recalled by the index p of the expression, induced by a drift unit error proportional to the cosine of the electrical angle of the gyro i that occurred during the first period.
(65) The second coefficients [C cos.sub.i(t, tT1].sub.p of each of the 3 rate gyros 1, 2 and 3 can be calculated in the following way:
(66)
where .sub.ei designates the electrical angle measured by the sensor 5 of the gyroscope i.
(67) Optionally, the correction coefficients associated with a gyroscope having the index i further comprise third coefficients representative of the impact, on the errors in attitude in the platform coordinate system, of a measurement error of each rate gyro i proportional to the sine of the electrical angle, called sine harmonic drift error here, that occurred during the first period. The third coefficients associated with the gyroscope having the index i can be grouped together in the form of a three-dimensional vector, noted as [C sin.sub.i(t, tT1].sub.p.
(68) Each component of the vector of correction coefficients [C sin.sub.i(t, tT1].sub.p represents the error in attitude along each axis of the platform coordinate system p, as is recalled by the index p of the expression, induced by a drift unit error proportional to the electrical angle of the gyro i that occurred during the first period. The third coefficients [C sin.sub.i(t, tT1].sub.p of each of the 3 rate gyros 1, 2 and 3 can be calculated as follows:
(69)
(70) In this specific embodiment, the second control rule to be generated during the second period to come to come [t, t+T2] is chosen in such a way that the correction coefficients calculated over the first period [t, tT1] and estimations of correction coefficients to come over the period [t, t+T2] compensate for each other.
(71) The compensation for the correction coefficients translates into the following equalities:
[Ck.sub.i(t,tT1)].sub.p+[{circumflex over (C)}k.sub.i(t,t+T2)].sub.p=0
[C sin.sub.i(t,tT1)].sub.p+[{circumflex over (C)} sin.sub.i(t,t+T2)].sub.p=0
[C cos.sub.i(t,tT1)].sub.p+[{circumflex over (C)} cos.sub.i(t,t+T2)].sub.p=0
(72) In these three equalities, the terms with a hat designate respective estimates of the vectors of first, second and third correction coefficients to come over the second period [t, t+T2], expressed in the platform coordinate system.
(73) These three equalities directly express the desired goal of cancelling out the accumulated average of the errors of the gyroscope, expressed in the platform coordinate system, over the interval [tT1, t+T2] covering the first period and the second period.
(74) As indicated above, at the reference time t, the correction coefficients over the period [t, t+T2] are obviously unknown since the movement of the carrier to come is not known.
(75) Advantageously, the hypothesis that the transition matrix Tpm over the period [t, t+T2] is constant and equal to the matrix Tpm at the time t can be made.
(76) The calculation unit 7 of the control device 6 thus determines the second rule for controlling precession for each of the rate gyros (Cpi, for i=1 to 3) that satisfies, for each rate gyro, a system of nine following scalar equations (written here for the rate gyro having the index i=1):
[Ck.sub.1(t,tT.sub.1)].sub.1+T.sub.pm11(t).Math..sub.t.sup.t+T2Cp.sub.1()d=0(1)
[Ck.sub.1(t,tT.sub.1)].sub.2+T.sub.pm21(t).Math..sub.t.sup.t+T2Cp.sub.1()d=0(2)
[Ck.sub.1(t,tT.sub.1)].sub.3+T.sub.pm31(t).Math..sub.t.sup.t+T2Cp.sub.1()d=0(3)
[C cos.sub.1(t,tT.sub.1)].sub.1+T.sub.pm11(t).Math..sub.t.sup.t+T2 cos (2(.sub.e1(t)+.sub.t.sup.t+T2Cp.sub.1().Math.d )d=0(4)
[C cos.sub.1(t,tT.sub.1)].sub.2+T.sub.pm21(t).Math..sub.t.sup.t+T2 cos (2(.sub.e1(t)+.sub.t.sup.t+T2Cp.sub.1().Math.d )d=0(5)
[C cos.sub.1(t),tT.sub.1)].sub.3+T.sub.pm31(t).Math..sub.t.sup.t+T2 cos (2(.sub.e1(t)+.sub.t.sup.t+T2Cp.sub.13().Math.d )d=0(6)
[C sin.sub.1(t,tT.sub.1)].sub.1+T.sub.pm11(t).Math..sub.t.sup.t+T2 sin (2(.sub.e1(t)+.sub.t.sup.t+T2Cp.sub.1().Math.d )d=0(7)
[C sin.sub.1(t,tT.sub.1)].sub.2+T.sub.pm21(t).Math..sub.t.sup.t+T2t sin (2(.sub.e1(t)+.sub.t.sup.t+T2tCp.sub.1().Math.d )d=0(8)
[C sin.sub.1(t,tT.sub.1)].sub.3+T.sub.pm31(t).Math..sub.t.sup.t+T2 sin (2(.sub.e1(t)+.sub.t.sup.t+T2Cp.sub.1().Math.d )d=0(9)
(77) With
(78) [Ck.sub.1(t, tT.sub.1)].sub.i: the component according to the component n i of the correction-coefficient vector [Ck.sub.1(t, tT.sub.1)].sub.p
(79) [C cos.sub.1(t, tT.sub.1)].sub.i: the component according to the component n i of the correction-coefficient vector d [C cos.sub.1 (t, tT.sub.1)].sub.p
(80) [C sin.sub.1(t, tT.sub.1)].sub.i: the component according to the component n i of the correction-coefficient vector [C sin.sub.1(t, tT.sub.1)].sub.p
(81) The systems of equations associated with the rate gyros 2 and 3 are identical if the index 1 is replaced with the indices 2 and 3.
(82) To simplify the calculations carried out by the calculation unit 7, the form of the second control rule (and thus of the second signal resulting therefrom) can be limited.
(83) For example, the second control rule can be limited to a parameterized function, two parameters of which are times of inversion of direction of rotation tinv1 and tinv2. Solving the equation system above means calculating these two inversion times starting from the reference time t.
(84) The second control rule can in particular have a rectangular shape, as illustrated in
(85) This type of rule is simple to calculate since it is only dependent on three parameters (CP, tinv1 and tinv2), the value of these three parameters being determined by solving the system of equations.
(86)
(87) The system of equations (1) to (9) disclosed above can be solved using a plurality of methods.
(88) According to a first alternative, the system is solved directly by ignoring equations (4) to (9) of the system. In this case, the harmonic derivatives are ignored, and there is no need to involve the electrical angle in the calculations of the control rule. The control device 6 does not therefore need to use data on electrical angle acquired by the sensor 5. Moreover, the calculations carried out by the control device 6 are thus relatively simple while allowing an appealing correction of the angular measurements provided by the gyroscope.
(89) According to a second alternative, the set of the nine equations is solved by minimizing a criterion according to a gradient method (fmincon algorithm, with a solving algorithm called interior-point). This second alternative has the advantage of more precisely correcting the angular errors induced by the gyroscope in the geographic coordinate system.
(90) The invention is not limited to the embodiments described above in relation to the appended drawings.
(91) For example, in the embodiment shown in
(92) Moreover, other shapes more complex than a rectangular shape can be chosen for the control rules (for example sinusoidal, triangular, periodic shapes, etc.).