Login| Sign Up| Help| Contact|

Patent Searching and Data


Title:
METHOD FOR COMPENSATING FOR CORIOLIS, CENTRIFUGAL AND GRAVITATIONAL COUPLES IN A MOVEMENT SIMULATOR AND SYSTEM COMPRISING A MOVEMENT SIMULATOR
Document Type and Number:
WIPO Patent Application WO/2017/220900
Kind Code:
A1
Abstract:
The invention relates to a method for compensating for disruptive couples for a movement simulator, said simulator including, for each axis, a monovariable correcting unit Corr(q'1) that receives a signal giving the difference between the setpoint θ r j and the measurement θ j for the corresponding axis and producing the control signal U j . According to the invention, the disruptive couples are coriolis, centrifugal and gravitational couples and furthermore a non-linear and multivariable compensating law is implemented that calculates a formula (a) estimating the disruptive couples, formula (a) being calculated on the basis of an error ε j (t) that is the control signal U j filtered by a filter H(q -1), and the simulator is modelled with a dynamic model expressing the couples in an affine way with respect to a set of base parameters ϰ according to a matrix relationship of the type: formula (b), and a subset j of base parameters, the estimation of the couples being formula (c), and, online, the αj are calculated via an iterative equation: formula (d) where ϕFj (t) = H(q-1)T(q-1)Φj(t) are the elements of the vectors formula (e) being filtered with H j Corr j G j /(1+C αj H j ), T being defined by the relationship 1 + Corr(q-1)L(q-1))⋅ T(q-1) = Corr(q-1)L(q-1) where L j (q -1) is the discreet transmittance of the transform of the product formula (f) where J j are inertias and μ1· is a positive real definite square matrix.

Inventors:
VAU BERNARD (FR)
BUSSUTIL MEHDI (FR)
Application Number:
PCT/FR2017/051582
Publication Date:
December 28, 2017
Filing Date:
June 16, 2017
Export Citation:
Click for automatic bibliography generation   Help
Assignee:
IXBLUE (FR)
International Classes:
G05B19/404; G01C25/00; G05B13/04
Foreign References:
EP2116912A12009-11-11
EP1630070A12006-03-01
EP1847892A22007-10-24
EP2571159A22013-03-20
EP2116912A12009-11-11
EP1630070A12006-03-01
EP1847892A22007-10-24
EP2571159A22013-03-20
Other References:
HOROWITZ ET AL.: "Model referenced adaptive control of a two axes direct drive manipulator arm", PROC. IEEE INTERNATIONAL CONFÉRENCE ON ROBOTICS AND AUTOMATION, RALEGH, 1987
J. CRAIG: "Adaptive control of mechanical manipulators", PROC. IEEE, INTERNATIONAL CONFÉRENCE ON ROBOTICS AND AUTOMATION, 1986
SLOTINE; LI: "Applied non linear control", 1991, PRENTICE HALL
"A new géométrie notation for open and closed-loop robots", IEEE INTERNATIONAL CONFÉRENCE ON ROBOTICS AND AUTOMATION, SAN FRANCISCO, April 1986 (1986-04-01)
Attorney, Agent or Firm:
CHAUVIN, Vincent et al. (FR)
Download PDF:
Claims:
REVENDICATIONS

1 . Procédé de compensation de couples perturbateurs pour un simulateur de mouvements, ledit simulateur comportant des articulations commandées par des organes effecteurs selon des axes y en fonction de consignes (fj de mouvements sur les axes, chaque organe effecteur d'un axe donné spécifique de l'organe effecteur recevant une commande Uj et un capteur de l'axe mesurant θj l'action de l'organe effecteur selon ledit axe y, le simulateur étant dans un système comportant pour chaque axe une loi de commande avec un bloc correcteur monovariable dans une boucle de rétroaction, ledit bloc correcteur monovariable de fonction de transfert Corr(q'1) recevant en entrée un signal d'écart entre la consigne (fj et la mesure θj pour l'axe correspondant et produisant en sortie la commande Uj,

caractérisé en ce que les couples perturbateurs sont des couples de Coriolis, centrifuges et de gravité et en ce qu'on met en œuvre pour chaque axe, une loi de commande comportant, en outre du bloc correcteur monovariable par axe, une loi de compensation non-linéaire et multivariable combinée aux correcteurs monovariables, la loi de compensation calculant en fonction de la commande Uj une estimation des couples perturbateurs, ladite estimation Pj(t) étant injectée à la commande Uj envoyée à l'organe effecteur pour compenser les couples perturbateurs, et

en ce que l'estimation des couples perturbateurs est calculée à partir

de la valeur d'un signal d'erreur qui est une version filtrée de la commande Uj par un filtre de transmittance H(q_1) destiné à éliminer au moins la composante continue de la commande et qu'on modélise préalablement le simulateur de mouvement afin d'obtenir un modèle dynamique exprimant les couples de façon affine par rapport à un ensemble de paramètres de base χ suivant une relation matricielle du type : , l'indice j correspondant aux différents axes, qu'on détermine suite à la modélisation préalable du simulateur un sous-ensemble αj des paramètres de base correspondant à des couples perturbateur s ayant un niveau supérieur à un seuil de perturbation déterminé, l'estimation j des couples perturbateurs étant calculée par :

et

en ce qu'on calcule en ligne les estimations du sous-ensemble des paramètres de base par une équation itérative :

les éléments des vecteurs étant filtrés par pour

obtenir le vecteur

T étant défini par la relation

la transmittance discrète de la transformée du produit dans le cas d'un système échantillonne ou Jj sont les inerties et μj· est

une matrice carrée définie réelle positive servant de paramètre de réglage de la vitesse de convergence de l'estimation.

2. Procédé selon la revendication 1 , caractérisé en ce que lors du calcul de l'estimation des couples perturbateurs, on néglige les effets de la variation

de la matrice d'inertie.

3. Procédé selon la revendication 1 ou la revendication 2, caractérisé en ce que le filtre de transmittance destiné à éliminer la composante continue de la commande est un filtre passe haut.

4. Procédé selon l'une quelconque des revendications précédentes, caractérisé en ce qu'on met en œuvre une compensation adaptative en temps réel dans laquelle les estimations du sous-ensemble des paramètres de base sont calculées préalablement et stockées dans des tables, dans lequel procédé, - dans une phase préalable :

- pour chaque effet non linéaire de chaque axe, on choisit un mouvement sensibilisant sur un ou plusieurs autres axes à vitesse constante conduisant à une perturbation significative sur le couple dudit axe,

- on calcule des estimations du sous-ensemble des paramètres de base par l'équation itérative jusqu'à convergence,

- dans une phase de mise en œuvre en temps réel, on utilise directement les tables de paramètres de base pour calculer l'estimation des couples

perturbateurs par

5. Procédé selon la revendication 4, caractérisé en ce que la convergence correspond à ce que la valeur du signal d'erreur tend vers zéro.

6. Procédé selon l'une quelconque des revendications précédentes, caractérisé en ce qu'on met en œuvre un algorithme du gradient récursif.

7. Procédé selon l'une quelconque des revendications précédentes, caractérisé en ce que le simulateur de mouvement est utilisé à vitesse constante ou à faible taux de variation de vitesse dans la phase d'estimation des estimées

8. Procédé selon l'une quelconque des revendications précédentes, caractérisé en ce qu'on met en œuvre un simulateur de mouvement à au moins deux axes commandés et comportant pour chaque axe une loi de commande avec un bloc correcteur monovariable dans une boucle de rétroaction, ledit correcteur recevant en entrée un signal d'écart entre la consigne θrj et la mesure θj pour l'axe correspondant et produisant en sortie la commande Uj destinée à un organe effecteur, et en ce qu'on rajoute entre la sortie du bloc correcteur et l'organe effecteur un module matériel de calcul de loi de compensation et de compensation de la commande, ledit module étant soit un programme informatique chargé sur un support et destiné à compléter un programme informatique du bloc correcteur monovariable, soit un équipement électronique et programmable de capture de la commande en sortie du bloc correcteur et de restitution au moteur d'une commande compensée par la loi de compensation.

9. Procédé selon l'une quelconque des revendications précédentes, caractérisé en ce qu'on utilise un modèle d'articulation dans lequel les inerties des différentes articulations sont indépendantes les unes des autres, les tenseurs d'inertie des articulations du simulateur de mouvement étant une matrice diagonale.

1 0. Système à simulateur de mouvements comportant un simulateur de mouvements et des moyens de compensation de couples perturbateurs, ledit simulateur comportant des articulations commandées par des organes effecteurs selon des axes y en fonction de consignes θrj de mouvements sur les axes, chaque organe effecteur d'un axe donné spécifique de l'organe effecteur recevant une commande Uj et un capteur de l'axe mesurant θj l'action de l'organe effecteur selon ledit axe y, le système comportant pour chaque axe une loi de commande avec un bloc correcteur monovariable dans une boucle de rétroaction, ledit bloc correcteur recevant en entrée un signal d'écart entre la consigne θrj et la mesure θj pour l'axe correspondant et produisant en sortie la commande Uj, caractérisé en ce que les moyens de compensation de couples perturbateurs sont un calculateur programmable spécialement configuré pour exécuter le procédé de l'une quelconque des revendications précédentes.

Description:
PROCEDE DE COMPENSATION DES COUPLES DE CORIOLIS, CENTRIFUGES ET DE GRAVITE DANS UN SIMULATEUR DE MOUVEMENTS, SYSTEME A SIMULATEUR DE

MOUVEMENTS DOMAINE TECHNIQUE AUQUEL SE RAPPORTE L'INVENTION

La présente invention concerne de manière générale le domaine des systèmes de test notamment destinés à des équipements de mesure pouvant être soumis à des mouvements et qui sont testés en étant soumis à des mouvements contrôlés. Elle concerne plus particulièrement un procédé de compensation des couples de Coriolis, centrifuges et de gravité dans un simulateur de mouvement. Un système comportant un simulateur de mouvements adapté à réaliser cette compensation complète l'invention.

ETAT DE L'ART

Les simulateurs de mouvements sont des machines tournantes destinées à tester des équipements comportant en particulier des composants inertiels, par exemple des gyromètres, accéléromètres et centrales inertielles. En fonction des tests à effectuer sur ces composants, l'utilisateur peut avoir recours à des simulateurs constitués de 1 , 2, 3 voire 4 articulations imbriquées les unes dans les autres, dans une structure mécanique s'apparentant à celle d'un cardan. Chacune des articulations dudit simulateur possède au moins un actionneur, qui en général est un moteur électrique dont on commande le couple. Ce moteur électrique peut être un moteur à courant continu, un moteur à courant alternatif, avec ou sans balai (brushless). L'actionneur peut parfois être de type hydraulique, la commande se faisant alors par l'intermédiaire d'un fluide dont les paramètres sont contrôlés (notamment la pression, le débit). Les positions angulaires des articulations sont mesurées au moyen de capteurs de position pouvant être en particulier des codeurs incrémentaux. Dans certains cas, des capteurs de vitesse angulaires sont également présents sur ces machines, par exemple avec un tachymètre.

Les positions et/ou vitesses angulaires sont asservies grâce à une loi de commande avec correcteur implémenté dans un calculateur programmable, typiquement un micro-ordinateur et/ou un équipement informatique de traitement de signaux numériques (DSP). A partir des consignes de positions/vitesses fournies par l'utilisateur via un générateur de trajectoire, et à partir des mesures de positions ou vitesses angulaires, la loi de commande fournit une commande, en particulier de couple, qui est appliquée sur l'amplificateur du moteur de chacune des articulations. Les simulateurs de mouvements sont des machines de test, et pour cette raison, leurs axes asservis doivent suivre des consignes de position et de vitesse avec une grande précision. Si le simulateur de mouvements possède au moins deux articulations, des phénomènes mécaniques d'interaction entre les articulations surviennent. Ces phénomènes sont nommés couplages. Cela signifie que la position/vitesse d'une articulation n'est pas totalement indépendante des positions/vitesses des autres articulations qui provoquent des couples perturbateurs sur ladite articulation. Dans le vocabulaire des automaticiens, un simulateur de mouvements est un système intrinsèquement multivariable. Ces couplages sont aisément modélisables, car ils correspondent à des phénomènes physiques bien connus. Ces couplages sont non-linéaires et résultent des couples de Coriolis, centrifuges, et de gravité.

Les simulateurs de mouvements classiques incorporent des lois de commande qui généralement sont dites monovariables : cela signifie que la commande de couple produite par l'asservissement d'une articulation n'est établie qu'à partir de la position ou vitesse de consigne et la position ou vitesse mesurée de ladite articulation. En particulier, les positions et vitesses des autres articulations ne sont pas explicitement prises en compte dans ces lois de commande classiques. La figure 1 de l'état de la technique, qui sera décrite en détail plus loin, et qui représente un simulateur comprenant trois articulations avec sa commande utilisant des correcteurs, schématise cet état de fait.

Aussi, les lois de commande classiques des simulateurs ne compensent-t- elles les phénomènes non-linéaires de couplage qu'indirectement : les couplages sont perçus par le correcteur comme une perturbation sur le couple de l'articulation et cette perturbation est compensée - plus ou moins bien - par le correcteur, en fonction de sa réponse fréquentielle.

Dans certains modes de fonctionnement particuliers du simulateur de mouvements, en particulier si les vitesses de rotations de plusieurs articulations sont simultanément élevées, plusieurs centaines de °/s (degrés par seconde), les phénomènes de couplages peuvent compromettre gravement les performances en stabilité de vitesse de chacune des articulations du simulateur. Cela, même si les lois de commandes monovariables ont des performances dynamiques optimales.

Compte tenu des fortes exigences en termes de performance et de stabilité de position et vitesse des simulateurs de mouvements, il est donc indispensable de développer des lois de commande qui permettent de prendre en compte explicitement toutes les articulations et leurs couplages.

A cette fin, les lois de commande multivariables sont particulièrement indiquées. Grâce à ce type de loi de commande, la commande en couple d'une articulation issue du correcteur dépend non seulement de la position et/ou vitesse de ladite articulation, mais également des positions et/ou vitesses des autres articulations. Une loi de commande multivariable, par définition, prend en compte de façon explicite ces phénomènes de couplage, afin de les compenser au mieux et d'en atténuer de façon significative les effets néfastes.

On connaît par le document EP 2 1 16 912 A1 un procédé de rejet robuste de perturbations périodiques qui met en œuvre une structure de contrôle faisant intervenir un paramètre de Youla associé à un correcteur central. Il s'agit là d'une structure de type « rétroaction » ou feedback alors que la présente invention met en œuvre une boucle de type « feedforward », la compensation étant opérée à partir de signaux de références externes à la boucle d'asservissement sur laquelle porte la compensation. Un des avantages d'une telle structure est de s'affranchir des contraintes de stabilité relatives à une structure de type feedback. On connaît également les documents EP 1 630 070, EP 1 847 892 A2 et EP 2 571 159 A2.

ARRIERE-PLAN TECHNOLOGIQUE

Dans le domaine de la robotique, la question de la compensation des couples de Coriolis, centrifuges et de gravité a été abordée dans un certain nombre de publications.

On peut en particulier mentionner la méthode dite des couples calculés, les méthodes basées sur la théorie de la passivité, ou encore les méthodes basées sur les principes de Lyapounov d'analyse de la stabilité. Cependant, ces méthodes supposent qu'on dispose d'un modèle dynamique complet du robot, par exemple obtenu par identification. Dans les cas où les paramètres dudit modèle ne sont pas connus, on est contraint d'avoir recours à des techniques adaptatives, permettant d'estimer en ligne/temps réel ces paramètres. Les techniques adaptatives les plus classiques sont celles qui reprennent des concepts adaptatifs développés pour les systèmes linéaires (par exemple Horowitz et al. : « Model referenced adaptive control of a two axes direct drive manipulator arm », Proc. IEEE international conférence on robotics and automation, Ralegh, 1987). D'autres méthodes utilisent des principes basés sur la formulation d'un découplage non-linéaire et une commande adaptative linéarisante (J. Craig : « Adaptive control of mechanical manipulators, Proc. IEEE, International conférence on robotics and automation, 1986). On peut encore mentionner des techniques basées sur la formulation d'une commande adaptative basée sur les propriétés de passivité des robots (Slotine et Li : « Applied non linear control, Prentice Hall, 1991 ).

Toutes ces techniques sont développées dans le cadre général de la robotique, et elles sont donc basées sur les contraintes rencontrées en robotique.

Or dans le domaine des simulateurs de mouvements, les contraintes et spécificités sont différentes, en particulier la possibilité qu'il n'y ait aucune contrainte minimale ou maximale de position angulaire. Cette propriété permet en particulier de maintenir pendant un long intervalle de temps des mouvements axiaux à vitesse constante, et elle est exploitée dans la présente invention. Une autre particularité d'un simulateur de mouvements est qu'il possède de nombreuses symétries et qu'en règle générale, les multiples axes de rotation sont concourants, ce qui simplifie le modèle et permet, la plupart du temps, de considérer la matrice d'inertie du modèle dynamique comme constante ou quasi constante.

OBJET DE L'INVENTION

Afin de remédier à l'inconvénient précité de l'état de la technique, la présente invention propose un procédé de compensation de couples perturbateurs pour un simulateur de mouvements, ledit simulateur comportant des articulations commandées par des organes effecteurs selon des axes y en fonction de consignes de mouvements sur les axes, chaque organe effecteur d'un axe

donné spécifique de l'organe effecteur recevant une commande U j et un capteur de l'axe mesurant θ j l'action de l'organe effecteur selon ledit axe y, le simulateur étant dans un système comportant pour chaque axe une loi de commande avec un bloc correcteur monovariable dans une boucle de rétroaction, ledit bloc correcteur monovariable de fonction de transfert recevant en entrée un signal d'écart entre la consigne et la mesure θ j pour l'axe correspondant et produisant en sortie la commande U j .

Selon l'invention, les couples perturbateurs sont des couples de Coriolis, centrifuges et de gravité et on met en œuvre pour chaque axe, une loi de commande comportant, en outre du bloc correcteur monovariable par axe, une loi de compensation non-linéaire et multivariable combinée aux correcteurs monovariables, la loi de compensation calculant en fonction de la commande U j une estimation des couples perturbateurs, ladite estimation étant

injectée à la commande U j envoyée à l'organe effecteur pour compenser les couples perturbateurs, et l'estimation des couples perturbateurs est calculée à partir de la valeur d'un signal d'erreur qui est une version filtrée de la

commande U j par un filtre de transmittance H( _1 ) destiné à éliminer au moins la composante continue de la commande et on modélise préalablement le simulateur de mouvement afin d'obtenir un modèle dynamique exprimant les couples de façon affine par rapport à un ensemble de paramètres de base χ suivant une relation matricielle du type l'indice j correspondant aux différents

axes, on détermine suite à la modélisation préalable du simulateur un sous- ensemble c¾ des paramètres de base correspondant à des couples perturbateurs ayant un niveau supérieur à un seuil de perturbation déterminé, l'estimation des couples perturbateurs étant calculée par : et on calcule

en ligne les estimations du sous-ensemble des paramètres de base par une équation itérative :

les éléments des vecteurs étant filtrés par pour

obtenir le vecteur ;

T étant défini par la relation

la transmittance discrète de la transformée du produi dans le cas d'un système échantillonne ou J j sont les inerties et μ,- est

une matrice carrée définie réelle positive servant de paramètre de réglage de la vitesse de convergence de l'estimation.

D'autres caractéristiques non limitatives et avantageuses du procédé conforme à l'invention, prises individuellement ou selon toutes les combinaisons techniquement possibles, sont les suivantes :

- lors du calcul de l'estimation des couples perturbateurs, on néglige les effets de la variation de la matrice d'inertie,

- le filtre de transmittance destiné à éliminer la composante continue de la

commande est un filtre passe haut,

- le filtre de transmittance destiné à éliminer la composante continue de la commande est un filtre passe bande,

- on met en œuvre une compensation adaptative en temps réel dans laquelle les estimations du sous-ensemble des paramètres de base sont calculées préalablement et stockées dans des tables, et dans lequel :

- dans une phase préalable :

- pour chaque effet non linéaire de chaque axe, on choisit un mouvement sensibilisant sur un ou plusieurs autres axes à vitesse constante conduisant à une perturbation significative sur le couple dudit axe,

- on calcule des estimations du sous-ensemble des paramètres de base par l'équation itérative

jusqu'à convergence,

- dans une phase de mise en œuvre en temps réel, on utilise directement les tables de paramètres de base pour calculer l'estimation des couples perturbateurs par

- la convergence correspond à ce que la valeur du signal d'erreur tend vers zéro,

- on met en œuvre un algorithme du gradient récursif, - le simulateur de mouvement est utilisé à vitesse constante ou à faible taux de variation de vitesse dans la phase d'estimation des estimées ,

- on met en œuvre un simulateur de mouvement à au moins deux axes commandés et comportant pour chaque axe une loi de commande avec un bloc correcteur monovariable dans une boucle de rétroaction, ledit correcteur recevant en entrée un signal d'écart entre la consigne et la mesure θ j pour l'axe

correspondant et produisant en sortie la commande U j destinée à un organe effecteur, et on rajoute entre la sortie du bloc correcteur et l'organe effecteur un module matériel de calcul de loi de compensation et de compensation de la commande, ledit module étant soit un programme informatique chargé sur un support et destiné à compléter un programme informatique du bloc correcteur monovariable, soit un équipement électronique et programmable de capture de la commande en sortie du bloc correcteur et de restitution au moteur d'une commande compensée par la loi de compensation,

- on utilise un modèle d'articulation dans lequel les inerties des différentes articulations sont indépendantes les unes des autres, les tenseurs d'inertie des articulations du simulateur de mouvement étant une matrice diagonale,

L'invention concerne également un système à simulateur de mouvements comportant un simulateur de mouvements et des moyens de compensation de couples perturbateurs, ledit simulateur comportant des articulations commandées par des organes effecteurs selon des axes y en fonction de consignes θ r j de mouvements sur les axes, chaque organe effecteur d'un axe donné spécifique de l'organe effecteur recevant une commande U j et un capteur de l'axe mesurant θ j l'action de l'organe effecteur selon ledit axe y, le système comportant pour chaque axe une loi de commande avec un bloc correcteur monovariable dans une boucle de rétroaction, ledit bloc correcteur recevant en entrée un signal d'écart entre la consigne θ r j et la mesure θ j pour l'axe correspondant et produisant en sortie la commande U j et dans lequel système, les moyens de compensation de couples perturbateurs sont un calculateur programmable spécialement configuré pour exécuter le procédé de l'invention.

DESCRIPTION DÉTAILLÉE D'UN EXEMPLE DE RÉALISATION

La description qui va suivre en regard des dessins annexés, donnés à titre d'exemples non limitatifs, fera bien comprendre en quoi consiste l'invention et comment elle peut être réalisée.

Sur les dessins annexés :

- la figure 1 représente un simulateur de mouvements commandé de l'état de la technique avec pour chaque axe commandé sa propre loi de commande monovariable avec correcteur et à boucle de rétroaction, - la figure 2 représente un bloc diagramme simplifié du modèle dynamique d'une articulation prenant en compte, outre les frottements, les effets des couples de Coriolis, centrifuge et de gravité (parfois nommé balourd)

- la figure 3 représente un bloc diagramme simplifié d'une application du modèle dynamique de la figure 2 à une loi de commande monovariable avec correcteur et à boucle de rétroaction, dans le cas d'un asservissement en position,

- la figure 4 représente un bloc diagramme simplifié du type de l'application de la figure 3 mais cette fois dans le cas d'un asservissement en vitesse, l'intégration finale de la vitesse pour obtenir la position pouvant alors être omise,

- la figure 5 représente un bloc diagramme simplifié du type de l'application de la figure 3 mais avec une réorganisation des blocs pour isoler les effets des couples de Coriolis, centrifuge et de gravité,

- la figure 6 représente un bloc diagramme simplifié sur la base de celui de la figure 5 avec introduction d'une loi de compensation des effets des couples de Coriolis, centrifuge et de gravité par injection dans la boucle d'une estimation de ces derniers effets à partir d'un signal d'erreur obtenu à partir du signal de couple moteur produit par le correcteur, et

- les figures 7 et 8 représentent deux blocs diagrammes simplifiés sur la base de celui de la figure 6 dans deux modes d'application de l'invention, un second mode, (Fig.7) adaptatif, pour des vitesses constantes avec calculs en ligne/temps réel d'un sous-ensemble vectoriel de paramètres de base pertinents et un premier mode, (Fig.8) non adaptatif, avec utilisation du sous-ensemble vectoriel de paramètres de base pertinents calculés dans le second mode et alors mémorisés.

En relation avec la figure 1 de l'état de la technique, on va commencer par décrire l'état de la technique afin de faciliter la présentation ultérieure de l'invention à partir d'éléments connus. Sur cette figure 1 , un simulateur de commande comportant trois articulations, qu'on assimilera par la suite à des axes, est commandé en fonction de consignes individuelles sur chacun des axes.

Un axe correspond à un effecteur/moteur et à un capteur et dans le cas où une articulation du simulateur correspond à un effecteur/moteur et à un capteur, on peut assimiler l'articulation à un axe. Dans le cas où l'articulation est complexe, par exemple avec plusieurs effecteurs et/ou plusieurs capteurs, on pourra la ramener à un ensemble d'axes qu'on pourra traiter comme décrit. Il en est de même dans le cas d'une articulation avec un effecteur/moteur et plusieurs capteurs ou plusieurs moteurs et un seul capteur.

Un bloc correcteur monovariable est mis en œuvre sur chaque axe avec une boucle de rétroaction et mesure de la position angulaire sur l'axe correspondant. Dans cette description, le terme « correcteur » couvre un bloc correcteur monovariable tel qu'utilisé classiquement, c'est-à-dire sans prise en compte des interactions entre les axes, sans compensation des couples de Coriolis, centrifuges et de gravité.

Sur la figure 1 , les variables : correspondant aux positions angulaires des axes, sont les consignes des positions angulaires desdits

axes et sont les commandes issues des correcteurs monovariables et

attaquant les amplificateurs de puissance des moteurs du simulateur. Un correcteur est mis en œuvre par axe commandé.

Les correcteurs peuvent posséder, comme sur la figure, un degré de liberté, et être par exemple de type PI D, ou encore 2 degrés de liberté, par exemple RST, LQG, commande prédictive, H-infini ... Ces correcteurs sont essentiellement linéaires. Les consignes sont fournies par un générateur de consignes

qui lui-même agit en fonction des ordres fournis par l'utilisateur du simulateur de mouvements.

Par ailleurs, en lui-même, un simulateur de mouvements est modélisable au moyen des outils traditionnels de la robotique. On peut en particulier, afin de déterminer le modèle dynamique du simulateur de mouvements, utiliser les équations d'Euler-Lagrange :

Avec :

: vecteur des positions angulaires de chaque axe,

: vecteur des vitesses angulaires de chaque axe,

: vecteur des couples produits par les moteurs de chaque axe, et

est le Lagrangien du système qui est par définition :

où :

est l'énergie cinétique totale du simulateur,

son énergie potentielle.

L'équation fondamentale de la dynamique des systèmes robotiques s'écrit alors :

Avec :

vecteur des accélérations angulaires de chaque axe,

est une matrice carrée qui est nommée matrice d'inertie, est la matrice carrée des couples centrifuges et Coriolis,

est le vecteur des couples de gravité,

est le vecteur des couples de frottements.

dépendent de la géométrie du simulateur de

mouvements et en particulier des tenseurs d'inertie de chacune des articulations, des positions des centres de masse par rapport aux axes de rotation, etc .. Le modèle dynamique du robot peut être obtenu en employant diverses conventions utilisées en robotique, en particulier la convention de Denavit-Hartenberg ou, encore, la convention de Denavit-Hartenberg modifiée (décrite dans l'article : « A new géométrie notation for open and closed-loop robots », in I EEE international conférence on robotics and automation, San francisco, April 1 986).

En particulier, en utilisant la convention de Denavit-Hartenberg modifiée, on montre qu'on obtient un modèle dynamique linéaire par rapport à un ensemble de paramètres χ, dits paramètres de base, suivant une relation matricielle du type :

Dans la matrice Φ, les termes dépendant de Θ sont forcément reliés aux coefficients de la matrice d'inertie.

Ainsi, le couple I)de l'articulation j pour 1≤ j≤ N où N est le nombre d'articulations peut être réécrit :

où les dépendent des positions angulaires des axes (c'est-à-dire

du vecteur Θ) et des paramètres de base (c'est-à-dire de χ). Alors que Fj dépend des vitesses angulaires des axes (c'est-à-dire du vecteur Θ).

Le couple de frottement Fj est décomposable entre un couple de frottements secs qui est considéré en première approximation, proportionnel au signe de , et un couple de frottement visqueux qui est considéré en première

approximation, proportionnel à Sous ces conditions de première approximation,

on remarque qu'à vitesse constante d'une articulation, et donc sans accélération, le couple de frottement est constant et qu'il peut donc être éliminé par un filtrage passe haut ou à tout le moins éliminant les composantes continues.

Dans le cadre de la procédure de réglage de la loi de compensation des couples de Coriolis, centrifuges et de gravité, on fait les approximations suivantes :

1 ) que la matrice d'inertie du simulateur de mouvements a des termes indépendants du vecteur Θ qui est le vecteur des positions angulaires.

2) que la matrice d'inertie du simulateur de mouvements est diagonale.

La première approximation est assez bien justifiée en général, compte tenu de la géométrie des simulateurs de mouvements. La seconde se justifie par le fait que les tests réalisés dans le cadre du réglage de la loi de compensation se font à vitesse constante et donc à accélération nulle, comme on le verra plus loin lors de la mise en œuvre de la loi de commande multivariable de l'invention. Ces deux approximations reviennent à dire qu'on a pour la matrice d'inertie :

Sous ces conditions d'approximation, il est possible de déterminer, pour chaque articulation du simulateur, un bloc diagramme décrivant le modèle dynamique du système et qui est schématisé sur la figure 2.

Dans le cadre de l'application d'une loi de commande classique, c'est-à-dire monovariable, on peut utiliser un modèle dynamique linéarisé simplifié (c'est-à- dire qui ignore les effets Coriolis, centrifuges de gravités, et les frottements secs) du système développé ci-dessus. La loi de commande classique monovariable avec correcteur obtenue est schématisée pour respectivement un asservissement en position et en vitesse sur les figures 3 et 4.

Le rôle du correcteur est d'assurer le suivi de consigne de position ou de vitesse et donc de compenser les couples perturbateurs. Suivant la dynamique de ce correcteur, les couples perturbateurs sont plus ou moins bien compensés. En particulier, plus la dynamique du correcteur est élevée et mieux le rejet de la perturbation est assuré, et moins l'effet de la perturbation se manifeste sur la variable asservie, que ce soit la vitesse ou la position.

Cependant, dans bien des cas, même si le correcteur est réglé de façon optimale afin d'avoir une dynamique importante, ces perturbations sont trop imparfaitement compensées du fait qu'on met en œuvre des correcteurs monovariables et donc que les interactions/couplages entre articulations/axes ne sont pas prises en compte globalement.

C'est donc pour cela qu'il est proposé avec la présente invention un moyen assurant une compensation plus efficace des perturbations non-linéaires, en particulier des couples de Coriolis, centrifuges, et de gravité, que celle que peuvent fournir les correcteurs classiques monovariables seuls vus précédemment, et de façon à minimiser l'impact desdites perturbations sur les grandeurs asservies.

On va donc maintenant décrire la loi de compensation proposée qui est non-linéaire et multivariable ainsi que sa méthode de réglage.

Tout d'abord, on suppose connus les inerties /,· ainsi que les gains d'amplificateur K aJ , et les constantes de couple K mj des moteurs. En d'autres termes, on connaît directement ou indirectement le rapport aj ^ mj ,

Le terme « gains d'amplificateur » doit ici être entendu au sens large et comme pouvant inclure des gains d'éventuels convertisseurs numériques- analogiques, convertisseurs analogiques-numériques et de réducteurs ou autres élément de la boucle.

On pose Kj. le gain global entre la commande issue de la loi de commande et le couple produit par le ou les moteurs de l'axe j.

De même, on suppose connues les fonctions de transfert de

chaque correcteur monovariable.

Pour cela, on aura identifié le modèle dynamique linéarisé du système formé par le simulateur et réglé la loi de commande monovariable, c'est-à-dire le correcteur, telle que présentée précédemment afin de récupérer ces données. Les constantes de couple moteur sont des données des constructeurs des moteurs. Les gains d'amplificateur sont des données mesurables ou calculables selon les cas. Les inerties sont obtenues par identification et sur cette question, on peut se référer à l'ouvrage de L.Ljung « identification, Theory for the user », Prentice Hall

Dans une variante de mise en œuvre, on peut faire des estimations ou hypothèses sur le modèle et notamment sur les inerties, voir les calculer à partir d'une analyse d'une représentation informatique modélisée du simulateur.

La loi de commande à compensation multivariable et correcteur monovariable proposée peut être déclinée en deux modes d'application de la loi de compensation :

- un premier mode pour compensation non adaptative des couples perturbateurs en utilisant des paramètres prédéterminés préalablement, et

- un second mode pour estimation et compensation en ligne/temps réel des paramètres nécessaires à l'application du premier mode.

Le second mode d'estimation en ligne, qu'on peut qualifier d'adaptatif, est utilisé dans une phase de réglage de la loi de compensation permettant de déterminer les paramètres utiles au premier mode. Dans une phase d'application fonctionnelle à des tests, on utilise de préférence le premier mode de compensation des couples perturbateurs en utilisant les paramètres prédéterminés précédemment avec le second mode.

On va dans, un premier temps, décrire le second mode d'estimation des paramètres utiles à la loi de compensation.

Dans la phase de réglage, la loi adaptative est basée sur le fait que si un axe j tourne à vitesse constante et si on considère que le couple de frottements secs est constant sur 360° , et dans l'hypothèse où il n'y a ni couples de Coriolis, centrifuge ou de gravité qui sont donc nuls, alors la sortie du correcteur Uj (t) est constante. Inversement, toujours à vitesse constante, mais dans l'hypothèse de la présence de couples de Coriolis, centrifuges, et de gravité, alors la commande Uj (t) n'est plus constante du fait de la contre-réaction qu'entraîne la présence de la boucle. Comme on le verra, un filtrage permet de séparer les éléments non constants de ceux qui le sont.

On va maintenant utiliser une représentation du système bouclé qui permet d'isoler les effets des couples de Coriolis, centrifuges et de gravité par rapport aux autres effets mentionnés précédemment.

Posons P j (t) comme étant égal à la somme des couples de Coriolis, centrifuges et de gravité agissant sur l'axe j, le tout multiplié par l'inverse du gain de l'amplificateur K aJ et par l'inverse de la constante de couple du moteur K mj , soit :

Avec ces conventions, un schéma simplifié de la boucle de contrôle propre à une articulation peut être modélisée suivant le schéma de la figure 5 dans le cas d'un asservissement en position.

Pour obtenir une compensation des effets des couples de Coriolis, centrifuges, et de gravité, il suffit alors d'injecter une compensation , qui est

une estimation de P j (t), en sortie du correcteur suivant le schéma de la figure 6.

La loi de compensation adaptative du second mode s'utilise lorsque la consigne de vitesse est constante. Cette loi consiste à minimiser le carré ou, dans une variante la somme des carrés, d'un signal d'erreur ε j (t), correspondant à la commande U j (t) passée par un filtre passe-haut destiné à éliminer la composante continue de U j (t) et dont la transmittance discrète est notée H(q -1 ), où q -1 est l'opérateur retard dans ce système échantillonné.

Posons L j (z) la transformée en z du système muni d'un échantillonner

bloqueur, et la transmittance discrète associée.

Compte tenu de la représentation de la figure 6, on a :

Mais compte tenu de la relation (4) qui exprime les couples perturbateurs de façon affine par rapport aux paramètres de bases, on peut déduire les relations (9), (10), (1 1 ) où les composantes des vecteurs αj forment un sous-ensemble de χ tel qu'il est défini par la relation (4). En d'autres termes, on gardera les composantes de αj qui sont les éléments de χ qui ont un impact sur les couples de Coriolis, centrifuges, et de gravité de l'axe j :

Il y a donc une relation générique du type (12): Ce sous-ensemble comporte donc les composantes des αj les plus significatives, c'est-à-dire les paramètres de base pour lesquels les couples perturbateurs associés sont les plus élevés, en pratique supérieurs à un seuil qu'on aura déterminé. On comprend donc qu'en fonction du seuil et donc du niveau de significativité choisi, la compensation sera plus ou moins précise. Par exemple, à partir d'une modélisation théorique on déterminera préalablement les paramètres de base qui produisent le couple perturbateur le plus élevé

La dépendance de φ ; · en est omise compte tenu du fait que la loi

adaptative est destinée à fonctionner à des vitesses constantes ou quasi- constantes, correspondant à des accélérations nulles ou quasi-nulles.

En effet, le simulateur de mouvement est ici utilisé à vitesse de mouvement constante et s'il y a variation de vitesse, celle-ci doit être la plus faible possible, par exemple inférieure à 1 %.

Soit l'estimée de αj . L'estimée de P j (t), notée s'écrit :

Ainsi le signal ε(t) peut s'exprimer suivant :

La relation précédente (14) conduit à proposer la formule d'estimation suivante :

où μ ; · est une matrice carrée définie réelle positive, qui sert de paramètre de réglage de la vitesse de convergence de l'estimation. Cette formule résulte de l'application de l'algorithme du gradient récursif.

Selon la théorie de la passivité, une condition suffisante de convergence de la formule de convergence (15) est donnée par la condition suivante :

Cette condition de convergence peut parfois se révéler contraignante, aussi est-il préférable de s'en affranchir par un filtrage approprié de φ j (t). Ce filtrage consiste à filtrer les composantes de la matrice par pour

obtenir la matrice

Définissons T(q -1 ) tel que :

On propose finalement la loi de compensation :

Si le vecteur est décorrélé du bruit de la boucle j, alors l'estimation du vecteur est non biaisée.

La figure 7 représente l'ensemble de la loi de commande mettant en œuvre cette loi de compensation avec d'estimation en ligne des â ; -et qui correspond au second mode d'estimation en ligne qui permet de calculer les paramètres utiles à la compensation.

Dans ce second mode, la loi de commande de la figure 7 peut être utilisée en tant que telle pour obtenir la compensation lors de l'utilisation du simulateur de mouvements pour effectuer des tests sur des équipements de mesure.

Toutefois, la compensation n'est efficace/obtenue que pour des mouvements à vitesse constante et lorsqu'on modifie une ou des vitesses de mouvement dans le simulateur, il peut se produire des transitoires nuisibles à la compensation, mais aussi à la qualité de l'estimation.

En conséquence, il est préféré le premier mode représenté sur la figure 8 pour la compensation lors des tests sur simulateur de mouvements, correspondant à une phase d'utilisation fonctionnelle du simulateur de mouvements et qui utilise les résultats de la loi de commande de la figure 7, les résultats (paramètres de base) étant stockés pour une utilisation ultérieure avec la loi de commande correspondant à la figure 8.

Pour pouvoir pleinement utiliser ce premier mode de la figure 8, la démarche suivante qui passe par le second mode est utilisée :

- pour chaque effet non linéaire de chaque axe, on choisit un mouvement sensibilisant à vitesse constante conduisant à une perturbation significative sur un ou plusieurs autres axes. On répète donc ce processus pour traiter tous les axes.

- on applique la loi adaptative du second mode, c'est-à-dire selon la loi de commande de la figure 7 jusqu'à la convergence, c'est-à-dire que le signal ε(ί) tend vers 0 et donc que les paramètres de base deviennent constants à la précision souhaitée.

- après convergence, les paramètres de base estimés deviennent/sont constants et on les mémorise dans des tables. Les tables sont donc constituées des paramètres de base estimés , une table pour chaque axe, le nombre de

paramètres à stocker n'excédant pas une dizaine pour chaque axe.

- une fois les tables obtenues, on peut utiliser la loi de commande du premier mode de compensation telle que représentée figure 8, c'est-à-dire qu'on réutilise les valeurs de mémorisées dans les tables dans une loi du type :

Il devient ainsi possible dans le premier mode d'utiliser la compensation pour des mouvements autres que des mouvements à vitesse constante.

L'invention a été appliquée à un simulateur de mouvement de la société IXBLUE, une machine Evo-30 en l'espèce, à trois axes commandés et il a été possible d'obtenir des atténuations des perturbations de couplage de 17 dB et 22 dB selon les axes et le type de perturbation, Coriolis, centrifuges, et/ou de gravité.