Patent Document

CROSS-REFERENCE TO RELATED APPLICATIONS 
       [0001]    This application is the National Stage of International Application No. PCT/EP2013/054563, filed on Mar. 7, 2013, which claims the benefit of French Application No. 1252101, filed Mar. 8, 2012. The contents of all of these applications are incorporated herein by reference. 
     
    
     BACKGROUND 
       [0002]    1. Technical Field 
         [0003]    Various embodiments relate to a method of identifying geometric parameters of an articulated structure and of an assembly of reference frames of interest disposed on said structure, with the aid of a tailored system of measurements. 
         [0004]    The information evaluated can be the following:
       The positions and orientations of the reference frames of interest with respect to the structure;   The biomechanical parameters of the articulated structure (for example the lengths of the segments).       
 
         [0007]    Various embodiments of the invention are applicable, for example, without this list being limiting, to the following functions:
       Accurately characterizing a system of measurements applied to the articulated structure. The reference frames of interest are then those of the measurement devices which instrument the structure.   Measuring the kinetic parameters of a solid structure (articulated or not). The reference frames of interest are generally the points where one is interested in the kinetic parameters.   Capturing the motion of an articulated body (sectors of medicine, animation cinema, sport or else video games, research in biomechanical analysis, in robotics, etc.).       
 
         [0011]    2. Description of the Related Art 
         [0012]    The fields of application in which articulated structures are used are expanding. It is possible to cite, for example, robotics and human or animal biomechanics. In these sectors, two types of information are of importance:
       The geometry of the articulated structure; and   The position and the orientation of an assembly of reference frames of interest (where for example temperature measurements, kinetic measurements, etc. have been made available).       
 
       SUMMARY OF THE INVENTION 
       [0015]    Various embodiments propose to treat these two problem areas jointly without resorting to the methods of the prior art, which principally consist in directly measuring the lengths of the segments of the articulated structure (for example, with the aid of a tape measure or with the aid of a complex optical system, etc.), in taking into account a morphological model making it possible to simulate the dynamics of said articulated structure and in locating the reference frames of interest on the segments also by direct measurement of their position and orientation. 
         [0016]    Various embodiment methods include associating a system of measurements distributed over said structure, said system comprising sensors fixed securely to the segment of said structure at the site of the points of the reference frames of interest so as to extract therefrom the desired information described hereinabove. 
         [0017]    Hereinafter in the document, we will illustrate embodiments of the invention principally in an exemplary application in which:
       The articulated structure is biomechanical and it is desired to evaluate the length of its segments;   A motion measurements system is disposed on the articulated structure and it is desired to identify their position and orientation, the previously defined reference frames of interest are those of each measurement element of the system; this system serves at one and the same time for the measurement of the motion and for the identification of the geometric parameters making it possible to characterize the segments of the structure and the position of reference frames of interest with respect to them;   Said measurements system comprises at least one accelerometer.       
 
         [0021]    For this purpose, various embodiment methods of determining the position of an assembly of sensors in a reference frame tied to a segment of an articulated chain are disclosed, in which the assembly of sensors comprises at least one accelerometer and is secured to said articulated chain, the method comprising: a first step of determining an orientation of a reference frame tied to the assembly of sensors with respect to the reference frame tied to said segment for at least one chosen configuration of said articulated chain; a second step of estimating a motion of said reference frame tied to the assembly of sensors in a terrestrial reference frame in the course of at least one motion of said segment; a third step of calculating said position of said assembly of sensors in the reference frame tied to said segment, said third step receiving as input the estimation of the motion of said reference frame tied to the sensor as output by the second step and the measurements of said accelerometer in the course of said at least one motion. 
         [0022]    Advantageously, the first step comprises a first sub-step of calculating a first switching matrix for passing from said reference frame tied to the assembly of sensors to a reference frame tied to the earth and a second sub-step of calculating a second switching matrix for passing from said reference frame tied to the earth to a reference frame tied to said segment. 
         [0023]    Advantageously, the first calculation sub-step uses at least one measurement of at least one second sensor of said assembly of sensors, said second sensor being able to provide measurements of at least one physical field which is substantially uniform over time and in space or of rotation speed. 
         [0024]    Advantageously, the first calculation step furthermore comprises a calculation sub-step prior to said first sub-step in the course of which a third switching matrix for passing between a reference frame in motion and said reference frame tied to the earth is calculated, said third switching matrix being either chosen or determined on the basis of measurements of at least one physical field which is substantially uniform over time and in space or of the measurements of the rotation speed of said reference frame in motion with respect to said reference frame tied to the earth. 
         [0025]    Advantageously, the first step is performed for at least two configurations of said articulated chain. 
         [0026]    Advantageously, prior to the first step, a first sub-step of determining a substantially invariant axis of rotation of said segment is carried out. 
         [0027]    Advantageously, the second step uses the outputs of at least one sensor chosen from the group comprising the accelerometer and a second sensor of said assembly of sensors, said second sensor being able to provide measurements of at least one physical field which is substantially uniform over time and in space or of rotation speed. 
         [0028]    Advantageously, in the course of the second step, said at least one motion of the segment is a rotation around a substantially invariant axis. 
         [0029]    Advantageously, in the course of at least the second and third steps, use is made of a predictive model of the outputs of the accelerometer chosen as a function of the type of the motion of said segment and the position is calculated of said assembly of sensors on said segment as output by an algorithm minimizing the errors between measured values and predicted values. 
         [0030]    Advantageously, said articulated chain comprises at least N segments, N being greater than or equal to two. 
         [0031]    Advantageously, a specific embodiment method further comprises a step in the course of which the length of at least one segment of said articulated chain is calculated. 
         [0032]    Advantageously, the calculation of a segment i inserted into an articulated chain comprising j segments, j being greater than 1 and than i, is performed by solving the equation Mat_tot mvt *PosLong=Acc basis-free (t initial →t final ) in which:
       Mat_tot mvt  is a matrix of dimension (i, j) whose coefficients are calculated by       
 
         [0000]    
       
         
           
             
                 
             
              
             
               
                 
                   
                     Mat 
                     mvt 
                   
                    
                   
                     ( 
                     
                       t 
                       , 
                       
                         sensor 
                          
                         
                             
                         
                          
                         j 
                       
                       , 
                       
                         sensor 
                          
                         
                             
                         
                          
                         i 
                       
                     
                     ) 
                   
                 
                 = 
                 
                   [ 
                   
                     - 
                     
                       
                         ( 
                         
                           
                             ∂ 
                             
                               ? 
                             
                           
                           
                             ∂ 
                             
                               t 
                               2 
                             
                           
                         
                         ) 
                       
                       
                         
                           
                             
                               reference 
                                
                               
                                   
                               
                                
                               frame 
                             
                           
                         
                         
                           
                             
                               sensor 
                                
                               
                                   
                               
                                
                               j 
                             
                           
                         
                       
                     
                   
                   ] 
                 
               
               , 
               
                 
 
               
                
               
                   
               
                
               
                 PosLong 
                 = 
                 
                   [ 
                   
                     
                       
                         
                           ? 
                         
                       
                     
                     
                       
                         
                           Position 
                            
                           
                               
                           
                            
                           
                             origin 
                             
                               segment 
                                
                               
                                   
                               
                                
                               2 
                             
                           
                         
                       
                     
                     
                       
                         
                           Position 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             2 
                           
                         
                       
                     
                     
                       
                         ⋮ 
                       
                     
                     
                       
                         
                           Position 
                            
                           
                               
                           
                            
                           
                             origin 
                             
                               segment 
                                
                               
                                   
                               
                                
                               N 
                             
                           
                         
                       
                     
                     
                       
                         
                           Position 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                         
                       
                     
                   
                   ] 
                 
               
             
           
         
       
       
         
           
             
                 
             
              
             
               PosLong 
                
               
                   
               
                
               is 
                
               
                   
               
                
               the 
                
               
                   
               
                
               vector 
             
           
         
       
       
         
           
             
               ? 
             
              
             
               indicates text missing or illegible when filed 
             
           
         
       
       
         
           
             The basis-free acceleration at the instant t is calculated by the formula 
           
         
       
     
         [0000]    
       
         
           
             
               
                 Acc 
                 
                   basis 
                   - 
                   free 
                 
               
                
               
                 ( 
                 t 
                 ) 
               
             
             = 
             
               
                 
                   Meas 
                   Acc 
                 
                  
                 
                   ( 
                   t 
                   ) 
                 
               
               - 
               
                 G 
                  
                 
                     
                 
                  
                 
                   0 
                   
                     
                       
                         
                           reference 
                            
                           
                               
                           
                            
                           frame 
                         
                       
                     
                     
                       
                         sensor 
                       
                     
                   
                 
               
               + 
               
                 Acc 
                 
                   assembly 
                   referenceframesensor 
                 
               
             
           
         
       
     
         [0035]    Advantageously, said articulated chain is a part of a human body or of a humanoid structure. 
         [0036]    Advantageously, the configurations of said articulated chain are determined by execution of at least N predefined successive gestures, each gesture enabling only a rotation of all or some of the segments of said chain in a unique plane about a unique axis passing through an articulation linking two segments, the segments other than the two stated segments remaining aligned during said rotation, in such a way that rotations of segments are executed about at least N distinct axes. 
         [0037]    Advantageously, N is greater than or equal to 3, a first segment corresponding to a shoulder, a second segment corresponding to an arm linked to the shoulder and a third segment corresponding to a forearm linked to the arm by an elbow, the execution of predefined gestures including, in this order: a rotation of the entire body about a vertical axis ( 105 ) that may be regarded as the axis of the body, the shoulder-arm-forearm assembly being held outstretched in a horizontal plane during the rotation of the body about said axis, and; a rotation of the arm-forearm assembly about a horizontal axis ( 205 ) passing through the articulation linking the shoulder to the arm, the arm-forearm assembly being held outstretched during said rotation, and; a rotation of the forearm about a horizontal axis ( 305 ) passing through the elbow linking the arm to the forearm, the shoulder-arm assembly being held outstretched during said rotation. 
         [0038]    Advantageously, each rotation of segments is executed about an axis passing through an articulation. 
         [0039]    Various embodiments also disclose a system for determining the position of an assembly of sensors in a reference frame tied to a segment of an articulated chain, said assembly of sensors comprising at least one accelerometer and being secured to said articulated chain, said system comprising a first module for determining an orientation of a reference frame tied to the assembly of sensors to said reference frame tied to said segment for at least one configuration of said articulated chain; a second module for estimating a motion of said reference frame tied to the assembly of sensors in a terrestrial reference frame in the course of at least one motion of said segment; a third module for calculating said position of said assembly of sensors in the reference frame tied to said segment, said third module receiving as input the estimation of the motion of said reference frame tied to the sensor as output by the second module and the measurements of said accelerometer in the course of said at least one motion. 
         [0040]    The principal advantage of certain embodiments is that of identifying, in an accurate, automatic, fast and practical manner, critical geometric parameters of an articulated structure and of a plurality of reference frames of interest. In some of its embodiments, the invention is particularly advantageous since it expresses the estimation of said parameters in the form of a linear least squares problem, the calculation of the estimate is therefore explicit and optimal. 
     
    
     
       BRIEF DESCRIPTION OF THE DRAWINGS 
         [0041]    Other characteristics and advantages of the invention will become apparent with the aid of the description which follows offered with regard to the following figures which illustrate examples of implementation of the method according to certain non-limiting embodiments of the present invention: 
           [0042]      FIG. 1  specifies the reference frames used in the description of the present invention; 
           [0043]      FIG. 2  represents a general flowchart of the processing operations in several embodiments of the invention; 
           [0044]      FIGS. 3   a  to  3   e  represent alternative variants of the invention in several of its embodiments; 
           [0045]      FIG. 4  illustrates the articulated structure (human being in the figure) equipped with an assembly of devices and with the associated system of measurements which will make it possible to identify the geometric parameters of the structure and devices whose reference frames are the reference frames of interest; 
           [0046]      FIG. 5  illustrates a first motion of a human being wearing sensors of a measurement system whose reference frames are the reference frames of interest, in an embodiment of the invention; 
           [0047]      FIG. 6  illustrates a second motion of a human being wearing sensors of a measurement system whose reference frames are the reference frames of interest, in an embodiment of the invention; and 
           [0048]      FIG. 7  illustrates a third motion of a human being wearing sensors of a measurement system whose reference frames are the reference frames of interest, in an embodiment of the invention. 
       
    
    
     DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 
       [0049]    An articulated structure is composed of at least one first segment which can be mobile in space. The following segments are attached one following the other in the form of a tree possibly comprising several branches. 
         [0050]    The system of measurements comprises sensors, disposed on the segments of the articulated structure, whose reference frames are the reference frames of interest. 
         [0051]    Various embodiments are aimed at a method utilizing:
       Means for measuring the orientation of the reference frames of interest, sensors of the system of measurements or segments,   The sensors worn of the system of measurements comprising at least one accelerometer,   Gestures to be performed;
 
so as to extract therefrom:
   The position and the orientation of the reference frames of interest on each segment,   If appropriate, the length of each segment.       
 
         [0057]      FIG. 1  specifies the reference frames used in a description of specific embodiments. 
         [0000]    R D  is the reference frame of interest,  101 . The sensors making it possible to perform the measurements will be placed on the reference frame of interest, at least for the time of the measurement. In the subsequent description, the expressions “reference frame of interest” or “reference frame tied to the assembly of sensors” will be used alternatively to designate the reference  101 .
 
R s  is the reference frame tied to the segment,  102 .
 
R g  is the reference frame tied to the center of gravity of the body,  103 .
 
R T  is the fixed reference frame,  104 . The fixed reference frame is for example tied to the Earth.
 
         [0058]      FIG. 2  represents a general flowchart of the processing operations in several embodiments of the invention. 
         [0059]    This entails determining the parameters which characterize the position and the orientation of the reference frames of interest with respect to the segments which constitute the branches of the articulated structure. 
         [0060]    Accordingly, it is desirable firstly to determine the orientation of the reference frame tied to the assembly of sensors (or reference frame of interest),  101  with respect to the reference frame of the segment  102 . This orientation can be a directly accessible data item or it can be determined in one or more configurations of the articulated structure, as illustrated further on in the description. 
         [0061]    The articulated structure is also made to perform at least one more or less simple motion, so as to obtain measurements of the parameters of orientation and of position of the reference frame tied to the assembly of sensors employed, so as to solve the equation for the motions which are performed and to deduce therefrom the estimation of the parameters which characterize the position of the assembly of sensors in the reference frame of the segment. 
         [0062]    Thus, according to an embodiment of the invention, in the course of a first step  201 ,  202 , one may fix the orientation of the sensor assembly directly in the reference frame of the segment  103 , or one may determine the orientation of the assembly of sensors (for example the references  401 ,  401   a ,  402 ,  402   a ,  403 ,  403   a  of  FIG. 4 ) in the reference frame the fixed reference frame,  104 , by making the articulated structure take one or more configurations, which make it possible to determine said orientation, and therefore a switching matrix for passing between the reference frame  101  and the reference frame  104 , and then a switching matrix for passing from the reference frame  104  to the reference frame  102  is determined. 
         [0063]    Thereafter, in an embodiment, in the course of a step  203 , the articulated structure is made to perform at least one motion for which it is possible to determine a predictive model of the measurements of the sensors belonging to the assembly of sensors  401 ,  401   a ,  402 ,  402   a ,  403 ,  403   a.    
         [0064]    Alternative variants for carrying out steps  201  and  203  are illustrated in the subsequent description. 
         [0065]    In  FIG. 3   a  is represented the flowchart of the processing operations of  FIG. 2  in a first embodiment. 
         [0066]    The assembly of sensors (references  401 ,  401   a ,  402 ,  402   a ,  403 ,  403   a  of  FIG. 4 ) comprises a means for measuring the orientation Mat RD     →     RT  of the reference frames of interest  101  with respect to the fixed reference frame tied to the Earth (R T ,  104 ). Various sensors are capable of providing measurements with respect to fields that are substantially invariant over time and in space (gravity, the terrestrial magnetic field) or else with respect to a fixed reference in the reference frame  104 , such as magnetic, optical, acoustic or radiofrequency sensors positioned in the assembly of sensors or on a fixed base in conjunction with a fixed base with respect to the reference frame  104  or with sensors positioned in the assembly of sensors. For example, gyrometers are capable of providing this information. Magnetometers are also capable of playing this role, as are optical, acoustic or radiofrequency means. 
         [0067]    In this case, the first step  201 ,  202  which makes it possible to identify the target matrix Mat RD     →     RS  includes adopting postures or poses that are predefined and therefore, known in the guise of Mat RD     →     RT  and therefore, by transitivity of the rotation matrices the matrix Mat RD     →     RS : 
         [0000]      Mat RD     →     RS =Mat RD     →     RT ×(Mat RS     →     RT ) −1  
 
         [0068]    The second step  203  includes performing gestures and in analyzing the accelerometric measurement by utilizing the knowledge of Mat RD     →     RT  and Mat RD     →     RS  so as to estimate the parameters of lengths and distances, by applying the composition law for motions which links the accelerations of the various points concerned. 
         [0069]    The third step  204  of estimating the parameters for the position of the assembly of sensors on the segment is explained further on in the description. 
         [0070]    Certain particular cases, illustrated by the flowchart of the processing operations of  FIG. 3   b , suggest the addition of constraints on the type of motions. For example, employing magnetometers as means for measuring the orientations may constrain the gestures to comply with a substantially invariant axis of rotation. A so-called “U constant” algorithm is then used to solve the equations for the motions as explained further on in the description. Such an algorithm is disclosed in application EP1985233 belonging to the applicants of the present application, which is incorporated herein by reference. The configurations and motions which the articulated structure is to be made to perform are illustrated in the embodiments described as commentary to  FIGS. 5 ,  6  and  7 . 
         [0071]      FIG. 3   c  represents the flowchart of the processing operations of a 2 nd  embodiment in which a means is available for measuring the orientation Mat RD     →     R′ , R′ being an arbitrary reference frame whose motion in the fixed reference frame R T  is known or that it is possible to fix. This allows us to return to the previous case for steps  203  and  204 . For example, a system of directional antennas worn on the one hand at the level of the center of mass (R′), and on the other hand at the level of the reference frames of interest, makes it possible to follow the motions of the reference frame R′ with respect to the reference frame of the earth,  104 . 
         [0072]      FIG. 3   d  represents the flowchart of the processing operations of a 3 rd  embodiment in which the orientation of the reference frame  101  in the reference frame  102  is already available, where a means of measuring said orientation is available. A matrix Mat RD     →     RS  is then determined which makes it possible to pass directly from the reference frame of interest to the reference frame of the segment, thereby carrying out the first step  201 ,  202  of the method of the invention. For example, it is possible to use the means cited in patent application EP1985233 belonging to the applicants of the present application, already cited. These means may comprise just an accelerometer or, in fact the same sensors as those of the system of measurements of embodiments of the invention. According to various embodiments, at least two substantially invariant axes of rotation of the segment instrumented with the sensor or sensors are determined. The rotation motions are determined as substantially invariant with respect to one or more thresholds chosen by the user of the system. 
         [0073]    The second step  203  includes performing protocol motions, for which it is desirable to impose the trajectory of all the equipped segments (X,Y,Z) independently of time or of the execution speed profile. The accelerometric data item measured in the course of time during this gesture is then compared elastically (elastic deformation of time) with the expected measurement model tied to the predefined trajectory for example by an error minimization operation or likelihood ratio maximization operation whose variables are the parameters sought. 
         [0074]    The third step  204  (which may, if appropriate, be simultaneous with step  203 ) of estimating the parameters for the position of the assembly of sensors on the segment is explained further on in the description. 
         [0075]      FIG. 3   e  represents a flowchart of the processing operations of a 4 th  embodiment of the invention in which a means is available for measuring the orientation Mat RS     →     RT  of the segment in the fixed reference frame tied to the Earth,  103 . The same means as those used in the embodiment of  FIG. 3   a  may be suitable, for example, optical systems, ultrasound systems or any other system which has a fixed base in the reference frame tied to the Earth. 
         [0076]    The first step  201 ,  202  includes performing protocol motions, with substantially invariant axis of rotation, so that with the aid of a measurement system comprising at least one accelerometer, it is possible to identify the rotation matrix Mat RD     →     RT  and thus return to the first case hereinabove. 
         [0077]    The third step  204  of estimating the parameters for the position of the assembly of sensors on the segment is explained further on in the description. 
         [0078]      FIG. 4  illustrates a particular case where the articulated structure ( 400 ) is a human being who is equipped on a part only of their body: left shoulder and arm. The shoulder as well as the arm and the forearm are equipped respectively with the devices ( 401   a ,  402   b ,  403   b ) and, at the same locations the sensors of said system of measurements ( 401 ,  402 ,  403 ). 
         [0079]      FIG. 5  illustrates a first motion of a human being wearing sensors ( 401 ,  402 ,  403 ) of a measurement system, in an embodiment of the invention. In this embodiment, the assembly of devices represented in  FIG. 4  and the system of measurements are merged and consist of sensors which associate accelerometers and magnetometers (Embodiment illustrated in  FIG. 3   b ). 
         [0080]    This exemplary implementation of the invention makes it possible to calibrate an assembly of three sensors  401 ,  402  and  403  tied to three segments, namely the shoulder of a person, to which the sensor  401  is attached, the arm of the person, to which the sensor  402  is attached, and finally the forearm of the person, to which the sensor  403  is attached. For the present exemplary embodiment of the invention, the applicants have used sensors  401 ,  402  and  403  marketed by one of the applicants under the commercial name MotionPod and which each combine a three-axis accelerometer with a three-axis magnetometer. Each of the sensors  401 ,  402  and  403  transmits its data via a radio link to a box commonly called a Motion Controller, this box being linked to a computer by a USB link. The box and the computer are not represented in the figure. The data are utilizable on the computer by virtue of a programming interface marketed by the applicants under the commercial name Smart Motion Development Kit (SMDK). The SMDK programming interface makes it possible either to obtain raw and calibrated measurements of a MotionPod, or to obtain an estimation of the orientation of a MotionPod. 
         [0081]    Hereinafter, the terms sensor, or MotionPod will be used interchangeably to designate the elements  401 ,  402  and  403  represented in  FIGS. 4 ,  5 ,  6  and  7 . 
         [0082]    Prior to the use of the system thus including the sensors  401 ,  402  and  403 , for example to capture the motions of the assembly with three segments shoulder-arm-forearm of the person, it is desirable to evaluate the change of reference frame between the reference frame of the solid that constitutes each segment and the reference frame of the sensor attached to said segment. Thus, it is desirable to evaluate the change of reference frame between the reference frame of the shoulder and the sensor  401 , the change of reference frame between the reference frame of the arm and the sensor  402 , as well as the change of reference frame between the reference frame of the forearm and the sensor  403 . It is also desirable to evaluate the changes of reference frame between the various segments. This is an object of the method of identifying the geometric parameters according various embodiments of the invention. In the present exemplary embodiment, this entails firstly evaluating the orientation of each of the sensors  401 ,  402  and  403  with respect to the segment to which said sensor is attached by using the means for measuring the orientation and optionally protocol gestures (see the various embodiments described hereinabove as commentary to  FIGS. 3   a  to  3   e ). Thereafter it entails evaluating the position of each of the sensors  401 ,  402  and  403  with respect to the segment to which said sensor is attached in the form of a position vector. It also entails evaluating the length of each of the three segments in the form of a length vector. It should be noted that the position of the sensors could be measured with a rule, but the estimation obtained may turn out to be too coarse; furthermore, only the component, referenced X in  FIGS. 5 ,  6  and  7 , along the length of each of the segments can actually be evaluated by this manual procedure. 
         [0083]    The method of identifying the geometric parameters according to various embodiments of the invention comprises a step of evaluating the orientation of the sensors. In this exemplary embodiment ( FIGS. 5 ,  6 ,  7 ), this entails notably giving the body a series of predefined static postures and comparing the actual measurements with theoretical values, so as to determine the orientation parameters. The larger the series, the better the accuracy. A single measurement is sufficient if the magnetic field is known perfectly and if the orientation of the segment is determined exactly, but this is not the case in human motions. 
         [0084]    Thus, for example, the body is firstly placed in a posture termed “posture 1” which corresponds to the reference posture, that is to say with all the angles at 0. Next it is rotated (for example) 90° clockwise, to attain the posture termed “posture 2”. It is then known that the sensors  401 ,  402  and  403  measure (the equations being valid for all these sensors): 
         [0000]    
       
         
           
             
               ? 
             
             = 
             
               R_orientation 
               * 
               G 
                
               
                   
               
                
               0 
             
           
         
       
       
         
           
             
               ? 
             
             = 
             
               R_orientation 
               * 
               H 
                
               
                   
               
                
               0 
             
           
         
       
       
         
           
             
                 
             
              
             
               
                 MeasureAccelero 
                 
                   Posture 
                    
                   
                       
                   
                    
                   2 
                 
               
               = 
               
                 R_orientation 
                 * 
                 
                   [ 
                   
                     
                       
                         0 
                       
                       
                         
                           - 
                           1 
                         
                       
                       
                         0 
                       
                     
                     
                       
                         1 
                       
                       
                         0 
                       
                       
                         0 
                       
                     
                     
                       
                         0 
                       
                       
                         0 
                       
                       
                         1 
                       
                     
                   
                   ] 
                 
                 * 
                 G 
                  
                 
                     
                 
                  
                 0 
               
             
           
         
       
       
         
           
             
                 
             
              
             
               
                 MeasureMagneto 
                 
                   Posture 
                    
                   
                       
                   
                    
                   2 
                 
               
               = 
               
                 R_orientation 
                 * 
                 
                   [ 
                   
                     
                       
                         0 
                       
                       
                         
                           - 
                           1 
                         
                       
                       
                         0 
                       
                     
                     
                       
                         1 
                       
                       
                         0 
                       
                       
                         0 
                       
                     
                     
                       
                         0 
                       
                       
                         0 
                       
                       
                         1 
                       
                     
                   
                   ] 
                 
                 * 
                 H 
                  
                 
                     
                 
                  
                 0 
               
             
           
         
       
       
         
           
             
               ? 
             
              
             
               indicates text missing or illegible when filed 
             
           
         
       
     
         [0085]    Where:
       MeasureAccelero Posture k  designates a measurement taken by the accelerometer when the body occupies the posture kε{1,2};   MeasureMagneto Posture k  designates a measurement taken by the magnetometer when the body occupies the posture kε{1,2};   {right arrow over (G)} a designates the terrestrial gravitational field;   {right arrow over (H)} designates the terrestrial magnetic field;   (GH) designates the angle between {right arrow over (G)} and {right arrow over (H)};       
 
         [0000]    
       
         
           
             
               G 
                
               
                   
               
                
               0 
             
             = 
             
               [ 
               
                 
                   
                     0 
                   
                 
                 
                   
                     0 
                   
                 
                 
                   
                     1 
                   
                 
               
               ] 
             
           
         
       
       
         
           and 
         
       
       
         
           
             
               H 
                
               
                   
               
                
               0 
             
             = 
             
               [ 
               
                 
                   
                     
                       sin 
                        
                       
                         ( 
                         GH 
                         ) 
                       
                     
                   
                 
                 
                   
                     0 
                   
                 
                 
                   
                     
                       cos 
                        
                       
                         ( 
                         GH 
                         ) 
                       
                     
                   
                 
               
               ] 
             
           
         
       
     
         [0000]    respectively designate the values of the fields {right arrow over (G)} and {right arrow over (H)} in a given initial position and measured in the reference frame of the sensor;
       R_orientation designates the rotation matrix to be identified.       
 
         [0092]    Indeed, by convention the Z axis is vertical and is oriented downwards. Several quantities may be determined: the orientation matrix R_orientation and the values of sin(GH) and cos(GH). Accordingly, the following calculations can be performed: 
         [0000]    
       
         
           
             
               
                 
                   
                       
                   
                    
                   
                     
                       
                         
                           
                             
                               
                                 
                                   
                                     
                                       
                                         
                                           ? 
                                         
                                         = 
                                         
                                           
                                             ? 
                                           
                                           
                                              
                                             
                                               ? 
                                             
                                              
                                           
                                         
                                       
                                     
                                   
                                   
                                     
                                       
                                         
                                           MeasureAccelero 
                                           
                                             Posture 
                                              
                                             
                                                 
                                             
                                              
                                             2 
                                           
                                         
                                         = 
                                         
                                           
                                             MeasureAccelero 
                                             
                                               Posture 
                                                
                                               
                                                   
                                               
                                                
                                               2 
                                             
                                           
                                           
                                              
                                             
                                               MeasureAccelero 
                                               
                                                 Posture 
                                                  
                                                 
                                                     
                                                 
                                                  
                                                 2 
                                               
                                             
                                              
                                           
                                         
                                       
                                     
                                   
                                 
                               
                             
                             
                               
                                 
                                   
                                     ? 
                                   
                                   = 
                                   
                                     
                                       ? 
                                     
                                     
                                        
                                       
                                         ? 
                                       
                                        
                                     
                                   
                                 
                               
                             
                           
                         
                       
                       
                         
                           
                             
                               MeasureAccelero 
                               
                                 Posture 
                                  
                                 
                                     
                                 
                                  
                                 2 
                               
                             
                             = 
                             
                               
                                 MeasureAccelero 
                                 
                                   Posture 
                                    
                                   
                                       
                                   
                                    
                                   2 
                                 
                               
                               
                                  
                                 
                                   MeasureAccelero 
                                   
                                     Posture 
                                      
                                     
                                         
                                     
                                      
                                     2 
                                   
                                 
                                  
                               
                             
                           
                         
                       
                     
                      
                     
                       
 
                     
                      
                     
                       
                         ? 
                       
                        
                       
                         indicates text missing or illegible when filed 
                       
                     
                   
                 
               
               
                 
                     
                 
               
             
           
         
       
     
         [0093]    This yields: 
         [0000]      sin( GH )=mean(∥MeasureAccelero Posture 1 ×MeasureMagneto Posture 1 ∥,∥MeasureAccelero Posture 1 ×MeasureMagneto Posture 2 ∥)
 
         [0000]      cos( GH )=mean(MeasureAccelero Posture 1 □MeasureMagneto Posture 1 ,MeasureAccelero Posture 2 □MeasureMagneto Posture 2 )
 
         [0094]    It is noted that the first expression (sin(GH)) is a mean of the vector products of the measurements of the sensors used and that the second expression (cos(GH)) is a mean of the scalar products of the measurements of the sensors used. 
         [0095]    Finally, the rotation matrix R_orientation is determined by: 
         [0000]    
       
         
           
             Mat 
             = 
             
               [ 
               
                 
                   MeasureAccelero 
                   
                     Posture 
                      
                     
                         
                     
                      
                     1 
                   
                 
                 , 
                 
                   MeasureMagneto 
                   
                     Posture 
                      
                     
                         
                     
                      
                     1 
                   
                 
                 , 
                 
                   MeasureMagneto 
                   
                     Posture 
                      
                     
                         
                     
                      
                     2 
                   
                 
               
               ] 
             
           
         
       
       
         
           
             
                 
             
              
             
               R_orientation 
               = 
               
                 Mat 
                 * 
                 
                   
                     [ 
                     
                       
                         
                           0 
                         
                         
                           
                             sin 
                              
                             
                               ( 
                               GH 
                               ) 
                             
                           
                         
                         
                           0 
                         
                       
                       
                         
                           0 
                         
                         
                           0 
                         
                         
                           
                             - 
                             
                               sin 
                                
                               
                                 ( 
                                 GH 
                                 ) 
                               
                             
                           
                         
                       
                       
                         
                           1 
                         
                         
                           
                             cos 
                              
                             
                               ( 
                               GH 
                               ) 
                             
                           
                         
                         
                           
                             cos 
                              
                             
                               ( 
                               GH 
                               ) 
                             
                           
                         
                       
                     
                     ] 
                   
                   
                     - 
                     1 
                   
                 
               
             
           
         
       
     
         [0096]    This data item is then included in the model of measurements of the sensors in triplet angle form. 
         [0097]    To proceed with the identification of the geometric parameters in this embodiment, a step is carried out of evaluating the lengths of the segments and positions of the sensors on the segments by virtue of a protocol of gestures. This step can rely on an algorithm aimed at reducing the number of degrees of freedom by enabling only planar rotations in relation to constant axes, doing thus so as to utilize the a priori knowledge of the constant vector to solve the system. 
         [0098]    Initially, the method for detecting a substantially invariant axis of rotation, described in patent EP1985233 already cited, makes it possible, using solely the measurements of the magnetometers under the planar motion condition to which the structure of the sensors is constrained, to retrieve the motion, that is to say to deduce the axis of rotation in the reference frame of the magnetometer and of the accelerometer, and also to deduce the angle of rotation. This makes it possible to validate the evaluation of the orientation of the sensors performed at the previous step and even to refine it. This also makes it possible to verify that the orientation of the various sensors is indeed the same, that is to say that the axis of rotation calculated on the basis of the measurements of the accelerometer is identical to that calculated on the basis of the measurements of the magnetometer undergoing the same planar motion. If such is not the case, it is desirable to perform an identification of the box geometric parameters, that is to say an identification of the geometric parameters that relate to the relative orientation of the magnetometer and of the accelerometer. 
         [0099]    Subsequently, the measurements of the accelerometers are used to determine the distance from each sensor to the axis of rotation. The measurements are transformed into the reference frame expected by virtue of the orientation matrices evaluated during the previous step, doing thus so as to work with respect to the segments of the body and not with respect to the sensors. The identification of the geometric parameters are preferably done in the order in which they are described in the present exemplary embodiment. The axes of rotation naturally pass through the articulations of the body. It is therefore desirable to define a protocol to excite sufficient axes so as to determine the three components of the length and position vectors.  FIG. 5  illustrates a rotation of the entire body about a vertical axis  505  that may be regarded as the axis of the body, the shoulder-arm-forearm assembly being held outstretched in a horizontal plane during the rotation of the body about the axis A1. We define: 
         [0000]    
       
         
           
             
               θ 
               a 
             
             = 
             
               
                 mean 
                 
                   
                     i 
                     = 
                     1 
                   
                   , 
                   2 
                   , 
                   3 
                 
               
                
               
                 ( 
                 
                   Uconstant 
                    
                   
                     ( 
                     
                       Mag 
                       i 
                     
                     ) 
                   
                 
                 ) 
               
             
           
         
       
       
         
           
             
               
                 θ 
                 . 
               
               a 
             
             = 
             
               
                  
                 
                   θ 
                   a 
                 
               
               
                  
                 t 
               
             
           
         
       
     
         [0100]    Where:
       mag i  designates the measurement taken by the magnetometer of the sensor iε{1, 2, 3};   U constant  designates a function which returns the axis of rotation obtained by the method described in patent EP1985233 already cited;   mean designates a function which returns the arithmetic mean.       
 
         [0104]    We then have, for i=1, 2, 3: 
         [0000]      MeasureAccelero x,i   a   =R   i *{dot over (θ)} a   2  
 
         [0105]    Where: 
         [0000]    
       
         
           
               
             
               { 
               
                 
                   
                     
                       
                         R 
                         1 
                       
                       = 
                       
                         
                           distance 
                            
                           
                             ( 
                             
                               
                                 basis 
                                  
                                 
                                     
                                 
                                  
                                 shoulder 
                               
                               , 
                               
                                 sensor 
                                 1 
                               
                             
                             ) 
                           
                         
                         X 
                       
                     
                   
                 
                 
                   
                     
                       
                         
                           
                             
                               R 
                               2 
                             
                             = 
                               
                              
                             
                               
                                 distance 
                                  
                                 
                                   ( 
                                   
                                     
                                       basis 
                                        
                                       
                                           
                                       
                                        
                                       shoulder 
                                     
                                     , 
                                     
                                       sensor 
                                       2 
                                     
                                   
                                   ) 
                                 
                               
                               X 
                             
                           
                         
                       
                       
                         
                           
                             = 
                               
                              
                             
                               
                                 length 
                                  
                                 
                                     
                                 
                                  
                                 
                                   
                                     ( 
                                     shoulder 
                                     ) 
                                   
                                   X 
                                 
                               
                               + 
                               
                                 
                                   distance 
                                    
                                   
                                     ( 
                                     
                                       
                                         basis 
                                          
                                         
                                             
                                         
                                          
                                         arm 
                                       
                                       , 
                                       
                                         sensor 
                                         2 
                                       
                                     
                                     ) 
                                   
                                 
                                 X 
                               
                             
                           
                         
                       
                     
                   
                 
                 
                   
                     
                       
                         
                           
                             
                               R 
                               3 
                             
                             = 
                               
                              
                             
                               
                                 distance 
                                  
                                 
                                   ( 
                                   
                                     
                                       basis 
                                        
                                       
                                           
                                       
                                        
                                       shoulder 
                                     
                                     , 
                                     
                                       sensor 
                                       3 
                                     
                                   
                                   ) 
                                 
                               
                               X 
                             
                           
                         
                       
                       
                         
                           
                             = 
                               
                              
                             
                               
                                 length 
                                  
                                 
                                     
                                 
                                  
                                 
                                   
                                     ( 
                                     shoulder 
                                     ) 
                                   
                                   X 
                                 
                               
                               + 
                               
                                 length 
                                  
                                 
                                     
                                 
                                  
                                 
                                   
                                     ( 
                                     arm 
                                     ) 
                                   
                                   X 
                                 
                               
                               + 
                               
                                 
                                   distance 
                                    
                                   
                                     ( 
                                     
                                       elbow 
                                       , 
                                       
                                         sensor 
                                         3 
                                       
                                     
                                     ) 
                                   
                                 
                                 X 
                               
                             
                           
                         
                       
                     
                   
                 
               
             
           
         
       
     
         [0106]      FIG. 6  illustrates a rotation of the arm-forearm assembly about a horizontal axis  605 , perpendicular to the plane of the figure and passing through the articulation linking the shoulder to the arm, the arm-forearm assembly being held outstretched during the rotation. We define: 
         [0000]    
       
         
           
             
               θ 
               b 
             
             = 
             
               
                 mean 
                 
                   
                     i 
                     = 
                     2 
                   
                   , 
                   3 
                 
               
                
               
                 ( 
                 
                   Uconstant 
                    
                   
                     ( 
                     
                       Mag 
                       i 
                     
                     ) 
                   
                 
                 ) 
               
             
           
         
       
       
         
           
             
               
                 θ 
                 . 
               
               b 
             
             = 
             
               
                  
                 
                   θ 
                   b 
                 
               
               
                  
                 t 
               
             
           
         
       
     
         [0107]    We then have, for i=2, 3: 
         [0000]      MeasureAccelero x,i   b   =R   i *{dot over (θ)} b   2   +G *sin(θ b )
 
         [0108]    With: 
         [0000]    
       
         
           
               
             
               { 
               
                 
                   
                     
                       
                         R 
                         2 
                       
                       = 
                       
                         
                           distance 
                            
                           
                             ( 
                             
                               
                                 basis 
                                  
                                 
                                     
                                 
                                  
                                 arm 
                               
                               , 
                               
                                 sensor 
                                 2 
                               
                             
                             ) 
                           
                         
                         X 
                       
                     
                   
                 
                 
                   
                     
                       
                         
                           
                             
                               R 
                               3 
                             
                             = 
                               
                              
                             
                               
                                 distance 
                                  
                                 
                                   ( 
                                   
                                     
                                       basis 
                                        
                                       
                                           
                                       
                                        
                                       arm 
                                     
                                     , 
                                     
                                       sensor 
                                       3 
                                     
                                   
                                   ) 
                                 
                               
                               X 
                             
                           
                         
                       
                       
                         
                           
                             = 
                               
                              
                             
                               
                                 length 
                                  
                                 
                                     
                                 
                                  
                                 
                                   
                                     ( 
                                     arm 
                                     ) 
                                   
                                   X 
                                 
                               
                               + 
                               
                                 
                                   distance 
                                    
                                   
                                     ( 
                                     
                                       elbow 
                                       , 
                                       
                                         sensor 
                                         3 
                                       
                                     
                                     ) 
                                   
                                 
                                 X 
                               
                             
                           
                         
                       
                     
                   
                 
               
             
           
         
       
     
         [0109]      FIG. 7  illustrates a rotation of the forearm about a horizontal axis  705 , perpendicular to the plane of the figure and passing through the articulation linking the arm to the forearm, that is to say the elbow, the shoulder-arm assembly being held outstretched during the rotation. We define: 
         [0000]    
       
         
           
             
               θ 
               c 
             
             = 
             
               
                 mean 
                 
                   i 
                   = 
                   3 
                 
               
                
               
                 ( 
                 
                   Uconstant 
                    
                   
                     ( 
                     
                       Mag 
                       i 
                     
                     ) 
                   
                 
                 ) 
               
             
           
         
       
       
         
           
             
               
                 θ 
                 . 
               
               c 
             
             = 
             
               
                  
                 
                   θ 
                   c 
                 
               
               
                  
                 t 
               
             
           
         
       
     
         [0110]    We then have: 
         [0000]      MeasureAcrelero X3   R   3 *{dot over (θ)} c   2   +G *sin(θ c )
 
         [0000]      With: 
         [0000]        R   3 =distance(elbow,sensor 3 ) X    
         [0111]    Using the relations hereinabove, the following equations can be deduced: 
         [0000]    
       
         
           
               
             
               { 
               
                 
                   
                     
                       
                         Position 
                         
                           X 
                           , 
                           1 
                         
                       
                       = 
                       
                         
                           
                             distance 
                              
                             
                               ( 
                               
                                 
                                   basis 
                                    
                                   
                                       
                                   
                                    
                                   shoulder 
                                 
                                 , 
                                 
                                   sensor 
                                   i 
                                 
                               
                               ) 
                             
                           
                           X 
                         
                         = 
                         
                           ( 
                           
                             
                               MeasureAccelero 
                               
                                 X 
                                 , 
                                 1 
                               
                               a 
                             
                             
                               
                                 θ 
                                 . 
                               
                               a 
                               2 
                             
                           
                           ) 
                         
                       
                     
                   
                 
                 
                   
                     
                       
                         Position 
                         
                           X 
                           , 
                           2 
                         
                       
                       = 
                       
                         
                           
                             distance 
                              
                             
                               ( 
                               
                                 
                                   basis 
                                    
                                   
                                       
                                   
                                    
                                   arm 
                                 
                                 , 
                                 
                                   sensor 
                                   2 
                                 
                               
                               ) 
                             
                           
                           X 
                         
                         = 
                         
                           ( 
                           
                             
                               
                                 
                                   
                                     
                                       MeasureAccelero 
                                       
                                         X 
                                         , 
                                         1 
                                       
                                       b 
                                     
                                     - 
                                   
                                 
                               
                               
                                 
                                   
                                     sin 
                                      
                                     
                                       ( 
                                       
                                         θ 
                                         b 
                                       
                                       ) 
                                     
                                     * 
                                     G 
                                   
                                 
                               
                             
                             
                               
                                 θ 
                                 . 
                               
                               b 
                               2 
                             
                           
                           ) 
                         
                       
                     
                   
                 
                 
                   
                     
                       
                         Position 
                         
                           X 
                           , 
                           3 
                         
                       
                       = 
                       
                         
                           
                             distance 
                              
                             
                               ( 
                               
                                 elbow 
                                 , 
                                 
                                   sensor 
                                   3 
                                 
                               
                               ) 
                             
                           
                           X 
                         
                         = 
                         
                           ( 
                           
                             
                               
                                 
                                   
                                     
                                       MeasureAccelero 
                                       
                                         X 
                                         , 
                                         1 
                                       
                                       e 
                                     
                                     - 
                                   
                                 
                               
                               
                                 
                                   
                                     sin 
                                      
                                     
                                       ( 
                                       
                                         θ 
                                         c 
                                       
                                       ) 
                                     
                                     * 
                                     G 
                                   
                                 
                               
                             
                             
                               
                                 θ 
                                 . 
                               
                               c 
                               2 
                             
                           
                           ) 
                         
                       
                     
                   
                 
               
             
           
         
       
     
         [0112]    Finally, the lengths of the segments can be estimated according to the X component: 
         [0000]    
       
         
           
               
             
               { 
               
                 
                   
                     
                       
                         
                           
                             
                               Length 
                               
                                 X 
                                  
                                 
                                     
                                 
                                  
                                 3 
                               
                             
                             = 
                               
                              
                             
                               
                                 
                                   Length 
                                    
                                   
                                     ( 
                                     shoulder 
                                     ) 
                                   
                                 
                                 X 
                               
                               = 
                               
                                 
                                   distance 
                                    
                                   
                                     ( 
                                     
                                       
                                         basis 
                                          
                                         
                                             
                                         
                                          
                                         shoulder 
                                       
                                       , 
                                       
                                         base 
                                          
                                         
                                             
                                         
                                          
                                         arm 
                                       
                                     
                                     ) 
                                   
                                 
                                 X 
                               
                             
                           
                         
                       
                       
                         
                           
                             = 
                               
                              
                             
                               ( 
                               
                                 
                                   
                                     MeasureAccelero 
                                     
                                       X 
                                        
                                       
                                           
                                       
                                        
                                       2 
                                     
                                     a 
                                   
                                   
                                     
                                       θ 
                                       . 
                                     
                                     a 
                                     2 
                                   
                                 
                                 - 
                                 
                                   Position 
                                   
                                     X 
                                     , 
                                     2 
                                   
                                 
                               
                               ) 
                             
                           
                         
                       
                     
                   
                 
                 
                   
                     
                       
                         
                           
                             
                               Length 
                               
                                 X 
                                 , 
                                 2 
                               
                             
                             = 
                               
                              
                             
                               
                                 
                                   length 
                                    
                                   
                                     ( 
                                     arm 
                                     ) 
                                   
                                 
                                 X 
                               
                               = 
                               
                                 
                                   distance 
                                    
                                   
                                     ( 
                                     
                                       
                                         basis 
                                          
                                         
                                             
                                         
                                          
                                         arm 
                                       
                                       , 
                                       elbow 
                                     
                                     ) 
                                   
                                 
                                 X 
                               
                             
                           
                         
                       
                       
                         
                           
                             = 
                               
                              
                             
                               ( 
                               
                                 
                                   
                                     MeasureAccelro 
                                     
                                       X 
                                        
                                       
                                           
                                       
                                        
                                       3 
                                     
                                     a 
                                   
                                   
                                     
                                       θ 
                                       . 
                                     
                                     a 
                                     2 
                                   
                                 
                                 - 
                                 
                                   Length 
                                   
                                     X 
                                      
                                     
                                         
                                     
                                      
                                     3 
                                   
                                 
                                 - 
                                 
                                   Position 
                                   
                                     X 
                                     , 
                                     3 
                                   
                                 
                               
                               ) 
                             
                           
                         
                       
                       
                         
                           
                             = 
                               
                              
                             
                               ( 
                               
                                 
                                   
                                     MeasureAccelero 
                                     
                                       X 
                                        
                                       
                                           
                                       
                                        
                                       3 
                                     
                                     b 
                                   
                                   
                                     
                                       θ 
                                       . 
                                     
                                     b 
                                     2 
                                   
                                 
                                 - 
                                 
                                   Position 
                                   
                                     X 
                                     , 
                                     3 
                                   
                                 
                               
                               ) 
                             
                           
                         
                       
                     
                   
                 
               
             
           
         
       
     
         [0113]    For the second length, it is preferable to evaluate the mean of the two equations hereinabove to improve the quality of the estimation. 
         [0114]    The same may be undertaken on the other axes of the body, so as to define the other components of the length and position vectors. 
         [0115]    While remaining entirely within the framework of the present invention, it is also possible to make the articulated structure perform less constrained motions than those used in the embodiments of  FIGS. 5 ,  6  and  7 . In these cases, it may not be possible to apply the simplified predictive models, used in these embodiments, of the measurements. It will, however, be possible to apply the various steps of embodiments of the method, it being understood that the 3 rd  step of the method for estimating the parameters may call upon a more complex predictive model of the measurements, for example that described in the patent application filed on the same day as the present application by the same applicants having the same inventor and having as title “PROCEDE D&#39;IDENTIFICATION DES PARAMETRES GEOMETRIQUES D&#39;UNE STRUCTURE ARTICULEE ET D&#39;UN ENSEMBLE DE REPERES D&#39;INTERET DISPOSES SUR LADITE STRUCTURE” [METHOD OF IDENTIFYING THE GEOMETRIC PARAMETERS OF AN ARTICULATED STRUCTURE AND OF AN ASSEMBLY OF REFERENCE FRAMES OF INTEREST DISPOSED ON SAID STRUCTURE], the contents of which are incorporated herein by reference. According to various embodiments of the invention, use is made of the measurements model represented by the following equation: 
         [0000]    
       
         
           
             Meas_Acc 
             = 
             
               
                 R 
                 Earth 
                   
                   
                   
                 Sensor 
               
               * 
               
                 ( 
                 
                   
                     G 
                      
                     
                         
                     
                      
                     0 
                   
                   - 
                   
                     ( 
                     
                       
                         
                           
                             ∂ 
                             2 
                           
                            
                           
                             T 
                             Sensor 
                               
                               
                               
                             Earth 
                           
                         
                         
                           ∂ 
                           
                             t 
                             2 
                           
                         
                       
                       + 
                       Acc_assembly 
                     
                     ) 
                   
                 
                 ) 
               
             
           
         
       
     
         [0116]    Indeed, we have the accelerometric measurements meas_acc and the representation of the motion by virtue of step 2 of the present invention. We can therefore construct the vector  Acc basis-free by virtue of the equality: 
         [0000]    
       
         
           
             
               
                 Acc 
                 
                   basis 
                    
                   
                     - 
                   
                    
                   free 
                 
               
                
               
                 ( 
                 t 
                 ) 
               
             
             = 
             
               
                 
                   Meas 
                   Acc 
                 
                  
                 
                   ( 
                   t 
                   ) 
                 
               
               - 
               
                 G 
                  
                 
                     
                 
                  
                 
                   0 
                   
                     
                       reference 
                        
                       
                           
                       
                        
                       frame 
                     
                     sensor 
                   
                 
               
               + 
               
                 Acc 
                 
                   
                     assembly 
                      
                     
                         
                     
                      
                     reference 
                      
                     
                         
                     
                      
                     frame 
                   
                   sensor 
                 
               
             
           
         
       
     
         [0117]    We can also construct the matrix Mat_tot mvt  by virtue of the equality: 
         [0000]    
       
         
           
             
               Mat_tot 
               mvt 
             
             = 
             
               [ 
               
                 
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             initial 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             1 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             1 
                           
                         
                         ) 
                       
                     
                   
                   
                     … 
                   
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             initial 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             1 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                         
                         ) 
                       
                     
                   
                 
                 
                   
                     ⋮ 
                   
                   
                     ⋱ 
                   
                   
                     ⋮ 
                   
                 
                 
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             final 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             1 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             1 
                           
                         
                         ) 
                       
                     
                   
                   
                     … 
                   
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             final 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                         
                         ) 
                       
                     
                   
                 
                 
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             initial 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             2 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             1 
                           
                         
                         ) 
                       
                     
                   
                   
                     … 
                   
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             initial 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             2 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                         
                         ) 
                       
                     
                   
                 
                 
                   
                     ⋮ 
                   
                   
                     ⋱ 
                   
                   
                     ⋮ 
                   
                 
                 
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             final 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             2 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             1 
                           
                         
                         ) 
                       
                     
                   
                   
                     … 
                   
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             final 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             2 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                         
                         ) 
                       
                     
                   
                 
                 
                   
                     ⋮ 
                   
                   
                     
                         
                     
                   
                   
                     ⋮ 
                   
                 
                 
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             initial 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             1 
                           
                         
                         ) 
                       
                     
                   
                   
                     … 
                   
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             initial 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                         
                         ) 
                       
                     
                   
                 
                 
                   
                     ⋮ 
                   
                   
                     ⋱ 
                   
                   
                     ⋮ 
                   
                 
                 
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             final 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             1 
                           
                         
                         ) 
                       
                     
                   
                   
                     … 
                   
                   
                     
                       
                         Mat 
                         mvt 
                       
                        
                       
                         ( 
                         
                           
                             t 
                             final 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                           , 
                           
                             sensor 
                              
                             
                                 
                             
                              
                             N 
                           
                         
                         ) 
                       
                     
                   
                 
               
               ] 
             
           
         
       
     
         [0118]    With if i is in the chain between the origin of the skeleton and the segment j 
         [0000]    
       
         
           
             
               
                 Mat 
                 mvt 
               
                
               
                 ( 
                 
                   t 
                   , 
                   
                     sensor 
                      
                     
                         
                     
                      
                     j 
                   
                   , 
                   
                     sensor 
                      
                     
                         
                     
                      
                     i 
                   
                 
                 ) 
               
             
             = 
             
               [ 
               
                 - 
                 
                   
                     ( 
                     
                       
                         
                           ∂ 
                           
                             
                               2 
                               
                                 sensor 
                                  
                                 
                                     
                                 
                                  
                                 1 
                               
                             
                              
                             
                               Rotation 
                                
                               
                                 ( 
                                 t 
                                 ) 
                               
                             
                           
                         
                          
                         Earth 
                       
                       
                         ∂ 
                         
                           t 
                           2 
                         
                       
                     
                     ) 
                   
                   
                     
                       reference 
                        
                       
                           
                       
                        
                       frame 
                        
                       
                           
                       
                        
                       i 
                     
                     sensor 
                   
                 
               
               ] 
             
           
         
       
       
         
           
             
                 
             
              
             
               And 
                
               
                   
               
                
               otherwise 
             
           
         
       
       
         
           
             
                 
             
              
             
               
                 
                   Mat 
                   mvt 
                 
                  
                 
                   ( 
                   
                     t 
                     , 
                     
                       sensor 
                        
                       
                           
                       
                        
                       j 
                     
                     , 
                     
                       sensor 
                        
                       
                           
                       
                        
                       i 
                     
                   
                   ) 
                 
               
               = 
               
                 [ 
                 
                   
                     
                       0 
                     
                     
                       0 
                     
                     
                       0 
                     
                   
                   
                     
                       0 
                     
                     
                       0 
                     
                     
                       0 
                     
                   
                   
                     
                       0 
                     
                     
                       0 
                     
                     
                       0 
                     
                   
                 
                 ] 
               
             
           
         
       
     
         [0119]    Once this matrix has been constructed, it merely remains to solve the following least squares problem: 
         [0000]    
       
         
           
             
               
                 Mat_tot 
                 mvt 
               
               * 
               PosLong 
             
             = 
             
               
                 Acc 
                 
                   basis 
                   - 
                   free 
                 
               
                
               
                 ( 
                 
                   
                     t 
                     initial 
                   
                   -&gt; 
                   
                     t 
                     final 
                   
                 
                 ) 
               
             
           
         
       
       
         
           With 
         
       
       
         
           
             PosLong 
             = 
             
               [ 
               
                 
                   
                     
                       Position 
                       
                         sensor 
                          
                         
                             
                         
                          
                         1 
                       
                     
                   
                 
                 
                   
                     
                       Position 
                        
                       
                           
                       
                        
                       
                         origin 
                         
                           segment 
                            
                           
                               
                           
                            
                           2 
                         
                       
                     
                   
                 
                 
                   
                     
                       Position 
                       
                         sensor 
                          
                         
                             
                         
                          
                         2 
                       
                     
                   
                 
                 
                   
                     ⋮ 
                   
                 
                 
                   
                     
                       Position 
                        
                       
                           
                       
                        
                       
                         origin 
                         
                           segment 
                            
                           
                               
                           
                            
                           N 
                         
                       
                     
                   
                 
                 
                   
                     
                       Position 
                       
                         sensor 
                          
                         
                             
                         
                          
                         N 
                       
                     
                   
                 
               
               ] 
             
           
         
       
     
         [0120]    Once PosLong has been estimated, it merely remains to collect the parameters according to the provision given in the above equality. 
         [0121]    This procedure is advantageous since it expresses the estimation in the form of a linear least squares problem, the calculation of the estimate is therefore explicit and optimal. 
         [0122]    According to embodiments of the invention (patent application filed on the same day as the present application by the same applicants having the same inventor and having as title “PROCEDE D&#39;IDENTIFICATION DES PARAMETRES GEOMETRIQUES D&#39;UNE STRUCTURE ARTICULEE ET D&#39;UN ENSEMBLE DE REPERES D&#39;INTERET DISPOSES SUR LADITE STRUCTURE” [METHOD OF IDENTIFYING THE GEOMETRIC PARAMETERS OF AN ARTICULATED STRUCTURE AND OF AN ASSEMBLY OF REFERENCE FRAMES OF INTEREST DISPOSED ON SAID STRUCTURE], incorporated herein by reference, the measurement model is advantageously solved, even if only a reduced number of gyrometers are available to supplement the accelerometer and magnetometer measurements, by calculating pseudo-static states which can be substituted, each time that the system is in a pseudo-static state, for the values calculated by a Kalman type state observer. 
         [0123]    These steps of the method of various embodiments of the invention can be implemented in software, certain parts of the software possibly being installed onboard the sensors, others possibly being embedded in a micro-controller, a micro-processor, or a micro-computer connected to the system of sensors. These processing capabilities can be conventional circuits, connected and configured to perform the processing operations described hereinabove. 
         [0124]    The examples described hereinabove are given by way of illustration of embodiments of the invention. They do not in any way limit the field of the invention, which is defined by the claims which follow.

Technology Category: 2