FR2930335A1 - Systeme et procede de determination de parametres representatifs de l'orientation d'un solide en mouvement soumis a deux champs vectoriels. - Google Patents
Systeme et procede de determination de parametres representatifs de l'orientation d'un solide en mouvement soumis a deux champs vectoriels. Download PDFInfo
- Publication number
- FR2930335A1 FR2930335A1 FR0802172A FR0802172A FR2930335A1 FR 2930335 A1 FR2930335 A1 FR 2930335A1 FR 0802172 A FR0802172 A FR 0802172A FR 0802172 A FR0802172 A FR 0802172A FR 2930335 A1 FR2930335 A1 FR 2930335A1
- Authority
- FR
- France
- Prior art keywords
- vector
- solid
- matrix
- field
- rot
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 239000013598 vector Substances 0.000 title claims abstract description 133
- 239000007787 solid Substances 0.000 title claims abstract description 59
- 238000000034 method Methods 0.000 title claims description 7
- 239000011159 matrix material Substances 0.000 claims abstract description 67
- 238000012937 correction Methods 0.000 claims abstract description 45
- 238000005259 measurement Methods 0.000 claims description 24
- 238000004364 calculation method Methods 0.000 claims description 20
- 230000004913 activation Effects 0.000 claims description 4
- 230000033001 locomotion Effects 0.000 description 9
- 102100038521 Calcitonin gene-related peptide 2 Human genes 0.000 description 4
- 101000741431 Homo sapiens Calcitonin gene-related peptide 2 Proteins 0.000 description 4
- 238000012360 testing method Methods 0.000 description 4
- 102100025588 Calcitonin gene-related peptide 1 Human genes 0.000 description 3
- 101000741445 Homo sapiens Calcitonin Proteins 0.000 description 3
- 101000932890 Homo sapiens Calcitonin gene-related peptide 1 Proteins 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 3
- 230000009849 deactivation Effects 0.000 description 2
- 230000036541 health Effects 0.000 description 2
- 229940050561 matrix product Drugs 0.000 description 2
- 241001556567 Acanthamoeba polyphaga mimivirus Species 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000005802 health problem Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
- 230000014616 translation Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
- G01C21/1654—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments with electromagnetic compass
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C17/00—Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
- G01C17/38—Testing, calibrating, or compensating of compasses
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
Abstract
Le système de détermination de paramètres représentatifs de l'orientation d'un solide en mouvement soumis à un premier champ vectoriel (A) et un deuxième champ vectoriel (M) comprend un premier capteur triaxial (CAPT1) et un deuxième capteur triaxial (CAPT2) solidaires dudit solide pour mesurer les composantes desdits champs vectoriels respectifs (A, M) selon les axes desdits capteurs, et des moyens de détermination (DETROT) de la matrice de rotation (ROT) du solide. Lesdits moyens de détermination (DETROT) de ladite matrice de rotation (ROT) comprennent:- des moyens de correction (CORR), de l'influence d'un champ vectoriel additionnel de même nature que ledit champ vectoriel mesuré; et- des premiers moyens de calcul (CALC1 ) d'un tiers vecteur (U) non coplanaire au plan formé par les deux vecteurs (App, M) délivrés par lesdits moyens de correction (CORR), et tel que les angles du trièdre formé par le tiers vecteur (U) et les deux vecteurs (App, M) délivrés par lesdits moyens de correction (CORR) restent constants.
Description
Système et procédé de détermination de paramètres représentatifs de l'orientation d'un solide en mouvement soumis à deux champs vectoriels.
L'invention concerne un système et un procédé de détermination de paramètres représentatifs de l'orientation d'un solide en mouvement soumis à deux champs vectoriels. De manière générale, les systèmes de capture de mouvement 5 d'un solide ont des applications dans des domaines variés tels que la santé, le multimédia, ou la géophysique. Pour des applications vidéo ou des jeux vidéo, les mouvements d'un utilisateur peuvent être utilisés pour commander des systèmes de réalité virtuelle. A titre d'exemple, les mouvements d'un joueur peuvent être 10 enregistrés pour commander l'évolution d'un personnage virtuel dans une scène de synthèse. Dans le domaine de l'électronique portable, les dispositifs de capture de mouvement permettent aux appareils de s'adapter au contexte d'utilisation. Ils permettent, par exemple, d'optimiser la réception d'un 15 téléphone portable par la connaissance de son orientation, ou d'améliorer les interfaces des assistants personnels. Concernant le domaine de la santé, de tels systèmes peuvent servir à positionner des outils de chirurgie, ou à surveiller les déplacements de personne âgées ou ayant des problèmes de santé entraînant une mobilité 20 réduite. Les capteurs de mouvement, et plus précisément les capteurs de position angulaire, sont fortement miniaturisés et font solide de recherches pour leur conférer une robustesse et un coût compatibles avec des applications visant le grand public. 25 La position d'un solide dans l'espace est entièrernent déterminée par la connaissance de six grandeurs. Parmi celles-ci on distingue trois grandeurs susceptibles de traduire des translations et trois autres grandeurs susceptibles de traduire des rotations. Les trois dernières grandeurs correspondent à des positions angulaires, appelées angles d'attitude, pouvant être utilisées pour déterminer des mouvements. En outre, une rotation peut être définie par un quaternion.
Par exemple le document FR 2 838 185 (Commissariat à l'Energie Atomique) divulgue un dispositif de capture de l'orientation d'un solide comprenant au moins un capteur de position angulaire susceptible d'être rendu solidaire du solide et de délivrer au moins une donnée de mesure représentative de l'orientation du solide, un moyen générateur de données de test représentatives d'une orientation estimée du solide, et un moyen de modification de l'orientation estimée du solide par confrontation de la donnée de mesure et de données de test. Après une ou plusieurs modifications de l'orientation estimée, celle-ci converge vers l'orientation effective du solide, ou, plus précisément, vers l'orientation mesurée. Ce dispositif ne nécessite pas de moyens de calcul pour établir l'orientation ou l'inclinaison du solide sur la base d'une fonction des données de mesure des capteurs, et permet de s'affranchir des comportements non linéaires de ceux-ci. Toutefois, un tel dispositif nécessite de nombreux calculs et ne peut pas, ou difficilement, être embarqué sur un système de taille réduite. Un 20 tel dispositif est en outre sensible à l'accélération propre du solide. Aussi, la présente invention vise à résoudre les problèmes mentionnés précédemment. Selon un aspect de l'invention, il est proposé un système de détermination de paramètres représentatifs de l'orientation d'un solide en 25 mouvernent, soumis à un premier champ vectoriel et un deuxième champ vectoriel, lesdits champs étant de directions connues dans un repère fixe non lié au solide. Ledit système comprend un premier capteur triaxial et un deuxième capteur triaxial solidaires dudit solide pour mesurer les composantes desdits champs vectoriels respectifs selon les axes desdits 30 capteurs, et des moyens de détermination de la matrice de rotation du solide. Lesdits moyens de détermination de ladite matrice de rotation comprennent : - des moyens de correction, désactivables sur commande, adaptés pour corriger l'influence exercée sur les mesures d'au moins un desdits capteurs par un champ vectoriel additionnel de même nature que ledit champ vectoriel mesuré et délivrer au moins un vecteur de champ vectoriel corrigé ; et - des premiers moyens de calcul d'un tiers vecteur adaptés pour calculer ledit tiers vecteur non coplanaire au plan formé par les deux vecteurs délivrés par lesdits moyens de correction, et tel que les angles du trièdre formé par le tiers vecteur et les deux vecteurs délivrés par lesdits moyens de correction restent constants. Un tel système permet, à coût réduit, de réaliser un système de calcul des angles d'attitude d'un solide en mouvement utilisant un nombre de calcul fortement réduit, facilitant sa mise en oeuvre de manière embarquée à bord d'un ensemble portable de petite taille.
Dans un mode de réalisation, lesdits moyens de détermination de ladite matrice de rotation comprennent, en outre, des moyens d'orthogonalisation et de centrage des mesures transrnises par lesdits capteurs triaxiaux. Ainsi, la simplicité de l'algorithme permet une implémentation 20 consommant peu d'énergie, aisément réalisable avec un processeur embarqué. Selon un mode de réalisation, lesdits moyens de détermination de ladite matrice de rotation comprennent, en outre, des moyens de comrnande adaptés pour désactiver lesdits moyens de correction à un 25 instant pris pour référence, pendant que lesdits premiers moyens de calcul calculent un tiers vecteur de référence. L'utilisateur peut ainsi choisir sa référence. Avantageusement, le système comprend, en outre, des moyens d'activation automatique adaptés pour activer lesdits moyens de 30 correction lorsqu'une norme d'un desdits champs vectoriels transmis par lesdits capteurs triaxiaux est supérieure à un seuil de référence et pour 4 désactiver lesdits moyens de correction lorsque ladite norme est inférieure ou égale audit seuil de référence. Ainsi, de manière automatique, le système peut désactiver la correction, par exemple, pour lancer un mode de reconnaissance de geste.
Dans un mode de réalisation, lesdits moyens de détermination de ladite matrice de rotation comprennent, en outre, des deuxièmes moyens de calcul d'une matrice intermédiaire dont les colonnes successives sont les composantes dudit tiers vecteur, les composantes dudit premier charnp vectoriel mesurées et éventuellement corrigées par lesdits moyens de correction, et les composantes dudit deuxième champ vectoriel mesurées et éventuellement corrigées par lesdits moyens de correction. II est ainsi possible d'indiquer des champs de référence, par exemple dans un environnement perturbé magnétiquement, et des les utiliser pour rendre une matrice de rotation correcte.
Selon un mode de réalisation, lesdits moyens de détermination de ladite matrice de rotation comprennent, en outre, des troisièmes moyens de calcul d'inversion de matrice, adaptés pour être activés par lesdits moyens de commande lors du calcul du tiers vecteur de référence et pour calculer la matrice inverse de ladite matrice intermédiaire correspondant au tiers vecteur de référence et nommée matrice inverse de référence. Les calculs d'inversion de matrice sont effectués uniquement pour la matrice intermédiaire de référence, ce qui limite fortement la complexité calculatoire de réalisation de l'invention. Dans un mode de réalisation, lesdits moyens de détermination de ladite matrice de rotation comprennent, en outre, des moyens de mémorisation pour mémoriser ladite matrice inverse de référence. Ainsi l'inversion de cette matrice n'est effectuée qu'une seule fois. Selon un mode de réalisation, lesdits moyens de détermination 30 de ladite matrice de rotation comprennent, en outre, un multiplicateur pour multiplier ladite matrice intermédiaire et ladite matrice inverse de référence mémorisée et délivrer en sortie ladite matrice de rotation. On obtient directement la ma matrice de rotation du solide, de manière simple.
Dans un mode de réalisation, le système comprend, en outre, des moyens de détermination desdits paramètres représentatifs de l'orientation du solide à partir des coefficients de ladite matrice de rotation. On déduit ensuite de manière immédiate les angles d'attitude du solide ou le quaternion représentatif de l'orientation du solide à partir de la matrice de rotation du solide. Selon un mode de réalisation, ledit tiers vecteur est le produit vectoriel du premier champ vectoriel mesuré et éventuellement corrigé et du deuxième champ vectoriel mesuré et éventuellement corrigé. Le produit vectoriel est un tiers vecteur qui remplit les 15 conditions précitées et est simple à calculer. Dans un mode de réalisation, ledit premier champ vectoriel est le champ de gravitation terrestre et ledit deuxième champ est le champ magnétique terrestre. L'invention s'applique de manière non limitative aux champs 20 gravitationnel et magnétique terrestres. Selon un mode de réalisation, lesdits moyens de correction sont adaptés pour corriger le champ de gravitation mesuré en un champ de gravitation corrigé en ajoutant au vecteur de gravitation mesuré un vecteur proportionnel au vecteur magnétique terrestre mesuré de sorte que le 25 vecteur de gravitation corrigé forme avec le vecteur magnétique terrestre mesuré un angle égal à un angle de référence égal à l'angle sensiblement constant entre le champ de gravitation terrestre et le champ magnétique terrestre dans ledit repère fixe non lié à solide, et adaptés pour centrer le vecteur de gravitation corrigé.
Dans un mode de réalisation, lesdits paramètres représentatifs de l'orientation du solide comprennent des angles d'attitude tels les angles de Cardan ou les angles d'Euler, ou un quaternion. Selon un autre aspect de l'invention, il est également proposé un procédé de détermination de paramètres représentatifs de l'orientation d'un solide en mouvement, soumis à un premier champ vectoriel et un deuxième champ vectoriel, de directions sensiblement constantes dans un repère fixe non lié au solide, dans lequel on mesure les composantes desclits champs vectoriels respectifs selon les axes de capteurs triaxiaux respectifs, et on détermine la matrice de rotation du solide. On corrige l'influence exercée sur les mesures d'au moins un desdits capteurs par un champ vectoriels additionnel de même nature que ledit champ vectoriels mesuré et on délivre au moins un vecteur de champ vectoriel corrigé. On calcule un tiers vecteur non coplanaire au plan formé par les deux vecteurs délivrés en sortie de correction, et tel que les angles du trièdre formé par le tiers vecteur et les deux vecteurs délivrés en sortie de correction restent sensiblement constants. Dans un mode de mise en oeuvre, on orthogonalise et on centre les mesures des premier et deuxième champs vectoriels, et on désactive ladite correction à un instant pris pour référence, pendant le calcul d'un tiers vecteur de référence. L'invention sera mieux comprise à l'étude de quelques modes de réalisation décrits à titre d'exemples nullement limitatifs et illustrés par les dessins annexés sur lesquels : - la figure 1 illustre schématiquement un mode de réalisation d'un système selon un aspect de l'invention; et - la figure 2 illustre schématiquement un mode de mise en oeuvre du procédé selon un aspect de l'invention. Dans la description qui suit, il est fait référence aux angles d'attitude d'un solide. Le solide ne fait cependant pas partie du système de détermination des angles d'attitude, qui correspondent plus précisément à ceux des capteurs susceptibles d'être fixés au solide. Par ailleurs, les termes orientation et position angulaire sont utilisés comme synonymes. Dans la suite de la description, de manière non limitative, les deux champs vectoriels sont le champ gravitationnel terrestre et le champ magnétique terrestre. Bien entendu, l'invention s'applique également à deux champs vectoriels quelconques sensiblement constants dans un repère fixe non lié à solide. Tel qu'illustré sur la figure 1, le système comprend un accéléromètre triaxial CAPT1 qui mesure dans un référentiel de référence lié au solide le champ gravitationnel A et un magnétomètre triaxial CAPT2 qui mesure dans le référentiel de référence le champ magnétique M. Les mesures transmises par l'accéléromètre triaxial CAPT1 et par le magnétomètre triaxial CAPT2 sont transmise à un module DETROT de détermination de la matrice de rotation ROT sont orthogonalisées et centrées par un module ORTHOC. En variante l'orthogonalisation et le centrage des mesures transmises par les capteurs triaxiaux CAPT1 et CAPT2 peut être directement effectué au sein même des capteurs. On entend par orthogonalisation des mesures délivrées par un capteur triaxial, une correction a posteriori des défauts de perpendicularité du capteur, et par centrage des mesures délivrées par un capteur, une correction de l'offset du capteur de sorte qu'il ait une réponse nulle pour un stimulus nul. Un module de correction CORR, désactivable sur commande d'un utilisateur du système, par l'intermédiaire d'un module de commande COMMANDE, permet de corriger l'influence exercée sur les mesures d'au moins un des capteurs par un champ vectoriel additionnel de même nature que celui mesuré. En l'espèce, une accélération propre au solide est mesurée par l'accéléromètre triaxial CAPT1 en sus du champ gravitationnel de référence Al. Dans un tel exemple de réalisation, le module de correction CORR ajoute au vecteur de mesures A un vecteur parallèle au vecteur de mesures M : A+t.M , que l'on nomme App, t étant un scalaire déterminé de sorte que l'angle formé par App et M soit égal à l'angle entre les champs gravitationnel et magnétique terrestres de directions sensiblement constantes dans un repère fixe non lié au solide. De manière optionnelle, un module de d'activation automatique ACTAUTO teste si une norme d'un desdits champs vectoriels est supérieure à un seuil de référence, et, si la norme d'un desdits champs vectoriels est supérieure à ce seuil de référence, active automatiquement le module de correction CORR, et pour le désactiver dans le cas contraire. Un premier module de calcul CALC1 calcule un tiers vecteur U non coplanaire au plan formé par les deux vecteurs délivrés par le module de correction CORR, et tel que les angles du trièdre formé par le tiers vecteur U et les deux vecteurs App et M délivrés par le module de correction restent constants. Dans cet exemple avec les champs gravitationnel et magnétique terrestres, le premier module de calcul CALC1 calcule le produit vectoriel U des vecteurs App et M délivrés par le module de correction CORR (U = App x M , x étant le symbole du produit vectoriel). Un deuxième module de calcul CALC2 forme une matrice intermédiaire (UAppM) dont les colonnes successives sont formées par les composantes du tiers vecteur U, du vecteur de mesures corrigé App, et du vecteur de mesures M. Durant la désactivation du module de correction CORR par le module de commande COMMANDE, le deuxième module de calcul CALC2 élabore une matrice intermédiaire (U1A1M1) correspondant: au vecteur tiers de référence là. Un troisième module de calcul CALC3 est activé par le module de commande COMMANDE permettant à un utilisateur de définir la référence du système. Le troisième module de commande CALC3 effectue le calcul de l'inverse d'une matrice, en ce cas, le calcul de l'inverse de la matrice ((MIMI) des vecteurs de référence (U1=A1 x MI) que l'on nomme matrice inverse de référence inv((U1A1M1)), et qui est mémorisée dans un module de mémorisation MEM. Cette matrice inverse de référence inv((U,A,M,)) est calculée une seule fois.
En fonctionnement établi du système le module de correction CORR est activé, et le troisième module de calcul CALC3 est désactivé. Un module de multiplication MULT reçoit en entrée la matrice intermédiaire (UAppM) et la matrice inverse de référence mémorisée inv((U1A1M1)), respectivement du deuxième module de calcul CALC2 et du module de mémorisation MEM, et délivre en sortie le produit matriciel de ces deux matrices, égal à la matrice de rotation ROT représentative de la rotation du solide. A partir de la matrice de rotation ROT, un module de détermination DET détermine les paramètres représentatifs de l'orientation du solide. Les paramètres représentatifs de l'orientation du solide peuvent être, par exemple, les angles d'attitude du solide, tels les angles de lacet, roulis et tangage. En variante, les paramètres représentatifs de l'orientation du solide peuvent être, par exemple, un quaternion.
Dans le cas des angles d'attitude, cette détermination par identification des angles d'attitude peut être effectuée en multipliant la matrice de rotation ROT par le vecteur V1=[1 0 0] , qui donne un deuxième vecteur V2=[x y z], tel que l'angle de lacet YAW, qui est la projection de V2 sur le plan (x, y) vérifie l'équation suivante: tan(YAW)=y/x. Pour les angles de roulis ROLL et de tangage PITCH, des identifications similaires peuvent être utilisées. Dans le cas du quaternion, cette détermination permet de retrouver le quaternion (vecteur de l'axe de rotation et rotation) associé à la rotation, par un calcul simple utilisant la trace de la matrice de rotation.
La figure 2 illustre le fonctionnement d'un système selon la figure 1. Les capteurs triaxiaux CAPT1 et CAPT2 effectuent des mesures (étape 20), qui sont orthogonalisées et centrées (étape 21) par le rnodule ORTHOC. L'influence exercée sur les mesures d'au moins un des capteurs par un champ additionnel de même nature que celui mesuré, en l'occurrence une accélération propre au solide est mesurée par l'accéléromètre triaxial CAPT1 en sus du champ gravitationnel de référence Al, est corrigée (étape 22) par le module de correction CORR de la manière décrite précédemment. Cette étape peut être désactivée, ou, en d'autres termes non effectuée, sur commande (étape 23) temporaire d'un utilisateur du système, notamment lorsqu'il veut définir une référence du système.
Un test automatique optionnel, (étape 21a) comparant si la norme de l'un des vecteurs orthogonalisé et centré A ou M, délivrés par le module d'orthogonalisation et de centrage ORTHOC, est supérieure à un seuil de référence, et, si cette condition est vérifiée, le module d'activation automatique ACTAUTO active le module de correction CORR.
Un tiers vecteur U est ensuite calculé (étape 24) de sorte qu'il soit non coplanaire au plan formé par les deux vecteurs délivrés par le module de correction CORR, et tel que les angles du trièdre formé par le tiers vecteur U et les deux vecteurs App et M délivrés par le module de correction restent constants. Par exemple, U peut être le produit vectoriel des vecteurs App et M délivrés par le module de correction CORR, calculé par le premier module de calcul CALC1. Le deuxième module de calcul CALC2 calcule ensuite (étape 25) une matrice intermédiaire (UAppM) dont les colonnes successives sont formées par les composantes du tiers vecteur U, du vecteur de mesures corrigé App, et du vecteur de mesures M. Durant la commande (étape 23) de désactivation de la correction (étape 22) faite par le module de correction CORR, le module de commande COMMANDE active également le troisième module de calcul CALC3 (étape 26) pour calculer la matrice inverse de référence inv((U1A1M1)) définie précédemment. Cette matrice inverse de référence inv((U1A1M1)) est mémorisée (étape 27) dans le module de mémorisation MEM. En fonctionnement établi, hors commande (étape 23) de prise de référence pour le système, le module de multiplication MULT effectue le produit matriciel ou multiplication (étape 28) de la matrice intermédiaire (UAppM) et de la matrice inverse de référence mémorisée inv((U1AI MI )) pour fournir en sortie la matrice de rotation ROT de la rotation du solide.
Le module de détermination DET détermine (étape 29) alors, les angles d'attitude du solide ou le quaternion à partir de la matrice de rotation ROT, par exemple comme décrit précédemment pour le module DET. La présente invention permet donc, avec un nombre de calculs réduits fournissant les angles d'attitude d'un solide en mouvement ou un quaternion à partir de la matrice de rotation, de réaliser un système portatif de petite taille permettant la capture de mouvement d'un solide.
Claims (15)
- REVENDICATIONS1. Système de détermination de paramètres représentatifs de l'orientation d'un solide en mouvement, soumis à un premier champ vectoriel (A) et un deuxième champ vectoriel (M), lesdits champs étant de directions connues dans un repère fixe non lié au solide, ledit système comprenant un premier capteur triaxial (CAPT1) et un deuxième capteur triaxial (CAPT2), solidaires dudit solide, pour mesurer les composantes desdits champs vectoriels respectifs (A, M) selon les axes desdits capteurs, et des moyens de détermination (DETROT) de la matrice ,de rotation (ROT) du solide, caractérisé en ce que lesdits moyens de détermination (DETRC)T) de ladite matrice de rotation (ROT) comprennent: - des moyens de correction (CORR), désactivables sur commande, adaptés pour corriger l'influence exercée sur les mesures d'au moins un desdits capteurs (CAPT1, CAPT2) par un champ vectoriel additionnel de même nature que ledit champ vectoriel mesuré, et délivrer au moins un vecteur corrigé (App) ; et - des premiers moyens de calcul (CALC1) d'un tiers vecteur (U) adaptés pour calculer ledit tiers vecteur (U) non coplanaire au plan formé par les deux vecteurs (App, M) délivrés par lesdits moyens de correction (CORR), et tel que les angles du trièdre formé par le tiers vecteur (U) et les deux vecteurs (App, M) délivrés par lesdits moyens de correction (CORR) restent constants.
- 2. Système selon la revendication 1, dans lequel lesdits moyens de détermination (DETROT) de ladite matrice de rotation (ROT) comprennent, en outre, des moyens d'orthogonalisation et de centrage 25 (ORTHOC) des mesures transmises par lesdits capteurs triaxiaux (CAPT1, CAPT2).
- 3. Système selon la revendication 1 ou 2, dans lequel lesdits moyens de détermination (DETROT) de ladite matrice de rotation (ROT) comprennent, en outre, des moyens de commande (COMMANDE)adaptés pour désactiver lesdits moyens de correction (CORR) à un instant pris pour référence, pendant que lesdits premiers moyens de calcul (CALC1) calculent un tiers vecteur (U) de référence (Ul).
- 4. Système selon la revendication 2 ou 3, comprenant, en outre, des moyens d'activation automatique (ACTAUTO) adaptés pour activer lesdits moyens de correction (CORR) lorsqu'une norme d'un desdits champs vectoriels (A, M) transmis par lesdits capteurs triaxiaux (CAPT1, CAPT2) est supérieure à un seuil de référence, et pour désactiver lesdits moyens de correction (CORR) lorsque ladite norme est inférieure ou égale audit seuil de référence.
- 5. Système selon l'une des revendications 1 à 4, dans lequel lesdits moyens de détermination (DETROT) de ladite matrice de rotation (ROT) comprennent, en outre, des deuxièmes moyens de calcul (CALC2) d'une matrice intermédiaire (UAppM) dont les colonnes successives sont les composantes dudit tiers vecteur (U), les composantes dudit premier champ vectoriel mesurées et éventuellement corrigées (App) par lesdits moyens de correction (CORR), et les composantes dudit deuxième champ vectoriel mesurées et éventuellement corrigées (M) par lesdits moyens de correction (CORR).
- 6. Système selon la revendication 5, dans lequel lesdits moyens de détermination (DETROT) de ladite matrice de rotation (ROT) comprennent, en outre, des troisièmes moyens de calcul (CALC3) d'inversion de matrice, adaptés pour être activés par lesdits moyens de commande (COMMANDE) lors du calcul du tiers vecteur de référence (U1) et pour calculer la matrice inverse de ladite matrice intermédiaire (U1A1M1) correspondant au tiers vecteur de référence (Ul) et nommée matrice inverse de référence (inv(U1A1M1)).
- 7. Système selon la revendication 6, dans lequel lesdits moyens de détermination (DETROT) de ladite matrice de rotation (ROT) 30 comprennent, en outre, des moyens de mémorisation (MEM) pour mémoriser ladite matrice inverse de référence (inv(U1A1M)).
- 8. Système selon la revendication 7, dans lequel lesdits moyens de détermination (DETROT) de ladite matrice de rotation (ROT) comprennent, en outre, un multiplicateur (MULT) pour multiplier ladite matrice intermédiaire (UAppM) et ladite matrice inverse de référence 5 (inv(U1A1M1)) mémorisée et délivrer en sortie ladite matrice de rotation (ROT).
- 9. Système selon l'une des revendications 1 à 8, comprenant, en outre, des moyens de détermination (DET) desdits paramètres représentatifs de l'orientation du solide à partir des coefficients 10 de ladite matrice de rotation (ROT).
- 10. Système selon l'une des revendications précédentes, dans lequel ledit tiers vecteur (U) est le produit vectoriel du premier charnp vectoriel mesuré et éventuellement corrigé (App) et du deuxième charnp vectoriel mesuré et éventuellement corrigé (M). 15
- 11. Système selon l'une des revendications précédentes, dans lequel ledit premier champ vectoriel (A) est le champ de gravitation terrestre et ledit deuxième champ vectoriel (M) est le champ magnétique terrestre.
- 12. Système selon les revendications 10 et 11, dans lequel 20 lesdits moyens de correction (CORR) sont adaptés pour corriger le champ de gravitation mesuré (A) en un champ de gravitation corrigé (App) en ajoutant au vecteur de gravitation mesuré (A) un vecteur proportionnel au vecteur magnétique terrestre mesuré (M) de sorte que le vecteur de gravitation corrigé (App) forme avec le vecteur magnétique terrestre mesuré (M) un 25 angle égal à un angle de référence égal à l'angle sensiblement constant entre le champ de gravitation terrestre et le champ magnétique terrestre dans ledit repère fixe non lié à solide, et adaptés pour centrer le vecteur cle gravitation corrigé (App).
- 13. Système selon l'une des revendications précédentes, 30 dans lequel lesdits paramètres représentatifs de l'orientation du solidecomprennent des angles d'attitude tels les angles de Cardan ou les angles d'Euler, ou un quaternion.
- 14. Procédé de détermination de paramètres représentatifs de l'orientation d'un solide en mouvement, soumis à un premier champ vectoriel (A) et un deuxième champ vectoriel (M), de directions sensiblement constantes dans un repère fixe non lié au solide, dans lequel on mesure les composantes desdits champs respectifs selon les axes de capteurs triaxiaux respectifs (CAPT1, CAPT2), et on détermine la matrice de rotation (ROT) du solide, caractérisé en ce que : - on corrige l'influence exercée sur les mesures d'au moins un desdits capteurs par un champ vectoriel additionnel de rnéme nature que ledit champ vectoriel mesuré et on délivre au moins un vecteur corrigé (App) ; et - on calcule un tiers vecteur (U) non coplanaire au plan formé par les deux vecteurs (App, M) délivrés en sortie de correction, et tel que les angles du trièdre formé par le tiers vecteur (U) et les deux vecteurs (App, M) délivrés en sortie de correction restent sensiblement constants.
- 15. Procédé selon la revendication 14, dans lequel on orthogonalise et on centre les mesures des premier et deuxième champs vectoriels, et on désactive ladite correction à un instant pris pour référence, pendant le calcul d'un tiers vecteur (U) de référence (Ul).
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR0802172A FR2930335B1 (fr) | 2008-04-18 | 2008-04-18 | Systeme et procede de determination de parametres representatifs de l'orientation d'un solide en mouvement soumis a deux champs vectoriels. |
US12/937,797 US9297660B2 (en) | 2008-04-18 | 2009-04-08 | System and method for determining parameters representing orientation of a solid in movement subject to two vector fields |
PCT/EP2009/054185 WO2009127561A1 (fr) | 2008-04-18 | 2009-04-08 | Systeme et procede de determination de parametres representatifs de l'orientation d'un solide en mouvement soumis a deux champs vectoriels |
EP09732406A EP2268999A1 (fr) | 2008-04-18 | 2009-04-08 | Systeme et procede de determination de parametres representatifs de l'orientation d'un solide en mouvement soumis a deux champs vectoriels |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR0802172A FR2930335B1 (fr) | 2008-04-18 | 2008-04-18 | Systeme et procede de determination de parametres representatifs de l'orientation d'un solide en mouvement soumis a deux champs vectoriels. |
Publications (2)
Publication Number | Publication Date |
---|---|
FR2930335A1 true FR2930335A1 (fr) | 2009-10-23 |
FR2930335B1 FR2930335B1 (fr) | 2010-08-13 |
Family
ID=40039886
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
FR0802172A Expired - Fee Related FR2930335B1 (fr) | 2008-04-18 | 2008-04-18 | Systeme et procede de determination de parametres representatifs de l'orientation d'un solide en mouvement soumis a deux champs vectoriels. |
Country Status (4)
Country | Link |
---|---|
US (1) | US9297660B2 (fr) |
EP (1) | EP2268999A1 (fr) |
FR (1) | FR2930335B1 (fr) |
WO (1) | WO2009127561A1 (fr) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011131497A1 (fr) * | 2010-04-23 | 2011-10-27 | Movea | Systeme d'analyse de foulees d'un utilisateur |
WO2015091402A1 (fr) | 2013-12-18 | 2015-06-25 | Movea | Procede de determination de l'orientation d'un repere capteur lie a un terminal mobile muni d'un ensemble capteur, porte par un utilisateur et comprenant au moins un capteur de mouvement lie en mouvement |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2381845B1 (fr) | 2009-01-05 | 2019-09-11 | Movea S.A | Dispositif, methode et systeme de caracterisation de mouvements d'un pied |
FR2976353B1 (fr) * | 2011-06-07 | 2013-07-05 | Movea | Procede d'estimation simplifie de l'orientation d'un objet et centrale d'attitude mettant en oeuvre un tel procede |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5953683A (en) * | 1997-10-09 | 1999-09-14 | Ascension Technology Corporation | Sourceless orientation sensor |
US20020103610A1 (en) * | 2000-10-30 | 2002-08-01 | Government Of The United States | Method and apparatus for motion tracking of an articulated rigid body |
US20060066295A1 (en) * | 2004-09-29 | 2006-03-30 | C & N Inc. | Control method of controlling magnetic-field sensor, control device, and mobile terminal device |
US20080042973A1 (en) * | 2006-07-10 | 2008-02-21 | Memsic, Inc. | System for sensing yaw rate using a magnetic field sensor and portable electronic devices using the same |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4298874A (en) * | 1977-01-17 | 1981-11-03 | The Austin Company | Method and apparatus for tracking objects |
CN101652631A (zh) * | 2007-04-04 | 2010-02-17 | Nxp股份有限公司 | 方位感测系统的自动校准 |
-
2008
- 2008-04-18 FR FR0802172A patent/FR2930335B1/fr not_active Expired - Fee Related
-
2009
- 2009-04-08 EP EP09732406A patent/EP2268999A1/fr not_active Withdrawn
- 2009-04-08 WO PCT/EP2009/054185 patent/WO2009127561A1/fr active Application Filing
- 2009-04-08 US US12/937,797 patent/US9297660B2/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5953683A (en) * | 1997-10-09 | 1999-09-14 | Ascension Technology Corporation | Sourceless orientation sensor |
US20020103610A1 (en) * | 2000-10-30 | 2002-08-01 | Government Of The United States | Method and apparatus for motion tracking of an articulated rigid body |
US20060066295A1 (en) * | 2004-09-29 | 2006-03-30 | C & N Inc. | Control method of controlling magnetic-field sensor, control device, and mobile terminal device |
US20080042973A1 (en) * | 2006-07-10 | 2008-02-21 | Memsic, Inc. | System for sensing yaw rate using a magnetic field sensor and portable electronic devices using the same |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011131497A1 (fr) * | 2010-04-23 | 2011-10-27 | Movea | Systeme d'analyse de foulees d'un utilisateur |
FR2959112A1 (fr) * | 2010-04-23 | 2011-10-28 | Movea | Systeme d'analyse de foulees d'un utilisateur |
US9538939B2 (en) | 2010-04-23 | 2017-01-10 | Movea | System for analyzing a user's strides |
WO2015091402A1 (fr) | 2013-12-18 | 2015-06-25 | Movea | Procede de determination de l'orientation d'un repere capteur lie a un terminal mobile muni d'un ensemble capteur, porte par un utilisateur et comprenant au moins un capteur de mouvement lie en mouvement |
Also Published As
Publication number | Publication date |
---|---|
FR2930335B1 (fr) | 2010-08-13 |
WO2009127561A1 (fr) | 2009-10-22 |
EP2268999A1 (fr) | 2011-01-05 |
US20110035172A1 (en) | 2011-02-10 |
US9297660B2 (en) | 2016-03-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1492998B1 (fr) | Dispositif de capture des mouvements de rotation d un solide | |
EP3658921B1 (fr) | Procédé de calibration d'un magnetometre | |
EP1984696B1 (fr) | Dispositif de capture de mouvement et procede associe | |
EP2718670B1 (fr) | Procede d'estimation simplifie de l'orientation d'un objet et centrale d'attitude mettant en oeuvre un tel procede | |
EP3807594B1 (fr) | Procédé de calibration de magnétomètres équipant un objet | |
EP3408612B1 (fr) | Procede d'estimation de l'activite physique d'un membre superieur | |
EP1969314B1 (fr) | Procede d'estimation d'un mouvement d'un solide | |
EP3655800B1 (fr) | Procédé et dispositif de mesure du champ magnétique par des magnétomètres | |
FR2930335A1 (fr) | Systeme et procede de determination de parametres representatifs de l'orientation d'un solide en mouvement soumis a deux champs vectoriels. | |
EP3427088B1 (fr) | Procédé de détection d'une anomalie dans le cadre de l'utilisation d'un dispositif de localisation magnétique | |
EP3655724B1 (fr) | Procédé d'estimation du mouvement d'un objet évoluant dans un champ magnétique | |
WO2019239063A1 (fr) | Procédé de calibration d'un gyromètre équipant un objet | |
FR2670300A1 (fr) | Systeme magnetique de mesure de position relative. | |
EP3230772B1 (fr) | Procédé de localisation d'au moins un objet magnétique mobile, et système associé | |
EP2271946B1 (fr) | Dispositif de detection d'evenement de percussion, et systeme mobile associe | |
EP2746722B1 (fr) | Procédé de détermination de l'inclinaison d'un objet | |
WO2013131990A1 (fr) | Procede d'identification des parametres geometriques d'une structure articulee et d'un ensemble de reperes d'interet disposes sur ladite structure | |
EP3008547B1 (fr) | Dispositif d'analyse de mouvement d'un element mobile et procede associe | |
EP3655725A1 (fr) | Procédé d'estimation du mouvement d'un objet évoluant dans un environnement et un champ magnétique | |
KR102393016B1 (ko) | 휴대용 장치의 방위를 추정하기 위한 방법 | |
EP4001851A1 (fr) | Procede d'alignement d'une pluralite de capteurs inertiels et/ou magnetiques et dispositif permettant la mise en oeuvre d'un tel procede |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PLFP | Fee payment |
Year of fee payment: 9 |
|
PLFP | Fee payment |
Year of fee payment: 10 |
|
PLFP | Fee payment |
Year of fee payment: 11 |
|
PLFP | Fee payment |
Year of fee payment: 13 |
|
PLFP | Fee payment |
Year of fee payment: 14 |
|
PLFP | Fee payment |
Year of fee payment: 15 |
|
ST | Notification of lapse |
Effective date: 20231205 |