The invention pertains to a device for determining a characteristic of a trajectory formed of successive positions of a triaxial accelerometer tied to a mobile element.
In a general manner, the invention is related to the fields of motion capture, and the geolocating of individuals moving around. Motion capture relates to general-public applications such as leisure applications (interactive games consoles, tracking of sports movements, virtual reality or augmented reality), applications for aiding the navigation of pedestrians (the most widely used at the present time being satellite navigation systems such as GPS), applications for aiding the mobility of vulnerable persons or those temporarily enfeebled by their environment (handicapped persons or those plunged into darkness), and fitness applications (pedometer, calculation of energy expenditure or of distance traveled). Motion capture also relates to medical applications (tracking of the elderly and/or of dependents, analysis of the gait for postural reeducation or aid to diagnosis), safety or rescue applications (locating of firemen inside a building on fire, operational tracking of military servicemen, or surveillance of prisoners), as well as commercially directed applications (statistics on the trajectories followed by consumers in shopping centers or supermarkets, definition of archetypes of use, or proposal of topo-dependent commercial services).
It is notably known to reconstruct the movement of an object or of a person fitted with an object comprising an emitter of signals that are recognized by a satellite-based navigation aid system, such as the GPS system, outdoors, and by a radiolocation system based on Ultra Wide Band (UWB) or WiFi transmissions indoors.
In numerous geographical zones, external or internal, navigation relying on a satellite-based navigation aid or radiolocation system turns out nonetheless to be very tricky, because of the obstruction of the radio signals that are required for the measurement of topo-dependent metrics, for example in the case of unavailability of the signals emitted by one or more satellites of the navigation aid system and required for the measurement of pseudo-distances. In practice, these blockage or obstruction situations heavily degrade the accuracy of the location information, and sometimes even render the navigation aid service unavailable, as illustrated in the document “An evaluation of UWB localization under non line-of-sight (NLOS) propagation” (A. Maali, A. Ouldali, H. Mimoun, and G. Baudoin), published in Wireless Pervasive Computing, ISWPC, 3rd International Symposium on, pages 379-382, in May 2008. Generally, the implementations cited above exhibit a cost, consumption, bulkiness, and/or infrastructure that are unsuitable or indeed crippling for general-public applications.
Other systems are aimed at computing a path on the basis of a given departure point, by using attitude sensors (accelerometer(s), magnetometer(s), gyrometer) usually delivering inertial measurements. These measurements make it possible to undertake navigation by more or less accurate and complicated means, such as described, for example in the documents “Inertial head-tracker sensor fusion by a complementary separate-bias kalman filter” (E. Foxlin) published in March 1996 in Virtual Reality Annual International Symposium, Proceedings of the IEEE 1996, pages 185-194; “Detection of spatio-temporal gait parameters by using wearable motion sensors” (K. Kogure L. Seon-Woo, and K. Mase), published in 2005 in Engineering in Medicine and Biology Society. IEEE-EMBS 2005. 27th Annual International Conference of the, pages 6836-6839, 2005; “Pedestrian tracking with shoe-mounted inertial sensors” (E. Foxlin), published in November 2005 in Computer Graphics and Applications, IEEE, 25:38-46, November-December 2005; or “Integration of foot-mounted inertial sensors into a Bayesian location estimation framework” (P. Robertson B. Krach), published in March 2008 in Positioning, Navigation and Communication, 2008. WPNC 2008. 5th Workshop on, pages 55-61. Such systems are of high cost and complexity, and often lack accuracy.
Video games consoles, such as the Wii, use optical and/or ultrasound sensors to determine the trajectory of a game control element. These systems are expensive and limited.
There also exist, as presented in the documents “Assessment of walking features from foot inertial sensing” (S. Scapellato F. Cavallo A. M. Sabatini, and C. Martelloni), published in March 2005 in Biomedical Engineering, IEEE Transactions on, pages 486-494, or “Multisensor approach to walking distance estimation with foot inertial sensing” (D. Alvarez A. M Lopez J. Rodriguez-Uria J. C. Alvarez, and R. C. Gonzalez), published in August 2007 in Engineering in Medicine and Biology Society, 2007, EMBS 2007. 29th Annual International Conference of the IEEE, pages 5719-5722, systems which assume two accelerometers and a gyrometer which are disposed in the sagittal plane of a user, making it possible to determine the attitude of this sensor in the plane. The acceleration is integrated on the axis of the foot. These systems have a reduced cost, but present other drawbacks. On the one hand, they assume that the sensors are perfectly placed in the sagittal plane, this being almost impossible for the user to actually achieve, and causing an estimation error related to the poor positioning of the sensor or sensors. On the other hand, they assume that walking takes place in the sagittal plane, which may not be the case, when walking sideways on, for example.
The document, “An innovative shoe-mounted pedestrian navigation system” (K. Fyfe, Gérard Lachapelle, R. Stirling, and J. Collin), published in April 2003 in Proc. European Navigation Conf. (GNSS), CD-ROM, Austrian Inst. of Navigation, discloses a system fitted with three accelerometers and with a fourth accelerometer so as to calculate the angle undergone by the sensor. This further accelerometer is placed on the same mobile element, but some distance from the latter. The two sensors therefore see the same rotation and the same displacement. Such a structure makes it possible to estimate the speed of rotation of the mobile element, in rotation about a substantially constant direction, while dispensing with a gyrometer. This system has a reduced cost due to the replacing of a single-axis gyrometer with a pair of accelerometers with respect to the systems with gyrometers proposed by Alvarez et al. and Scapellato et al. However, such a system exhibits the same drawbacks as the example cited hereinabove, since only the rotation about the axis orthogonal to the sagittal plane is taken into account. Furthermore, the estimation of the rotation by a pair of accelerometers, just like that carried out with the aid of a gyrometer, exhibits significant drifts. A heading is also determined with the aid of a magnetometer, for example when the foot is resting, thus giving the direction of the foot and not the sought-after direction of the displacement.
The aim of the invention is to determine a trajectory at reduced cost, and to solve the problems cited above.
According to one aspect of the invention, there is proposed a device for determining a characteristic of a trajectory formed of successive positions of a triaxial accelerometer rigidly tied to a mobile element, between a first instant of immobility and a second instant of immobility of the triaxial accelerometer, subsequent to said first instant of immobility, 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, in a fixed global reference frame tied to the terrestrial reference frame, said additional sensor being rigidly tied to said mobile element and fixed in the reference frame of the accelerometer, and control means, characterized in that said control means comprise:
Such a device makes it possible to determine a trajectory of a triaxial accelerometer tied to a mobile element, in an accurate manner and at reduced cost. The mobile element may be a part of the human body like a foot or a hand, or a part of an animal body, as well as a part of an artificial body such as a robot or a computer mouse. In the subsequent description, the invention will be described for a foot of a human body, but can be applied by analogy to any mobile element.
In one mode of implementation, said successive positions are substantially coplanar.
For example, the device may be a device for determining a trajectory formed of substantially coplanar successive positions of a triaxial accelerometer rigidly tied to a mobile element of a human, animal or artificial body, between a first instant of immobility and a second instant of immobility of the triaxial accelerometer, subsequent to said first instant of immobility, the triaxial accelerometer being in rotation with respect to a substantially constant direction between said first and second instants of immobility. Said device comprises, furthermore, an additional sensor for measuring a vector of a substantially constant vector field between said first and second instants of immobility, in a fixed global reference frame tied to the terrestrial reference frame, said additional sensor being rigidly tied to said mobile element and with measurement axes substantially parallel to the measurement axes of the accelerometer, and control means. Said control means comprise:
Such a device makes it possible, at reduced cost, to determine a characteristic of a plane trajectory of a triaxial accelerometer tied to a mobile element, in an accurate manner.
Hence, in one mode of implementation, said mobile element is a foot, the time interval separating said first and second instants of immobility of the triaxial accelerometer corresponding to a pace of said foot.
According to one mode of implementation, said control means comprise first means for computing a direction vector, adapted for linking the respective positions, expressed in said fixed global reference frame, of the triaxial accelerometer with said first instant of immobility and with said second instant of immobility.
The direction of this vector in the fixed global reference frame gives the direction of the displacement, and its length the distance traveled.
In one mode of implementation, said plane of the trajectory being vertical, said control means comprise, furthermore, second means for computing a displacement heading with respect to said vector field measured by the additional sensor, said second computation means being adapted for performing an orthogonal projection, of said vector field measured by the additional sensor, onto a horizontal plane orthogonal to said plane of the trajectory.
If the additional sensor is a magnetometer, the direction of the displacement with respect to North is obtained. It is possible, for example, to plot the direction of the displacement on a map or to give the coordinates of this vector, thus indicating the direction in which the user has moved.
In one mode of implementation, said plane of the trajectory being vertical, said second means for determining the plane of said trajectory of the triaxial accelerometer are adapted for performing a singular-value decomposition of the three-column matrix formed by the vectors delivered by the triaxial accelerometer at said successive instants, in said mobile reference frame, and extracting the two vectors corresponding to the larger two singular values.
The device is in translation in a plane and performs a rotation about a substantially constant direction. This calculation means is robust and inexpensive in terms of the number of operations. Moreover the orientation of the sensor on the mobile element is irrelevant. No assumption is made regarding the direction of the trajectory which may be arbitrary.
In one mode of implementation, said plane of the trajectory being vertical, said second means for determining the plane of said trajectory of the triaxial accelerometer are adapted for performing a decomposition into eigenvalues and eigenvectors, in said mobile reference frame, the autocorrelation matrix of the three-column matrix formed by the vectors delivered by the triaxial accelerometer at said successive instants, and extracting the two eigenvectors corresponding to the larger two eigenvalues.
Likewise, the device is in translation in a plane and performs a rotation about a substantially constant direction. This calculation means is robust and inexpensive in terms of the number of operations. Moreover the orientation of the sensor on the mobile element is irrelevant. No assumption is made regarding the direction of the trajectory which may be arbitrary.
According to one mode of implementation, said second calculation means comprise fifth calculation means for switching to an intermediate reference frame, tied to the terrestrial reference frame, defined by a first vector delivered by said first calculation means on the basis of a vector provided by the additional sensor, and by a second vector, orthogonal to said first vector and belonging to said plane of the trajectory.
The number of calculations to be performed is thus minimized since the first vector is available and only a few multiplications and additions are used to switch to the global reference frame.
According to one mode of implementation, in which said third means for determining the rotation for switching from said mobile reference frame to said fixed global reference frame comprise means for estimating an angle, said switching rotation being defined by an orthogonal projection onto said substantially constant vector field, followed by a rotation by said estimated angle in said plane of trajectory of the triaxial accelerometer.
This estimation makes it possible to orient the trajectory in a known global reference frame, such as the NED or “North-East-Down” reference frame.
For example said estimation means are adapted for estimating said angle on the basis of the slope of the contact surface of the mobile element, and of the vector transmitted by said fifth calculation means on the basis of the vector transmitted by the triaxial accelerometer.
The slope may be known through a predetermined correspondence table providing the slope of the contact surface of the mobile element on the basis of the position of the accelerometer.
This scheme is robust once the slope is known accurately (in buildings for example the slope is often zero, another example is walking on an inclined slope of constant slope). By virtue of this scheme, in the estimated characteristic of the trajectory, the foot is on the ground at each instant of immobility
For example, said estimation means are adapted for estimating said angle on the basis of a singular-value decomposition of the three-column matrix provided by said fifth calculation means on the basis of the matrix formed by the vectors delivered by the triaxial accelerometer at said successive instants.
In this case, no knowledge of the slope is required, everything is based on the statistics of the signal.
For example, said estimation means are adapted for estimating said angle as the angle, at said first or second instant of immobility, between the vector delivered by said first calculation means on the basis of the vector provided by the additional sensor, and the vector delivered by said first calculation means on the basis of the vector provided by the triaxial accelerometer.
In this case, no mapping is needed, nor any assumption regarding the trajectory, such as trajectory longer than it is high.
In one mode of implementation, said control means comprise third means for computing the distance traveled between said first and second instants of immobility, and/or during a set of successive time intervals separating two successive instants of immobility of the triaxial accelerometer, on the basis of the data provided by said fourth calculation means.
The distance traveled between the two successive instants of immobility of the triaxial accelerometer, and therefore, in the case of the foot, the distance traveled by the foot between two successive groundings, is easily calculated.
According to one mode of implementation, said control means comprise fourth means for computing a trajectory during a set of successive time intervals separating two successive instants of immobility of the triaxial accelerometer, on the basis of the data provided by said fourth calculation means.
The invention makes it possible to compute, with a number of reduced calculations, a characteristic of the trajectory of a user during a displacement.
In one mode of implementation, said additional sensor is a triaxial magnetometer for measuring the terrestrial magnetic field, substantially constant between said first and second instants of immobility.
Thus the cost is reduced, for example by comparison with the use of gyrometers.
According to one mode of implementation, said triaxial accelerometer is disposed so as to be positioned substantially at the level of the contact surface of the mobile element, at an instant of immobility of said triaxial accelerometer.
In this case, the acceleration is indeed zero during a grounding of the foot, thereby improving the accuracy of the device.
In one mode of implementation, said additional sensor is disposed so as to be positioned some distance from the contact surface of said mobile element at an instant of immobility of said triaxial accelerometer.
Disturbances in measuring the terrestrial magnetic field at ground level are avoided, thereby improving the accuracy of the device.
According to one mode of implementation, said control means are tied to the mobile element or disposed some distance from the mobile element, and adapted for operating in real or non-real time.
It is possible to produce a device in which said control means move with the mobile element or otherwise, and which processes the information in real time or otherwise.
According to another aspect of the invention, there is proposed a video game system comprising a visual or auditory indicator, such as a screen or a loudspeaker, for indicating at least one pace to be taken by the player, comprising at least one device such as described above.
It is thus possible to supervise the proper execution of the directive and, for example, to establish a score.
According to another aspect of the invention, there is proposed a jump analysis system, comprising at least one device such as described above.
It is thus possible to estimate the height, length, duration, quality of a jump.
According to another aspect of the invention, there is proposed an outdoor or indoor geolocation system, comprising at least one device such as described above.
This system is a low-cost system which may be supplemented with manual initialization (the user indicates where he is situated on a map) or with the aid of another geolocation system (GPS, UWB, etc.). In the latter case, the proposed system improves the performance of the other system or substitutes itself for it when it is no longer available (example GPS in buildings).
According to another aspect of the invention, there is proposed a system for calculating energy expenditure of a user, comprising at least one device such as described above.
This device affords significant information about the displacement of the foot. It is thus possible to integrate this information over the duration of the pace so as to obtain a fine evaluation of the energy expenditure which takes account of the height of the foot at each instant.
For example, the characteristic of the trajectory of the triaxial accelerometer comprises the velocity of the triaxial accelerometer, or the trajectory of the triaxial accelerometer.
According to another aspect of the invention, there is also proposed a method for determining a characteristic of a trajectory formed of successive positions of a triaxial accelerometer rigidly tied to a mobile element, between a first instant of immobility and a second instant of immobility of the triaxial accelerometer, subsequent to said first instant of immobility, by means furthermore of a triaxial additional sensor for measuring a vector of a substantially constant vector field between said first and second instants of immobility in a fixed global reference frame tied to the terrestrial reference frame, said additional sensor being rigidly tied to said mobile element and fixed in the reference frame of the accelerometer, said method comprising the following steps:
The invention will be better understood on studying a few modes of implementation described by way of wholly non-limiting examples and illustrated by the appended drawings in which:
In the set of figures, elements having the same labels are similar.
As illustrated in
Of course, as a variant, if the magnetometer is fixed in the reference frame of the accelerometer, the reference frames of the two sensors are tied by a switching matrix, and it suffices to carry out a further transformation in order to express coordinates of a reference frame of one of the sensors in the reference frame of the other sensor, so as to use the coordinates of the measurements of the sensors in one and the same reference frame.
A first determination module MD1 makes it possible, on the basis of the measurements transmitted by the triaxial accelerometer 3A and the triaxial magnetometer 3M, to determine a first instant of immobility t0 and a second instant of immobility tn of the triaxial accelerometer, subsequent to said first instant of immobility t0. When the mobile element EM is a foot, an instant of immobility corresponds to a grounding of the foot on the contact surface. The technique used by the first determination module MD1 may, for example, be that described in the document “Robust step detection method for pedestrian navigation systems” (D. H. Hwang, J. H. Jang, and J. W. Kim) published in Electronics Letters, 43(14), in July 2007, in which the authors seek to detect a base shape, corresponding to a typical signal for a pace, in the signal of the norm of the accelerometers. When this shape is detected, the start corresponds to the instant t0 and the end, to the instant tn.
The successive instants t0, t1, . . . tn are situated in time in a chronological manner between the first instant of immobility t0 and the second instant of immobility tn. The various successive instants t0, t1, . . . tn correspond to a digitization and to a sampling of the signals arising from the sensors, followed by a calibration to get back to the measured physical quantities.
A second determination module MD2 makes it possible to determine the plane [{right arrow over (u)}1,{right arrow over (u)}2] of said trajectory of the triaxial accelerometer 3A, on the basis of the vectors delivered by the triaxial accelerometer 3A, at the various successive instants t0, t1, . . . , tn, in a mobile reference frame LF tied to the triaxial accelerometer 3A and to the triaxial magnetometer 3M.
As a variant, as illustrated in
The plane [{right arrow over (u)}1,{right arrow over (u)}2] corresponds to the plane containing at the maximum the measurements, considered to be points or vectors in a three-dimensional space by considering the measurements transmitted for each axis of the triaxial accelerometer 3A, or respectively of the triaxial magnetometer, and the axis defined by the vector {right arrow over (u)}3 is the axis on which the projection of the measurements varies the least. The vector {right arrow over (u)}3 is the vector normal to the plane of the trajectory [{right arrow over (u)}1,{right arrow over (u)}2], but also the axis of rotation of the triaxial accelerometer 3A.
To determine these three vectors {right arrow over (u)}1,{right arrow over (u)}2,{right arrow over (u)}3, the second determination means form a matrix ALF with n+1 rows, n+1 being the number of samples taken between t0 and tn inclusive, and with 3 columns corresponding to the three measurements of the three axes x, y, z of the triaxial accelerometer 3A. We have:
As a variant, it is possible to take just a subset of the samples at the successive instants t0, t1, . . . tn.
Several modes of implementation are possible for determining the three vectors {right arrow over (u)}1,{right arrow over (u)}2,{right arrow over (u)}3, on the basis of the matrix ALF(=ALF(t0, . . . , tn)).
One mode of implementation consists in performing the singular-value decomposition SVD of the matrix ALF:ALF=USV. V is a matrix with three rows and three columns, each column of which corresponds to one of the three vectors {right arrow over (u)}1,{right arrow over (u)}2,{right arrow over (u)}3. The matrix S contains the three singular values s1, s2, s3. These three singular values s1, s2, s3, must be ranked in decreasing order. The vector {right arrow over (u)}3 is the column of the matrix V corresponding to the smallest singular value. The other two columns give the coordinates of the vectors forming the plane [{right arrow over (u)}1,{right arrow over (u)}2].
Another mode of implementation consists in decomposing the correlation matrix R=ALF τ ALF into three eigenvectors and eigenvalues (R=uτSu) and in ranking them by decreasing eigenvalues s1,s2,s3 so as to obtain the three vectors {right arrow over (u)}1,{right arrow over (u)}2,{right arrow over (u)}3. ALF τ corresponds to the matrix transpose of ALF . The two eigenvectors corresponding to the larger two eigenvalues correspond to the plane [{right arrow over (u)}1,{right arrow over (u)}2], the eigenvector {right arrow over (u)}3 is that corresponding to the smallest eigenvalue.
The control module CMD also comprises a first calculation module MC1 for calculating, at the successive instants t0, t1, . . . tn, orthogonal projections of the vector delivered by the triaxial accelerometer 3A and of the vector delivered by the triaxial magnetometer 3M in said mobile reference frame LF, on the plane of the trajectory [{right arrow over (u)}1,{right arrow over (u)}2] of the triaxial accelerometer 3A; the matrices of the projections are obtained:
A
p
LF(t0 . . . tn)=[A(t0 . . . tn)·u1, A(t0 . . . tn)·u2]
B
p
LF(t0 . . . tn)=[B(t0 . . . tn)·u1, A(t0 . . . tn)·u2]
The control module CMD comprises, furthermore, a third module MD3 for determining, at the successive instants t0, t1, . . . tn, the rotation for switching from the mobile reference frame LF to a fixed global reference frame GF, tied to the terrestrial reference frame, on the basis of the orthogonal projections of the vectors delivered by the triaxial magnetometer 3M. The third determination module MD3 advantageously determines an intermediate plane IF formed by the vectors bp(t), and bp⊥(t), bp(t) being the unit vector of the terrestrial magnetic field BLF(t) and bp⊥(t) being obtained by rotating the vector bp(t) by 90° in the plane of the trajectory or of the gait [{right arrow over (u)}1,{right arrow over (u)}2].
Thus, the third determination module computes the vectors of the intermediate reference frame IF:
A second calculation module MC2, of the control module CMD, performs the calculation, at the successive instants t0, t1, . . . , tn, of the orthogonal projection, provided by the first calculation module MC1, in the fixed global reference frame GF, of the vector delivered by the triaxial accelerometer 3A.
The second calculation module MC2 comprises a fifth calculation module MC5 for calculating switching in the intermediate reference frame IF, tied to the terrestrial reference frame:
Stated otherwise, ApLF(t0 . . . tn) is projected orthogonally in the plane of the trajectory [{right arrow over (u)}1,{right arrow over (u)}2] onto the vectors bp(t), and bp⊥(t) of the intermediate reference frame IF to obtain the accelerometer measurements projected onto the plane of the trajectory [{right arrow over (u)}1,{right arrow over (u)}2] and expressed in the intermediate reference frame IF:
A
IF(t)=[ApLF(t)·b(t) ApLF(t)·b⊥(t)]=[AbIF Ab
The third module MD3 for determining the rotation for switching from the mobile reference frame LF to the fixed global reference frame GF comprises a module MEST for estimating an angle α, said switching rotation being defined by an orthogonal projection onto the substantially constant terrestrial magnetic field between the two instants of immobility t0 and tn, followed by a rotation by the estimated angle α in the plane [{right arrow over (u)}1,{right arrow over (u)}2] of trajectory of the triaxial accelerometer 3A.
Stated otherwise, the estimation module MEST makes it possible to find the rotation α (characterized by a rotation matrix Mα) to be performed in order to switch from the intermediate reference frame IF {bp(t),bp⊥(t)} to the global reference frame GF in the walking plane defined by the vectors └{right arrow over (h)},{right arrow over (v)}┘, the third vector of the global reference frame GF being {right arrow over (u)}3.
In the case of pedestrian navigation, {right arrow over (h)} is the horizontal in the walking plane and {right arrow over (v)} the vertical.
To determine α, several modes of implementation of the estimation module MEST are possible.
A first mode of implementation can consist, knowing the slope θ between the two grounding points of the foot at the instants t0 and tn with respect to the horizontal, in estimating α through the following equation:
This slope θ may be estimated by virtue of the inclination of the sensors on the foot when it is grounded, at t0 or tn, by considering that the slope is constant for the duration of the pace, or with the aid of a stored mapping delivering as output the slope of the contact surface of the place where the person (the mobile element EM) is situated.
In another mode of implementation, by admitting that the largest variance of the acceleration is applied along the displacement of the foot, the singular-value decomposition or SVD of the acceleration matrix AIF determines the matrix Mα, the singular vector corresponding to the largest singular value corresponds to the vector {right arrow over (h)}.
The singular-value decomposition may be written: AIF=USV where V is the matrix Mα
This assumption is valid only in the case of large paces for which the horizontal displacement is larger than the vertical displacement on flat ground, of zero slope. If the slope is not zero, it is possible to use this scheme but {right arrow over (h)} will not be the horizontal but the vector joining the position of the sensor at the first instant of immobility t0 to its position at the second instant of immobility tn.
Another mode of implementation can also be envisaged, starting from the fact that at the instants t0 and tn the foot is resting, the vertical is along the acceleration measured at this instant by the triaxial accelerometer 3A and α is the angle between {right arrow over (A)}pLF(t0) and {right arrow over (B)}pLF(t0), or between {right arrow over (A)}pLF(tn) and {right arrow over (B)}pLF(tn).
The second calculation module MC2 also comprises a multiplier for protecting the measurements Ap into the global reference frame:
The control module CMD comprises, furthermore, a third calculation module MC3 for subtracting from the vector delivered by said second calculation means MC2 at said successive instants t0, t1, . . . tn, the mean vector over said successive instants, so as to obtain the accelerations centered in the plane [{right arrow over (u)}1,{right arrow over (u)}2] of the trajectory of the triaxial accelerometer 3A, devoid of the influence of terrestrial gravity and of drifts of the device, in the fixed global reference frame GF. The third calculation module carries out the following calculations of contractions of the horizontal and vertical averages:
The control module CMD also comprises a fourth module MC4 for calculating a characteristic of the trajectory of the triaxial accelerometer of the 3A on the basis of centered accelerations, for example by double temporal integration of the centered accelerations delivered by the third calculation module MC3, so as to obtain, in this instance, the trajectory, expressed in the fixed global reference frame GF, of the triaxial accelerometer 3A, that is to say of the foot of the user, in the plane of the trajectory of the foot during a pace, between the first grounding and the second grounding, or instants of immobility, t0 and tn.
The fourth calculation module MC4 makes it possible to integrate the acceleration twice with respect to time, so as to calculate the trajectory of the foot, or more precisely of the accelerometer tied to the foot, in the plane of the trajectory or of walking. The numerical integration may be carried out by employing the following relations, using integration by the method of rectangles:
in which {right arrow over (v)}(t0)=[0 0] and {right arrow over (x)}(t0)=[0 0]
In which Fe is the sampling frequency expressed in Hz, and the components of the matrix {right arrow over (A)}cGF are expressed in m/s2. {right arrow over (v)} and {right arrow over (x)} are respectively the velocity and position vectors along the two axes of the global reference frame {h,v}.
As a variant, the fourth calculation module MC4 can employ double integration by more complex modes of numerical calculation, for examples by using Splines.
As a variant, the fourth calculation module MC4 can perform single integration to get back to the velocity.
The control module CMD can comprise a first module MEL1 for computing a direction vector, adapted for linking the respective positions, expressed in said fixed global reference frame GF, of the triaxial accelerometer 3A with the first instant of immobility t0 and with the second instant of immobility tn.
The control module CMD can also comprise a second module MEL2 for computing a displacement heading with respect to said vector field measured by the additional sensor, in this instance with respect to the terrestrial magnetic field measured by the triaxial magnetometer 3M. The second computation module MEL2 can compute the heading in the following manner.
The heading of the displacement is defined as the angle between the terrestrial magnetic North pole and the direction of the displacement. It must not be confused with the heading of the person, which is his orientation with respect to North. It is often the latter which is estimated in the literature. The heading of the person is often assumed to be the same as that of the displacement. Now, this is the case only in the case of walking forward but not when walking backward, sideways, or slightly askew. Hence, the second computation module MEL2 estimates the heading of the displacement and more generally the trajectory in the NED (North,East,Down) reference frame as follows.
In the foregoing, the trajectory is estimated in a plane └{right arrow over (h)},{right arrow over (v)}┘ corresponding to the plane of the trajectory of the foot. The third vector {right arrow over (u)}3, which makes it possible to form a reference frame {{right arrow over (h)},{right arrow over (v)},{right arrow over (u)}3} with three dimensions corresponding respectively to the horizontal in the plane of walking, to the vertical in the plane of walking and to a vector normal to the plane of walking, which is also assumed horizontal.
To calculate the heading, the following calculation is performed:
B
GF
=B
h
+B
v
+B
u3
in which:
The component Bu3 must be substantially invariant as a function of time, thus amounting to making the assumption of walking in a plane and more generally of a rotation about a substantially invariant axis and that the terrestrial magnetic field B is not disturbed. As this is generally not the case in practice, the second computation module can take the temporal average over the pace (between the instants of immobility t0 and tn) as estimation of this component.
To determine the heading Bh and Bu3 alone are useful. Indeterminacies in the sign of the vectors {right arrow over (h)} and {right arrow over (u)}3 still remain. Indeed, such as they were defined hereinabove, {right arrow over (h)} may be in the opposite direction to the direction of the displacement and {right arrow over (v)} may be directed upward or downward.
The second computation module MEL2 constructs a reference frame {{right arrow over (p)}1,{right arrow over (p)}2,{right arrow over (p)}3} such that:
The vectors {right arrow over (p)}1,{right arrow over (p)}2,{right arrow over (p)}3 are determined as follows;
The angle φ between the direction of the displacement {right arrow over (p)}1 and magnetic North in the {North, East} reference frame may be obtained by inverting the following formulae:
The control module CMD can also comprise a third module MEL3 for computing the distance traveled between the first and second instants of immobility t0 and tn, i.e. a pace, and/or during a set of successive time intervals separating two successive instants of immobility t0 and tn of the triaxial accelerometer, i.e. a succession of paces, on the basis of the data provided by the fourth calculation module.
For example the horizontal distance traveled during a pace is given by:
d
h(t0,tn)=xh(tn)−xh(t0)
for a series of paces, the distance traveled is given by the sum of the distances calculated for each pace.
The control module CMD can also comprise a fourth module MEL4 for computing a trajectory during a set of successive time intervals separating two successive instants of immobility t0 and tn of the triaxial accelerometer 3A, in this instance during a set of successive paces, on the basis of the data provided by the fourth calculation module. For example, by means of the same formulae as those used by the second computation module MEL2, or directly on the basis of the results of the second computation module MEL2 if the device comprises them. The displacement in the corresponding horizontal plane is given by xh(t).
The displacement along the axis directed toward North is given by the following relation:
The displacement along the axis directed toward East is given by the following relation:
The down displacement is given by the following relation:
The estimated trajectory in the horizontal plane (xN(t), xE(t)) for a series of paces is thus obtained.
It is also possible to estimate the displacement in any global reference frame GF for which the rotation matrix making it possible to switch from the NED reference frame to the desired reference frame is known. For example, when a person is in front of his games console. It is possible for an acquisition of the measurements to be effected when the person is stationary and facing his screen. The heading of the person which is calculated serves as reference for the orientation of his virtual depiction.
As a variant, the consideration of the two successive instants of immobility may be replaced with the consideration of two successive instants for which the velocity vectors in the plane of the trajectory are known, as well as of the angle α at these two instants, it being possible for these data to be measured by additional sensors or estimated on the basis of measurements provided by additional sensors. In such a case, the fourth calculation module must initialize the velocity with the velocity of the first instant and add a constant dependent on the velocities of the two instants to the centered acceleration.
In the more general case of a rotation about a substantially invariant axis, the second determination module MD2 estimates the axis of rotation by using the triaxial additional sensor, the first calculation module MC1 also performs a projection along the vector u3. Furthermore, the third calculation module MC3 calculates the centered acceleration along the vector u3, and the fourth calculation module MC4 integrates the latter centered acceleration, once to obtain the velocity, or twice for the position.
The present invention makes it possible, at reduced cost, to determine a planar trajectory of a triaxial accelerometer tied to a mobile element, notably a foot, in an accurate manner and at reduced cost. The mobile element may be another part of the human body, such as a hand, a part of an animal body, or a part of an artificial body such as a robot or a computer mouse.
Number | Date | Country | Kind |
---|---|---|---|
0857181 | Oct 2008 | FR | national |
This application is a national phase application under §371 of PCT/EP2009/063741, filed Oct. 20, 2009, which claims priority to French Patent Application No. 0857181, filed Oct. 22, 2008, the entire content of which is expressly incorporated herein by reference.
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/EP2009/063741 | 10/20/2009 | WO | 00 | 7/18/2011 |