DEVICE FOR MEASURING ANGULAR ERRORS IN THE INCLINATION OF THE TRUE AXIS OF ROTATION OF A ROTARY ELEMENT, AND ASSOCIATED METHOD
20250137784 · 2025-05-01
Inventors
- Damien PONCEAU (SAINT-GERMAIN-EN-LAYE, FR)
- Mehdi BUSSUTIL (SAINT-GERMAIN-EN-LAYE, FR)
- Bernard VAU (SAINT-GERMAIN-EN-LAYE, FR)
- Clément PINZIO (SAINT-GERMAIN-EN-LAYE, FR)
Cpc classification
International classification
G01C19/00
PHYSICS
Abstract
The invention relates to a device (100) for measuring the angular errors in the inclination of a real axis of rotation (204) of a rotary element (101), the device comprising control electronics (111) controlling the rotation of the rotary element (101) about its real axis of rotation (204), a first and a second rotation sensor (112a, 112b) for obtaining angular velocities about two measurement axes (302, 304) which are orthogonal to one another and both orthogonal to the real axis of rotation (204), a third rotation sensor (112c) making it possible to obtain the angular position and angular velocity of the rotation element (101) about its real axis of rotation (204), at least two of the aforementioned sensors being inertial sensors making it possible to obtain projections of the vector of the speed of rotation of the Earth onto at least two axes of projection, an acquisition unit (113), a measurements-storage memory (114), a computation unit (115) configured to compute, from the angular positions and velocities obtained from the aforesaid sensors, the angular errors in the inclination of the real axis of rotation (204) of the rotary element (101).
Claims
1-12. (canceled)
13. A device (100) for measuring and estimating angular errors of inclination a.sub.x(), a.sub.y() of a real axis of rotation (204) of a rotary element (101) in relation to a reference axis (203), the rotary element (101) being installed in metrology or machining equipment in such a way that its real axis of rotation (204) is aligned as closely as possible with the reference axis (203), the real axis of rotation (204), in relation to the reference axis (203), having an inclination that is variable as a function of the angular position of the rotary element about its real axis of rotation (204) or wobble, the device including: control electronics (111) for controlling the rotation of the rotary element (101) about its real axis of rotation (204); a first and a second rotation sensors (112a, 112b) for obtaining respectively angular velocities of the rotary element (101), about two measurement axes (302, 402) which are orthogonal to one another and both orthogonal to the real axis of rotation (204); a third rotation sensor (112c) for obtaining the angular position and the angular velocity of the rotary element (101) about its real axis of rotation (204), at least two of the above-mentioned sensors being inertial and enabling to obtain projections of the Earth's rotational velocity vector onto at least two projection axes; an acquisition unit (113) configured to acquire measurements made by the above-mentioned sensors while the rotary element carries out at least one series of periodic oscillations resulting in reversals of the direction of rotation of the rotary element; a memory (114) for storing the measurements of the above-mentioned sensors; a calculation unit (115) configured to calculate, from the angular velocities and positions obtained from the above-mentioned sensors, the angular errors of inclination a.sub.x(), a.sub.y() of the real axis of rotation (204) of the rotary element (101) in relation to the reference axis (203) and as a function of the angular position of the rotary element (101) about its real axis of rotation (204).
14. The device according to claim 13, wherein at least two of the three rotation sensors incorporate a gyrometer.
15. The device according to claim 14, wherein said at least two inertial sensors that enable to obtain the projections of the Earth's rotational velocity vector onto at least two projection axes are the first and the second rotation sensors and the two measurement axes (302, 402) of the first and the second rotation sensors are merged with said at least two projection axes.
16. The device according to claim 13, wherein the first and second rotation sensors (112a, 112b) each incorporate a gyrometer integral with the rotary element (101) and the third rotation sensor (112c) incorporates a gyrometer integral with the rotary element (101) and installed in such a way that its sensitive axis is aligned with the real axis of rotation and the calculation unit (115) is configured to calculate the angular rotational velocity and the angular position of the rotary element (101) based on measurements of the third rotation sensor (112c).
17. The device according to claim 14, wherein the first and second rotation sensors (112a, 112b) each incorporate a gyrometer integral with the rotary element (101) and the third rotation sensor (112c) incorporates a gyrometer integral with the rotary element (101) and installed in such a way that its sensitive axis is aligned with the real axis of rotation and the calculation unit (115) is configured to calculate the angular rotational velocity and the angular position of the rotary element (101) based on measurements of the third rotation sensor (112c).
18. The device according to claim 14, wherein the first and second rotation sensors (112a, 112b) each incorporate a gyrometer integral with the rotary element (101) and the third rotation sensor is a specific measurement system enabling to produce directly and/or via calculations the angular rotational velocity and the angular position of the rotary element (101), said specific measurement system being integral with a fixed part of equipment incorporating the rotary element (101).
19. The device according to claim 15, wherein the first and second rotation sensors (112a, 112b) each incorporate a gyrometer integral with the rotary element (101) and the third rotation sensor is a specific measurement system enabling to produce directly and/or via calculations the angular rotational velocity and the angular position of the rotary element (101), said specific measurement system being integral with a fixed part of equipment incorporating the rotary element (101).
20. The device according to claim 14, wherein the first and second rotation sensors (112a, 112b) each incorporate a gyrometer integral with the rotary element (101) and wherein the device incorporates a third rotation sensor (112c) incorporating a gyrometer and a specific measurement system, the gyrometer of the third rotation sensor (112c) being arranged in such a way that its sensitive axis is aligned with the real axis of rotation and the calculation unit (115) being configured to calculate at least one of the angular rotational velocity and the angular position of the rotary element (101) based on measurements of the gyrometer of the third rotation sensor (112c), and said specific measurement system enables to produce directly and/or via calculations at least one of the angular rotational velocity and the angular position of the rotary element (101), said specific measurement system being integral with a fixed part of equipment incorporating the rotary element (101) and wherein the calculation unit (115) is configured to use the angular rotational velocities and the angular positions of the rotary element (101) obtained from measurements of the gyrometer of the third rotation sensor (112c) and the specific measurement system.
21. The device according to claim 15, wherein the first and second rotation sensors (112a, 112b) each incorporate a gyrometer integral with the rotary element (101) and wherein the device incorporates a third rotation sensor (112c) incorporating a gyrometer and a specific measurement system, the gyrometer of the third rotation sensor (112c) being arranged in such a way that its sensitive axis is aligned with the real axis of rotation and the calculation unit (115) being configured to calculate at least one of the angular rotational velocity and the angular position of the rotary element (101) based on measurements of the gyrometer of the third rotation sensor (112c), and said specific measurement system enables to produce directly and/or via calculations at least one of the angular rotational velocity and the angular position of the rotary element (101), said specific measurement system being integral with a fixed part of equipment incorporating the rotary element (101) and wherein the calculation unit (115) is configured to use the angular rotational velocities and the angular positions of the rotary element (101) obtained from measurements of the gyrometer of the third rotation sensor (112c) and the specific measurement system.
22. The device according to claim 13, wherein the calculation unit (115) is configured to calculate, from the measurements of the rotation sensors, an inclination angle (a, a.sub.x, a.sub.y) between the real axis of rotation (204) and the reference axis (203).
23. The device according to claim 15, wherein the calculation unit (115) is configured to calculate, from the measurements of the rotation sensors, an inclination angle (a, a.sub.x, a.sub.y) between the real axis of rotation (204) and the reference axis (203).
24. The device according to claim 17, wherein the calculation unit (115) is configured to calculate, from the measurements of the rotation sensors, an inclination angle (a, a.sub.x, a.sub.y) between the real axis of rotation (204) and the reference axis (203).
25. The device according to claim 19, wherein the calculation unit (115) is configured to calculate, from the measurements of the rotation sensors, an inclination angle (a, a.sub.x, a.sub.y) between the real axis of rotation (204) and the reference axis (203).
26. A method for measuring and estimating angular errors of inclination a.sub.x(), a.sub.y() of a real axis of rotation (204) of a rotary element (101) in relation to a reference axis (203), the rotary element (101) being installed in metrology or machining equipment in such a way that its real axis of rotation is aligned as closely as possible with the reference axis (203), the real axis of rotation (204), in relation to the reference axis (203), having an inclination that is variable as a function of the angular position of the rotary element (101) about its real axis of rotation (204) or wobble, including the following steps: measuring the angular velocities of the rotary element (101) about two measurement axes (302, 402) which are orthogonal to one another and both orthogonal to the real axis of rotation (204); measuring the angular position and the angular velocity of the rotary element (101) about its real axis of rotation (204); measuring the projections of the Earth's rotational velocity onto at least two projection axes; said measurements being made while the rotary element carries out at least one series of periodic oscillations resulting in reversals of the direction of rotation of the rotary element; calculating, from measurements made at the previous steps, the angular errors of inclination a.sub.x(), a.sub.y() of the real axis of rotation (204) of the rotary element (101) in relation to the reference axis (203) and as a function of the angular position of the rotary element (101) about its real axis of rotation (204).
27. The method according to claim 26, further including the following steps: carrying out periodic measurements at determined rotational velocities of the rotary element; averaging the periodic measurements; deducing therefrom errors of orthogonality of the two sensitive axes (302, 402); correcting the measurements of the angular velocities of the rotary element (101) about two axes of measurement (302, 402) for components resulting from the identified errors of orthogonality.
28. The method according to claim 27, including a step of correcting the measurements of the angular velocities of the rotary element (101) about the axes of measurement (302, 402) of the components resulting from the projections of the Earth's rotational velocity vector and integrating said so-corrected measurements of the angular velocities to calculate the angular errors of inclination of the real axis of rotation (204) of the rotary element (101) in relation to the reference axis (203) and as a function of the angular position of the rotary element about its real axis of rotation.
29. The method according to claim 26, wherein a first, a second and a third rotation sensors, which are three gyrometers, are implemented, the real axis of rotation being aligned along a vertical reference z-axis of an orthonormal trihedron of axes x, y, z, the first g.sub.x the second g.sub.y and the third g.sub.z gyrometers carrying out measurements along the axes x, y, z, respectively, and wherein velocities w.sub.x, w.sub.y due to the inclination between the reference axis and the real axis of rotation are calculated by the relations:
{dot over (a)}.sub.x(t)=w.sub.x(t)
{dot over (a)}.sub.y(t)=w.sub.y(t)
30. The method according to claim 27, wherein a first, a second and a third rotation sensors, which are three gyrometers, are implemented, the real axis of rotation being aligned along a vertical reference z-axis of an orthonormal trihedron of axes x, y, z, the first g.sub.x the second g.sub.y and the third g.sub.z gyrometers carrying out measurements along the axes x, y, z, respectively, and wherein velocities w.sub.x, w.sub.y due to the inclination between the reference axis and the real axis of rotation are calculated by the relations:
{dot over (a)}.sub.x(t)=w.sub.x(t)
{dot over (a)}.sub.y(t)=w.sub.y(t)
31. The method according to claim 28, wherein a first, a second and a third rotation sensors, which are three gyrometers, are implemented, the real axis of rotation being aligned along a vertical reference z-axis of an orthonormal trihedron of axes x, y, z, the first g.sub.x the second g.sub.y and the third g.sub.z gyrometers carrying out measurements along the axes x, y, z, respectively, and wherein velocities w.sub.x, w.sub.y due to the inclination between the reference axis and the real axis of rotation are calculated by the relations:
{dot over (a)}.sub.x(t)=w.sub.x(t)
{dot over (a)}.sub.y(t)=w.sub.y(t)
32. The method according to claim 26, wherein the projection axes on which the Earth's rotational velocity is measured are merged with at least two axes among the two measurement axes (302, 402) and the real axis of rotation (204).
Description
BRIEF DESCRIPTION OF DRAWINGS
[0112]
[0113]
[0114]
[0115]
[0116]
[0117]
[0118]
DETAILED DESCRIPTION OF THE INVENTION
[0119] The following description in relation with the appended drawings, given by way of non-limiting examples, will allow a good understanding of what the invention consists of and of how it can be implemented.
[0120] Generally, as modelled in
[0121] A wobble example is schematized in
[0122] Back to
[0123] In the example that will be detailed hereinafter, for a vertical reference axis, these angles will be a.sub.x, a.sub.y(wobble angles) along x-axis and y-axis of a reference frame and their declinations a.sub.x(t), a.sub.y(t) and a.sub.x(), a.sub.y(), respectively, as a function of time and of the angular position of the rotary element. In
[0124] The rotation is thus made in reality about the real axis of rotation 204, the position of which can be modelled b.sub.y two errors of inclination about two axes which are orthogonal to one another and both orthogonal to the reference axis 203.
[0125] The invention enables to determine in a device 100 schematized in
[0126] Within the framework of the invention, for the rotary element 101, it is considered that the magnitude of these errors is less than a few tens of arcsec.
[0127] It results from these errors, the creation of a wobble during the rotation of the rotary element and that the invention proposes to quantify by calculating the angular errors of inclination of the real axis of rotation of the rotary element then, in particular, the precise orientation of the real axis of rotation 204 and that may correspond to the North alignment of the real axis of rotation or to the inclination between the real axis of rotation 204 and, preferentially, the reference axis 203 of the rotary element 101.
[0128] Due to the Earth's rotation, in a geocentric reference frame, the rotary element 101 and its frame 201 both rotate about the Earth's axis of rotation.
[0129] If we consider, as schematically shown in
[0130] If we consider rotation sensors 112a, 112b that may be a first and a second gyrometers each having a sensitive axis (=measurement axis), denoted 302 for the first rotation sensor and 402 for the second rotation sensor, and which are integral with and perfectly orthogonal to the real axis of rotation 204 of the rotary element 101, then these two rotation sensors 112a, 112b would not measure the rotation component of the real axis of rotation 204 but would measure the Earth's rotation projection onto their respective sensitive axes 302, 402.
[0131] This latter component (the Earth's rotation projection onto the sensitive axis 302, 402) would of course vary as a function of the two inclination components of the real axis 204 but also as a function of the angular position of the rotary element 101 on its real axis of rotation 204 during its rotation.
[0132] Moreover, this latter component would be maximum when the sensitive axis 302, 402 of the corresponding rotation sensor 112a or 112b is aligned with the projection 401 of the Earth's rotational velocity vector in the plane of rotation of the sensitive axis 302, 402 about the rotary element 101. It would then be equal to the projection 401 of the Earth's rotational velocity vector in the plane of rotation of the sensitive axis 302, 402 about the rotary element 101. Conversely, this latter component would be zero when the sensitive axis 302, 402 of the rotation sensor 112a or 112b is orthogonal to the projection 401 of the Earth's rotational velocity vector in the plane of rotation of the sensitive axis 302, 402 about the rotary element 101.
[0133] The invention enables, in several embodiments, to identify this projection component 401 of the Earth's rotational velocity vector and to correct the measurements accordingly.
[0134] In practice, a rotation sensor 112a, 112b, the first and the second gyrometers in the example, cannot be installed with its sensitive axis perfectly orthogonal to the real axis of rotation 204. The orthogonality error of this rotation sensor 112a, 112b with the real axis of rotation 204 has thus be taken into account. For that purpose, the invention includes identifying this orthogonality error and correcting the measurements accordingly.
[0135] The same applies to the potential orthogonality error between the sensitive axes of the first 112a and the second 112b gyrometers.
[0136] In practice, the third rotation sensor 112c, which can be a gyrometer, cannot be installed in perfect alignment with the real axis of rotation 204. The alignment error of this rotation sensor with the real axis of rotation 204 can also be taken into account, but in practice, this error, which is generally small, is neglected.
[0137] It is to be noted that the metrology device may incorporate two elements for the third rotation sensor: a gyrometer and a specific measurement system to obtain via two means the angular rotational velocity and the angular position of the rotary element, for example an angular encoder.
[0138] The device 100 implemented within the framework of the invention incorporates rotation sensors 112a, 112b, 112c, preferably gyrometers integral with the rotary element 101, i.e. attached to the rotary element. It is to be noted that, when it is indicated that the gyrometers are integral with or attached to the rotary element, these attachments may be direct or indirect and in these latter cases, they are attached to a measurement table driven in rotation by the rotary element.
[0139] In an embodiment, two rotation sensors, a first and a second rotation sensors, are installed on the rotary element in such a way that their measurement axes (sensitive axes in the case of gyrometers) are orthogonal to one another and both orthogonal to the real axis of rotation 204 of the rotary element 101. These rotation sensors may in particular be independent gyrometers or the gyrometers of an inertial unit.
[0140] Moreover, a third rotation sensor integral with the rotary axis 101 is installed in such a way that its measurement axis (sensitive axis in the case of a gyrometer) is aligned with the real axis of rotation 204 of the rotary element 101. This third rotation sensor may in particular be an independent gyrometer or the third gyrometer of the above-mentioned inertial unit that conventionally incorporates three gyrometers, the inertial unit being configured to produce measurements according to an orthonormal trihedron.
[0141] It is to be noted that the invention is applicable to an inertial unit whose gyrometers are not necessarily aligned along an orthonormal trihedron, for example the gyrometers are arranged in a pyramid shape inside the inertial unit. An inertial unit can thus be used without worrying about the direction of the sensitive axes of the gyrometers inside the inertial unit. It will be seen that it is possible to do without gyrometer for the third rotation sensor but it is necessary to have a specific measurement system for obtaining directly or via calculations the angular position (t) and the angular velocity {dot over ()}(t) of the rotary element. It is indeed necessary to know the angular position (t) and the angular velocity {dot over ()}(t) of the rotary element to calculate in space (and even in time) the angular errors of inclination of the real axis of rotation and thereafter the precise orientation of the real axis of rotation of the rotary element, including the North alignment of the real axis of rotation and/or the inclination between the real axis of rotation and a determined reference axis, in particular its reference axis.
[0142] In practice, such a specific measurement system will generally be associated with a third gyrometer because an inertial unit or an inertial measurement unit is generally implemented, which comes with three gyrometers as standard, and two sources (the gyrometer and the specific measurement system) will be available to obtain the angular position (t) and the angular velocity (t) of the rotary element.
[0143] The specific measurement system enabling to obtain the angular position (t) and the angular velocity (t) of the rotary element other than a gyrometer is a rotation sensor integral with a fixed portion of the frame 201 of the equipment and that measures the rotation of the rotary element 101 about its real axis of rotation 204. This specific measurement system can in particular be an optical encoder, an inductive encoder, a magnetic encoder, an interferometric rotation measurement system, this specific measurement system can further incorporate calculation means to produce in particular an angular velocity measurement from the angular position. In certain modalities, the specific measurement system is consisted of two sensors, one for the angular position and one for the angular velocity.
[0144] The device 100 of the invention also incorporates control electronics 111 that controls the rotary element 101 according to the determined instructions.
[0145] The device 100 according to the invention also incorporates an acquisition unit 113 making the synchronous acquisition of the measurements made by the rotation sensors 112a, 112b, 112c and the potential specific measurement system and enables to store the measurements as data in a memory 114.
[0146] Indeed, in order to characterize the rotary element 101, it is necessary to obtain measurements over several turns of the rotary element and preferably for several values of rotation velocities of said rotary element. Moreover, in order to increase the precision of the results, it is advantageous to average the measurement results to reduce and eliminate the random effects. In practice, the measurement/data collection may last from a few seconds to a few hours, the final characterization calculations being themselves very fast with the computer means available inside the device or outside the device.
[0147] In one embodiment in which the characterization is made within the device, the latter incorporates a computer processing unit 115 (Digital Processing Unit/DSP and/or microprocessor) using the measurement/data in memory 114 to calculate the angular errors of inclination of the real axis of rotation and, afterwards, in particular the precise orientation of the real axis of rotation, including North alignment of the rotary element or inclination of the real axis of rotation with respect to a reference axis.
[0148] Once these characterization data of the rotary element obtained during a characterization phase of the rotary element, they can be used during normal operation (metrology phase in the case of a metrology equipment) of the equipment incorporating this rotary element to carry out corrections in real time. These characterization data are thus advantageously memorized in the equipment for a latter use by the control electronics 111 that controls the rotary element 101 so that the equipment operates according to the determined instructions that are provided to it by eliminating the errors due to the misalignment between the real axis of rotation and the reference axis. These stored characterization data can also be used to correct measurements made on a device set in motion by the metrology equipment rotary element.
[0149] During the characterization phase, the control electronics 111 that controls the rotary element 101 receives instructions for the rotary element to carry out at least one series of periodic oscillations during which measurements are acquired. These periodic oscillations may be for example an angular oscillation, e.g. of sinusoidal form. Another form of periodic oscillation is possible, but there must be continuity of angular velocity and position. These periodic oscillations lead to reversals in the direction of rotation of the rotary element.
[0150] The equipment is therefore initially used in a characterization phase of the rotary element, which consists of collecting measurements and then characterizing the rotary element. The calculated characterization data obtained are therefore stored in the equipment for later use in metrology phases corresponding to the usual use of the equipment. It is understood that calculations on measurements/data during the characterization phase can be carried out within the equipment or in an external storage and calculation system, the latter case in particular if this phase is carried out only once at the end of equipment manufacture.
[0151] The characterization phase can be carried out only at the end of the equipment manufacture, and not repeated subsequently. However, it may be advantageous to repeat a characterization phase from time to time, as a change in characterization data may be an early warning sign of an equipment fault, and therefore be used in a failure prediction process.
[0152] In certain implementation modes, it is envisaged that characterization is carried out in pseudo-real time, at the same time as the usual use of the equipment, with the characterization data updated periodically during the time of use.
[0153] Referring to
[0154] As indicated, it is advantageous to average the measurements/data obtained to reduce/suppress the random or even periodic effects. The averaging is carried out over a given number of measurement sequences with periodic oscillations, advantageously sinusoidal, whose amplitude and period characteristics are identical (the sequences are repeated with a same periodic oscillation).
[0155] Using the stored measurements/data, advantageously averaged, the orthogonality errors of the rotation sensors are identified, in order to be able to subsequently correct these measurements/data of the rotation sensors from the components resulting from the orthogonality errors. This identification and correction are carried out for the first and the second gyrometers.
[0156] With the measurements/data corrected for the orthogonality errors, the amplitude of the Earth's rotational velocity vector projection and the initial headings of the rotation sensors are then estimated. The North alignment of the real axis of rotation can then be determined, which enables to eliminate the Earth's rotation component from the measurements made b.sub.y the gyrometers.
[0157] Moreover, the calculations can be continued to obtain the inclination of the real axis of rotation with respect to the reference axis. For that purpose, the measurements made by the rotation sensors are corrected for the components resulting from the projections of the Earth's rotational velocity vector onto the rotation sensors, then the measurements of the rotation sensors are integrated to obtain the two components of angular error of inclination of the rotary element, i.e. the inclination between the real axis of rotation 204 and the reference axis 203 and corresponding to two errors of inclination about two axes which are orthogonal to one another and both orthogonal to the reference axis 203 as mentioned hereinabove.
[0158] Returning to the device 100 of
[0159] The modalities of calculation of the wobble (warp or offset) in the case of a vertical rotary element, by way of example, i.e. aligned along z-axis, which is thus the reference axis, will now be described according to a second mode of presentation.
[0160] In this example, three rotation sensors are implemented and these are three gyrometers enabling measurements of angular velocities in the x-y plane and along z-axis and which are attached to the rotary element that is assumed to be vertical. The three gyrometers are fixed and their sensitive axes are oriented with reference to the real axis of rotation of the rotary element.
[0161] Hereinafter, the following notations are used, wherein the x, y and z axes are the axes of a reference frame of a test plate in the application in relation with
[0174] The calculations implemented enable to correct the measurements by eliminating, or at least reducing, the biases of the gyrometers, the effects of the Earth's rotation projection on the gyrometer measurements, the misalignments of the gyrometers between each other.
[0175] The gyrometer biases are reduced/suppressed by averaging the measurements. Measurement averaging is thus carried out during or after the measurements, at the beginning of the characterization phase. Once this bias correction obtained, it remains on the measurement/sensitive axes perpendicular to the real axis of rotation, a residual velocity that corresponds to the Earth's rotation projection and to the wobble effect and the calculations will enable to determine this later effect and thus to characterize the rotary element.
[0176] It is considered that the local geographical trihedron is such that z-axis points upward, x-axis towards the North, and y-axis towards the West. It is also assumed that the equipment reference frame is the local geographical trihedron, which may be easily achieved by northing the equipment. If the latter operation is not carried out, the resulting offset will be taken into account in the calculations.
[0177] In this reference frame, the Earth's projection, denoted V.sub.terre_GEO is
[0178] Assuming that the axis is not affected by the wobble and that the reference frame of the gyrometers placed on the equipment rotary element is aligned with the local geographical reference frame when the position of the axis is zero (=0), under these simplifying assumptions:
[0179] In practice, the gyrometers are not perfectly aligned and the reference frame of the gyrometers is deduced from the equipment reference frame by means of a passage matrix. Given the use made here of gyrometer measurements, this transition matrix M.sub.mes from the equipment reference frame to the gyrometer reference frame can be expressed by
[0180] Taking into account theses misalignments, the gyrometer measurements are expressed according to:
[0181] Now, taking into account the wobble effects on x-axis and y-axis, we obtain:
[0182] Which may be rewritten:
[0183] And finally:
[0184] Moreover, , L are known.
[0185] Likewise, the angular position (t) of the rotary element and the angular velocity {dot over ()}(t) of the rotary element are known at each time instant t, either directly through the implementation of one or more specific measurement devices (i.e. non-gyrometric), including specific calculations (including the derivation, as the velocity can be calculated from specific measurements of position), or using the gyrometer measurement g.sub.z(t) along z-axis. The measurements g.sub.z(t) along z-axis are therefore not necessary for a vertical rotary element if the angular position (t) of the rotary element and the angular velocity {dot over ()}(t) of the rotary element can be known by another manner than b.sub.y a z-axis gyrometer. Therefore, in the case of a vertical rotary element, it is possible to use only two gyrometers, along x-axis and y-axis, and at least one specific measurement system for the angular position (t) and the angular velocity {dot over ()}(t).
[0186] Note that for z-axis, it is possible to use only one gyrometer that gives the rotational velocity, since integrating the z-axis gyrometer velocity gives a position, but the later has the disadvantage of being within one constant. A means for recalibrating the position must therefore be implemented, either b.sub.y calculation or by another sensor indexing a given rotational position.
[0187] In practice, two sensors will thus be used for z-axis, advantageously a gyrometer and a means for obtaining the rotational position of the rotary element.
[0188] Moreover, the angular velocity {dot over ()}(t) of the axis is (almost all the time) much higher than the quantity sinL, i.e. |{dot over ()}(t)|sinL, and the term sinL negligible relative to {dot over ()}(t) can be considered. Therefore:
[0189] Considering the equations giving g.sub.x(t) and g.sub.y(t), at each time instant t it can be seen that the velocities due to the wobble can be deduced at each time instant w.sub.x(t), w.sub.y(t) by the relations:
[0190] The North alignment of the axis (here vertical) is made using the velocities measured b.sub.y the x-axis and y-axis gyrometers, during static phases corresponding to {dot over ()}=0. Let's .sub.c be the angular position measured by the encoder, and the distance from the North, such that =c+ when {dot over ()}=0, then
[0191] .sub.c is known because it is measured and also
[0192] Therefore, for example using four static positions such that .sub.c= [0; 90; 180; 270], it is possible to estimate the parameters cos, sin, b.sub.x, b.sub.y by means of a linear regression, because g.sub.x and g.sub.y linearly depend on these four parameters.
[0193] In these last two equations, the terms g.sub.x(t), g.sub.y(t) are known at each time instant by acquiring information from the x-axis and y-axis gyrometers, the terms cos(t) cosL and sin(t) cosL are also known due to the fact that (t) is known directly (by specific measurement device(s), and possibly calculations from said measurements) or indirectly using the measurement g.sub.z(t).
[0194] Moreover, the terms m.sub.1z, m.sub.2z and b.sub.x, b.sub.y are identifiable and can be estimated for example by means of a simple linear regression (least squares), whereas {dot over ()}(t) is known directly (by specific measurement device(s), and possibly calculations from said measurements) or indirectly using the measurement g.sub.z(t).
[0195] By definition of the wobble, the wobble angles a.sub.x(t), a.sub.y(t) as a function of time obey the very simple differential equations
{dot over (a)}.sub.x(t)=w.sub.x(t)
{dot over (a)}.sub.y(t)=w.sub.y(t)
[0196] But as is known at each time instant t, the wobble angles may be expressed directly as a function of the angular position or .sub.c of the equipment rotary element, i.e. express a.sub.x(), a.sub.y() or a.sub.x(.sub.c), a.sub.y(.sub.c).
[0197] These principles can be applied to the cases of the horizontal rotary elements having a wobble. To simplify the calculations, the horizontal rotary element may be aligned with x-axis or y-axis, which will then be the reference axis. Compared with previous calculations, the projection of the Earth's rotational velocity onto the precise axis must be taken into account, and a z-axis gyrometer must therefore be used to obtain the measurement g.sub.z(t). As regards the rotary element gyrometer (=the third rotation sensor), which is along x-axis or y-axis according to the case, it may be contemplated to add or replace it with specific sensor(s) to obtain the angular position (t) and the angular velocity {dot over ()}(t) of the rotary element.
[0198] In the calculation formulas for horizontal rotary elements, we will take into account the fact that the parasitic velocities resulting from the wobble effect perceived on the gyrometers will then concern the two other axes (x or y and z) which are not along the rotary element (the rotary element being y or x, respectively). It is the same for the wobble angle. For example, if the rotary element is aligned along x (reference axis), then the parasitic velocities resulting from the wobble effect are perceived on the y-axis and z-axis gyrometer (w.sub.y, w.sub.z) and the wobble angles are on y-axis and z-axis (a.sub.y, a.sub.z).
[0199] The previous exemplary embodiment uses simplified calculations, thanks to a choice of particular orientations for the equipment and the vertical or horizontal rotary element, but it is clear that it is possible to use other orientations, in which case these will be taken into account in the calculations.