Device and method for determining a characteristic of a path formed by consecutive positions of a triaxial accelerometer rigidly connected to a mobile element
First Claim
1. A device for determining a characteristic of a trajectory of a mobile element, the device comprising:
- a triaxial accelerometer attached to the mobile element;
an additional triaxial sensor for measuring a vector of a relatively constant vector field in a fixed global reference frame with respect to the terrestrial reference frame, said additional triaxial sensor being attached to said mobile element and fixed in a reference frame of the triaxial accelerometer; and
a control circuit, said control circuit comprising;
first determining means for determining a first instant of immobility and a second instant of immobility of the triaxial accelerometer, the second instant of immobility being subsequent to said first instant of immobility;
second determining means for determining a relatively invariant axis of rotation of the triaxial accelerometer between said first and second instants of immobility as the device moves between said first and second instants of immobility, and a plane orthogonal to said relatively invariant axis of rotation, in a mobile reference frame with respect to the accelerometer or to the additional triaxial sensor on the basis of vectors provided by the triaxial accelerometer, or on the basis of vectors provided by the additional triaxial sensor;
first calculating means for calculating at successive instants between said first and second instants of immobility first orthogonal projections onto said plane of the vectors provided by the triaxial accelerometer and of the vectors provided by the additional triaxial sensor in said mobile reference frame;
third determining means for determining at said successive instants a rotation for switching from said mobile reference frame to said fixed global reference frame, on the basis of said first orthogonal projections of the vectors delivered by the additional triaxial sensor;
second calculating means for calculating at said successive instants second orthogonal projections in said fixed global reference frame of the first orthogonal projections, provided by said first calculating means in said plane of the vectors delivered by the triaxial accelerometerthird calculating means for subtracting from each second orthogonal projection in said fixed global reference frame provided by the second calculating means a mean vector over said successive instants, so as to obtain accelerations centered in said plane relatively devoid of terrestrial gravitational influences and of drifts of said device, in said fixed global reference frame; and
fourth calculating means for calculating a characteristic of the trajectory utilizing the centered accelerations obtained from the third calculating means.
1 Assignment
0 Petitions
Accused Products
Abstract
Device for determining a characteristic of a trajectory formed of successive positions of a triaxial accelerometer (3A) rigidly tied to a mobile element (EM), between a first instant of immobility (t0) and a second instant of immobility (tn) of the triaxial accelerometer (3A), subsequent to said first instant of immobility (t0), said device comprising, furthermore, a triaxial additional sensor for measuring a vector of a substantially constant vector field between said first and second instants of immobility (t0,tn), in a fixed global reference frame (GE) tied to the terrestrial reference frame, said additional sensor being rigidly tied to said mobile element (EM) and fixed in the reference frame of the accelerometer (3A), and control means (CMD).
3 Citations
25 Claims
-
1. A device for determining a characteristic of a trajectory of a mobile element, the device comprising:
-
a triaxial accelerometer attached to the mobile element; an additional triaxial sensor for measuring a vector of a relatively constant vector field in a fixed global reference frame with respect to the terrestrial reference frame, said additional triaxial sensor being attached to said mobile element and fixed in a reference frame of the triaxial accelerometer; and a control circuit, said control circuit comprising; first determining means for determining a first instant of immobility and a second instant of immobility of the triaxial accelerometer, the second instant of immobility being subsequent to said first instant of immobility; second determining means for determining a relatively invariant axis of rotation of the triaxial accelerometer between said first and second instants of immobility as the device moves between said first and second instants of immobility, and a plane orthogonal to said relatively invariant axis of rotation, in a mobile reference frame with respect to the accelerometer or to the additional triaxial sensor on the basis of vectors provided by the triaxial accelerometer, or on the basis of vectors provided by the additional triaxial sensor; first calculating means for calculating at successive instants between said first and second instants of immobility first orthogonal projections onto said plane of the vectors provided by the triaxial accelerometer and of the vectors provided by the additional triaxial sensor in said mobile reference frame; third determining means for determining at said successive instants a rotation for switching from said mobile reference frame to said fixed global reference frame, on the basis of said first orthogonal projections of the vectors delivered by the additional triaxial sensor; second calculating means for calculating at said successive instants second orthogonal projections in said fixed global reference frame of the first orthogonal projections, provided by said first calculating means in said plane of the vectors delivered by the triaxial accelerometer third calculating means for subtracting from each second orthogonal projection in said fixed global reference frame provided by the second calculating means a mean vector over said successive instants, so as to obtain accelerations centered in said plane relatively devoid of terrestrial gravitational influences and of drifts of said device, in said fixed global reference frame; and fourth calculating means for calculating a characteristic of the trajectory utilizing the centered accelerations obtained from the third calculating means. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24)
-
-
25. A method for determining a characteristic of a trajectory obtained from successive positions of a triaxial accelerometer attached to a mobile element, between a first instant of immobility and a second instant of immobility of the triaxial accelerometer, the second instant of immobility being subsequent to said first instant of immobility, the method further comprising utilizing an additional triaxial sensor for measuring a vector of a relatively constant vector field in a fixed global reference frame with respect to the terrestrial reference frame, said additional triaxial sensor being connected to said mobile element and fixed in a reference frame of the triaxial accelerometer, said method further comprising, using a data processor, performing the following steps:
-
determining said first and second instants of immobility of the triaxial accelerometer; determining, as the mobile element moves between said first and second instants of immobility, a relatively invariant axis of rotation of the triaxial accelerometer between the first and second instants of immobility, and determining a plane orthogonal to said relatively invariant axis of rotation, in a mobile reference frame with respect to the accelerometer or to the additional triaxial sensor, utilizing vectors provided by the triaxial accelerometer or utilizing vectors provided by the additional triaxial sensor; calculating, at successive instants between said first and second instants of immobility, first orthogonal projections in said plane, of the vectors provided by the triaxial accelerometer and of the vectors provided by the additional triaxial sensor in said mobile reference frame; determining, at said successive instants, a rotation for switching from said mobile reference frame to said fixed global reference frame, utilizing said first orthogonal projections of the vectors provided by the additional triaxial sensor; calculating, at said successive instants, second orthogonal projections in said fixed global reference frame of the first orthogonal projections in said plane of the vectors provided by the triaxial accelerometer; subtracting from each second orthogonal projection in said fixed global reference frame, a mean vector over said successive instants so as to obtain accelerations centered in said plane, relatively devoid of influence of terrestrial gravity and of drifts of said device, in said fixed global reference frame; and determining a characteristic of the trajectory on the basis of the centered accelerations.
-
Specification