EP0085008A1 - Structure de commande analogique pour boucles d'asservissement de la position en rotation d'un moteur à charge inertielle variable - Google Patents
Structure de commande analogique pour boucles d'asservissement de la position en rotation d'un moteur à charge inertielle variable Download PDFInfo
- Publication number
- EP0085008A1 EP0085008A1 EP83400154A EP83400154A EP0085008A1 EP 0085008 A1 EP0085008 A1 EP 0085008A1 EP 83400154 A EP83400154 A EP 83400154A EP 83400154 A EP83400154 A EP 83400154A EP 0085008 A1 EP0085008 A1 EP 0085008A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- motor
- analog
- signal
- digital
- rotation
- 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.)
- Withdrawn
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
- G05B19/33—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an analogue measuring device
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1638—Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39178—Compensation inertia arms
Definitions
- the present invention relates generally to the fields of servo-control in position of articulated systems whose inertia varies according to the state of the system. This is particularly the case for articulated manipulators, fitted with any rotary motor members (electric, hydraulic or pneumatic) or certain machine tools.
- the inertia brought back to the axis of the control motor obviously depends on the geometrical state of the articulated system as well as on the mass load (s) that it is required to load or transport.
- the invention relates more precisely to the problem of slaving to a set value ⁇ c (t) of the real angle of rotation ⁇ r (t) of the axis of the control motor of the device.
- the analog signal Gf + ⁇ 'then being introduced into a power amplifier 3 which applies a torque to the motor 4.
- An analog sensor reads on the axis of the motor 4, the instantaneous value of ⁇ r (t) and sends it via the feedback loop 6 to the negative input of the summator 1.
- a servo control structure in accordance with the diagram in FIG. 1, poses practically insoluble problems when the inertia brought back to the axis of the motor 4, is itself variable depending on the configuration of the system. articulated, since, in this case, the discriminant ⁇ also varies as a function of this same configuration and since the performances of the control system are not constant.
- a servo of this kind which would also make it possible to correct the effects of acceleration by adding a term linked to the second derivative of the position reference signal, could obviously be developed on a digital computer which, starting from the angular position of the motor axis recorded by a digital encoder mounted on the latter's shaft, would calculate the magnitude of the torque according to equation (2) above and send it to a digital analog converter.
- the corresponding analog signal could then be used as input of power amplifiers which would transform it into a signal capable of actuating the motor by applying to it exactly the torque
- the subject of the present invention is an analog control structure for a control loop for the rotation position ⁇ r of a motor whose inertial load J brought down on the axis of rotation is variable, which makes it possible to ensure in a simple manner , despite the instantaneous variations in the inertia J, an adaptation of the gain G and damping 5 parameters of the control chain so that the performance of the system remains close, to within a percentage of tolerance, to the theoretical performance defined by the setpoint ⁇ c of the angle of rotation.
- the use of a digital computer makes it possible to carry out, within the time required at all times and depending on the configuration of the articulated servo system as well as the loads it carries, the calculation of the inertia of the J system brought back on the axis of the motor, as well as that of the gain G and of the damping a to maintain the adaptation of the variables ⁇ , G and J to a defined percentage near.
- the proportional signals G ⁇ and derivatives ⁇ ' are constructed from analog multipliers with two inputs of a type known per se.
- only the computer which constitutes the control unit works in digital mode, a digital analog converter ensuring the link with. all the rest of the control chain which operates in an analog system allowing its use on standard commercial equipment, without any modification.
- the program placed in the computer of the control unit makes it possible to ensure that the discriminant A of the system remains constant, to within a certain relative value, defined in advance.
- the control unit of the analog servo structure can be a digital computer of any kind; it is however advisable to use a microprocessor for this purpose.
- a control unit essentially composed of a digital computer 7, which stores the angular setpoint positions ⁇ c ( t) calculates at all times the exact value of the inertia J brought back on the axis of the engine according to the spatial configuration of the articulated robot which it controls as well as the masses which it is responsible for moving.
- the second input 16 of this multiplier 14 receives directly from the digital analog converter 8, the analog quantity ⁇ .
- the two lines 12 and 17 lead to a second adder 18 which delivers as output on line 19 supplying the power amplifier 13, the analog signal of global correction ⁇ G + ⁇ ' ⁇ , in which G and P vary according to the configuration of the articulated servo system and the masses it carries, that is to say ultimately as a function of time.
- FIG. 2 The structure of FIG. 2 is, as can be seen, of the hybrid type, that is to say that it uses for rapid calculations a control unit 7 of the digital type, but that the entire control chain located behind the analog digital converter 8 to the servo control of the axis of the motor 4 is of analog type. It is therefore indeed a hybrid structure, the properly controlled servo control part of which is analog and makes it possible to use, at the level of the motor 4, the materials (probes, potentiometers, etc.) usually used in such and commonly sold commercially.
- FIGS. 5a, 5b and 5c relate to the servo in rotation of a motor from a setpoint angle 9 c whose desired evolution over time is represented in FIG. 5a, the time being expressed in seconds and the angle in degrees. If one performs the enslavement using a known proportional derivative system, of the kind of that described in figure 1, one obtains for the real angle ⁇ r the curve of figure 5b which shows transient disturbances significant in area 25.
- part of the invention is also manual embodiments in which a digital computer would calculate the inertias J at all times and where an operator would modify, using adjustment knobs, the values of the gain G and of the damping ⁇ .
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
Structure hybride, à commande analogique pour boucle d'asservissement de la position en rotation (ϑ) d'un moteur (4) dont la charge inertielle (J) ramenée sur l'axe de rotation est variable. Cette structure comprend des moyens (7, 8, 2) pour adapter instantanément, lors de chaque variation de la charge inertielle ramenée, les valeurs du gain G et de l'amortissement β pour la rotation réelle ϑr du moteur asservi (4) reste, à un pourcentage près défini, égal à l'angle de consigne ϑc.
Description
- La présente invention se rapporte d'une façon générale aux domaines des asservissements en position de systèmes articulés dont l'inertie varie en fonction de l'état du système. C'est le cas notamment des manipulateurs articulés, munis d'organes moteurs rotatifs quelconques (électrique, hydraulique ou pneumatique) ou de certaines machines outils. Dans des appareils de ce genre, l'inertie ramenée à l'axe du moteur de commande, dépend bien évidemment de l'état géométrique du système articulé ainsi que de la ou des charges massiques que celui-ci est amené à charger ou à véhiculer. L'invention a trait plus précisément au problème de l'asservissement à une valeur de consigne θc(t) de l'angle de rotation réel θr(t) de l'axe du moteur de commande de l'appareil.
- De tels asservissements sont généralement réalisés jusqu'ici à l'aide d'une structure analogique émettant un signal de commande du type proportionnel et dérivé, c'est-à-dire se composant de deux termes dont l'un est proportionnel au signal d'erreur et l'autre à sa dérivée. Une telle structure d'asservissement connue est représentée sur la figure 1 qui montre comment, à l'aide du sommateur 1 qui reçoit d'une part le signal angulaire de consigne θc(t) et d'autre part le signal θr(t) correspondant à la valeur réelle de l'angle de rotation d'un moteur, on constitue le signal d'erreur ε = θc(t)-θr(t). Ce signal est introduit dans un correcteur 2 qui délivre à la sortie un signal analogique de la forme GE + βε' dans laquelle G et P sont le gain et l'amortissement du système correcteur 2, choisis de façon expérimentale, comme il sera expliqué plus loin.
-
- L'équation fondamentale de la dynamique appliquée à l'axe du moteur 4, permet d'écrire l'équation (1) suivante :
- On conçoit qu'une structure de commande asservie, conforme au schéma de la figure 1, pose des problèmes pratiquement insolubles lorsque l'inertie ramenée au niveau de l'axe du moteur 4, est elle-même variable en fonction de la configuration du système articulé, puisque, dans ce cas, le discriminant Δ varie également en fonction de cette même configuration et que les performances du système d'asservissement ne sont pas constantes. En d'autres termes, la variation de l'inertie J due aux variations de la configuration du système articulé et des charges massiques soulevées et transportées, entraîne une désadaptation des gains G et des amortissements β, dont les valeurs ont été choisies expérimentalement pour une valeur déterminée J0 de l'inertie J ramenée sur l'axe du moteur 4.I1 en résulte en fonctionnement des écarts intolérables par rapport aux trajectoires de consigne prescrites pour l'appareil commandé ; de plus, un système de régulation tel que celui de la figure 1 est peu commode à utiliser en robotique en raison des effets d'accélération pour lesquels on ne prévoit pas de correction, car l'asservissement conçu dans la commande de la figure 1 est une approximation du premier ordre qui néglige complètement les effets d'accélération. Ces défauts sont particulièrement gênants lorsque le système articulé à commander est par exemple un robot à bras articulés possédant plusieurs moteurs actionnant des articulations successives dont les erreurs de position peuvent ainsi s'ajouter dangereusement.
- Pour résoudre ce problème, et compenser les variations de l'inertie par des modifications du gain et de l'amortissement en cours de fonctionnement, l'invention propose de réaliser un couple moteur de la forme :
- Un asservissement de ce genre, qui permettrait de corriger en outre les effets d'accélération en ajoutant un terme lié à la dérivée seconde du signal de consigne de position, pourrait évidemment être élaboré sur un calculateur numérique qui, à partir de la position angulaire de l'axe du moteur relevée par un codeur digital monté sur l'arbre de ce dernier, calculerait la grandeur du couple selon l'équation (2) précédente et l'enverrait sur un convertisseur numérique analogique. Le signal analogique correspondant pourrait alors être utilisé comme entrée des amplificateurs de puissance qui le transformeraient en un signal capable d'actionner le moteur en lui appliquant exactement le couple
- Cette solution théoriquement possible se heurte néanmoins dans la pratique à un grand nombre d'inconvénients majeurs qui la rendent presque inutilisable pour les raisons suivantes :
- 1. Tout le matériel de robotique actuellement en service est conçu pour fonctionner en asservissement analogique et il serait nécessaire de reprendre complètement les câblages et les potentiomètres existants pour adapter le matériel à un fonctionnement numérique. Par ailleurs, il est bien connu que les commandes numériques présentent une sensibilité parfois très gênantes vis-à-vis des parasites extérieurs de nature diverse.
- 2. En cas d'incident sur le calculateur, provoquant son arrêt, il s'ensuivrait un "gel" des ordres d'asservissement et le maintien à leur valeur au moment de l'incident des courants appliqués à la commande de l'arbre moteur, ce qui pourrait conduire à des mouvements catastrophiques pour les manipulateurs et leur environnement, puisque les mouvements en cours au moment de la panne continueraient, théoriquement du moins, de façon illimitée.
- 3.La structure de tels asservissements nécessiterait le recours aux techniques du multi-traitement (en anglais multiprocessing) et serait donc complexe à réaliser.
- 4. La rapidité des calculateurs numériques actuels n'est pas suffisante généralement pour assurer dans de bonnes conditions l'asservissement d'un robot possédant un certain nombre d'articulations en série (on peut calculer qu'il faudrait au moins 25 ms pour le calcul des coefficients d'inertie et l'élaboration de la commande
- 5. Les codeurs numériques sont en général très volumineux et de plus sensibles aux rayonnements ionisants, ce qui peut être gênant lorsque le télémanipulateur ou le robot employé fonctionne dans une. enceinte soumise à ces rayonnements.
- Pour toutes ces raisons par conséquent, un asservissement numérique calculant à chaque instant, selon la loi définie en (2), la grandeur du couple moteur à réaliser pour compenser exactement les variations de la charge inertielle en agissant sur les coefficients de gains et d'amortissement n'est pas pratiquement réalisable.
- La présente invention a pour objet une structure de commande analogique pour boucle d'asservissement de la position en rotation θr d'un moteur dont la charge inertielle J ramenée sur l'axe de rotation est variable, qui permet d'assurer de façon simple, malgré les variations instantanées de l'inertie J, une adaptation des paramètres de gain G et d'amortissement 5 de la chaîne d'asservissement de façon telle que les performances du système restent voisines, à un pourcentage de tolérance près, des performances théoriques définies par la consigne θc de l'angle de rotation.
- Cette structure, du type de celles qui élaborent pour la commande du couple
- La présence des moyens d'adaptation instantanée permet par conséquent de s'assurer que le signe du discriminant A = β2 - 4 JG reste le même c.'est-à-dire que l'on ne change pas de régime oscillatoire pour la réalisation de l'ordre de consigne, mais également que les écarts possibles entre l'angle de consigne θc et l'angle réel θr de rotation du moteur dus à la désadaptation partielle des coefficients de gain G et d'amortissement β, ne dépassent pas une certaine limite relative que l'on s'est fixée par avance.
- Selon l'invention et de façon plus précise, lesdits moyens d'adaptation comprennent en combinaison :
- - une unité de contrôle numérique qui garde en mémoire les valeurs θc=f(t) de la consigne d'angle de rotation, reçoit les données sur l'évolution et la charge du moteur, et qui, à partir, d'un programme établi et des données précédentes, calcule les valeurs successives de l'inertie ramenée J, et, pour chaque valeur de celle-ci, les valeurs G et P pour maintenir l'adaptation des variables β, G et J à un pourcentage défini près ;
- - un convertisseur numérique-analogique qui transforme les grandeurs précédentes en signaux analogiques ;
- - une boucle de rétroaction permettant de recueillir la valeur réelle θr de l'angle de rotation du moteur et d'établir, dans un premier sommateur, le signal d'erreur instantané ε = θc(t) - θr(t);
- - un circuit correcteur chargé d'élaborer le signal analogique représentatif de la somme Gε+βε' et se composant de deux branches en parallèle recevant à l'entrée le signal ε, la première branche comportant un premier multiplicateur analogique à deux entrées recevant les signaux Cet G, la deuxième branche comportant un différentiateur produisant le signal dérivé ε' et un deuxième multiplicateur analogique à deux entrées recevant les signaux ε' et β, les deux branches en parallèle aboutissant à un deuxième sommateur
- - la sortie de ce deuxième sommateur alimentant l'amplificateur de puissance et l'actionneur chargé d'appliquer au moteur le couple correspondant.
- Le recours à un calculateur numérique permet d'effectuer dans les délais voulus à chaque instant et en fonction de la configuration du système articulé asservi ainsi que des charges qu'il véhicule, le calcul de l'inertie du système J ramenée sur l'axe du moteur, ainsi que celui du gain G et de l'amortissement a pour maintenir l'adaptation des variables β, G et J à un pourcentage défini près. Les signaux proportionnels Gε et dérivés βε' sont construits à partir de multiplicateurs analogiques à deux entrées d'un type en soi connu. Conformément à l'invention, seul le calculateur qui constitue l'unité de commande travaille en numérique, un convertisseur numérique analogique assurant la liaison avec. tout le reste de la chaîne d'asservissement qui fonctionne elle dans un système analogique permettant son utilisation sur un matériel courant du commerce, sans aucune modification. Le programme placé dans le calculateur de l'unité de commande permet de s'assurer que le discriminant A du système reste constant, à une certaine valeur relative près, définie d'avance.
- Selon un mode de mise en oeuvre spécialement intéressant de la présente invention, la structure analogique est conçue pour corriger de façon exacte les variations de l'adaptation des coefficients de gain G et d'amortissement β en fonction des variations de l'inertie ramenée J provoquée par les changements de configuration du système asservi et des masses qu'il met en mouvement de façon à obtenir une équation en boucle fermée du système d'asservissement de la forme (3) définie précédemment. Cette structure analogique se caractérise en ce que, l'unité de contrôle précédente calcule en outre les produits JG et Jß et les injecte respectivement après passage dans le convertisseur numérique-analogique, dans l'entrée de gain du premier multiplicateur et dans l'entrée d'amortissement du deuxième multiplicateur.
- La multiplication, réalisée dans les multiplicateurs électroniques analogiques des grandeurs J, G et ß, permet de rendre l'équation en boucle fermée (3) indépendante du coefficient d'inertie J ce qui assure une adaptation parfaite des gains et des amortissements pour chaque configuration particulière du système articulé asservi.
- Dans une variante perfectionnée du mode de mise en oeuvre précédent, on améliore encore la nature de l'asservissement obtenu en corrigeant les effets dus à l'accélération angulaire du moteur de commande. A cet effet et conformément à l'invention l'unité de contrôle calcule en outre la quantité Jd2θc/dt2 qui est introduite, après codage analogique dans le convertisseur numérique analogique, dans le deuxième sommateur situé à la sortie du circuit correcteur.
- La possibilité ainsi offerte par le calculateur numérique de calculer, en un temps suffisamment court, la dérivée seconde de l'angle de rotation du moteur par rapport au temps, permet de tenir compte des effets d'accélaration angulaire que la régulation de l'art antérieur du type à deux termes proportionnel et dérivée ne permettait pas de prendre en compte. Il en résulte un perfectionnement important de la fiabilité du système lorsque les accélérations angulaires des moteurs de commande du système asservi atteignent, ce qui est fréquemment le cas, des valeurs non négligeables.
- L'unité de contrôle de la structure analogique d'asservissement, selon la présente invention, peut être un calculateur numérique d'une nature quelconque ; il est toutefois indiqué d'utiliser à cet effet un microprocesseur.
- De toute façon, l'invention sera mieux comprise en se référant à la description de trois exemples de réalisation qui seront décrits ci-après en se référant aux figures 1 à 6 sur lesquelles :
- - la figure 1 représente le schéma connu d'un asservissement classique du genre proportionnel dérive.
- - la figure 2 représente une structure pour boucle d'asservissement selon la présente invention dans laquelle on corrige partiellement, à un certain pourcentage près, les désadaptations du système en fonction des variations de l'inertie J ;
- - la figure 3 représente un schéma de mise en oeuvre d'une structure pour boucle d'asservissement selon l'invention dans lequel on corrige exactement les défauts d'adaptation du gain et de l'amortissement du système d'asservissement en fonction des variations de l'inertie ramenée J du système ;
- la figure 4 représente une structure pour boucle d'asservissement, objet de l'invention, qui reproduit les éléments de la figure 3 en y ajoutant de plus une correction des accélérations angulaires.
- - la figure 5 (5a, 5b, 5c) montre l'évolution dans le temps d'une consigne angulaire θc (figure 5a) par le système d'asservissement de la figure 1 (figure 5b) et par le système de la figure 4 (figure 5c). Sur les figures 5a, 5b et 5c les angles sont exprimés en ordonnées et en degrés et les temps en abscisses et en secondes.
- - la figure 6 (6a, 6b, 6c) montre l'évolution dans le temps d'une consigne angulaire θc (figure 6a) par le système d'asservissement de la figure 1 (figure 6b) et par le système de la figure 4 (figure 6c). Sur les figures 6a, 6b et 6c les angles sont exprimés en ordonnées et en degrés et les temps en abscisses et en secondes.
- Sur la figure 1 destinée à rappeler le schéma connu d'une commande analogique à boucle d'asservissement du type proportionnel dérivé, on voit le sommateur 1 qui reçoit le signal de consigne angulaire θc(t) sur son entrée positive et, par la boucle d'asservissement 6, le signal θr(t), représentatif de la rotation réelle du moteur 4 à asservir, sur son entrée négative. Le sommateur 1 élabore donc le signal d'erreur ε(t)=θc(t)-θr(t) que le circuit correcteur 2 transforme en un signal à deux termes, Gε+βε', G et P étant les valeurs constantes du gain et de l'amortissement de la boucle d'asservissement et ε' la dérivée
- Sur'le premier mode de réalisation de la structure analogique pour boucle d'asservissement objet de l'invention, représenté sur la figure 2, on retrouve comme dans la figure 1, le moteur 4 alimenté par l'amplificateur de puissance 3. Comme sur la figure 1, la ligne de rétroaction 6 permet de ramener à l'entrée négative du sommateur 1 la valeur instantanée θr(t) de la position angulaire de l'arbre du moteur 4. Dans cette première variante de mise en oeuvre conforme à l'invention, une unité de contrôle composée essentiellement d'un calculateur numérique 7, qui garde en mémoire les positions angulaires de consigne θc(t) calcule à chaque instant la valeur exacte de l'inertie J ramenée sur l'axe du moteur en fonction de la configuration spatiale du robot articulé qu'il commande ainsi que des masses qu'il est chargé de déplacer. A partir de cette valeur de l'inertie ramenée J, il calcule également pour chaque configuration du robot asservi, des valeurs G et a du gain et de l'amortissement, de façon à maintenir l'adaptation de ces trois variables à un pourcentage défini près. Selon l'invention, un convertisseur numérique analogique 8 convertit les grandeurs précédentes en représentation analogique et celles-ci sont utilisées de la façon suivante pour alimenter le correcteur 2 chargé d'élaborer le signal d'asservissement délivré à l'entrée de l'amplificateur de puissance 3.
- A cet effet d'abord, un premier sommateur 1 reçoit sur sa borne positive le signal de consigne an- gulaire θc(t) et sur sa borne négative, par la voie 6, la valeur analogique de l'angle réel 9 (t) de position du moteur 4. Ce sommateur 1 élabore le signal d'erreur E qui pénètre dans le correcteur 2 lequel se compose de deux branches en parallèle. La branche représentée sur la partie supérieure du dessin ou première branche comporte un premier multiplicateur analogique 9 à deux entrées dont la première 10 reçoit le signal G et la deuxième 11 reçoit le signal ε. Ce multiplicateur analogique 9 délivre donc en sortie sur la ligne 12 le signal analogique εG. Le correcteur 2 se compose également d'une deuxième branche parallèle à la précédente et comporte un dérivateur 13 et un deuxième multiplicateur analogique 14 à deux entrées. Le dérivateur 13 construit la fonction ε'=dε/dt laquelle est injectée sur la première entrée 15 du multiplicateur 14. La deuxième entrée 16 de ce multiplicateur 14 reçoit directement du convertisseur numérique analogique 8, la grandeur analogique β. Sur la ligne-de sortie 17 du multiplicateur 14, se trouve par conséquent présent le signal analogique ε'β. Les deux lignes 12 et 17 aboutissent à un deuxième sommateur 18 qui délivre en sortie sur la ligne 19 alimentant l'amplificateur de puissance 13, le signal analogique de correction globale εG+ε'β, dans lequel G et P varient en fonction de la configuration du système articulé asservi et des masses qu'il transporte c'est-à-dire en fin de compte en fonction du temps.
- La structure de la figure 2 est comme on le voit de type hybride, c'est-à-dire qu'elle utilise pour les calculs rapides une unité de commande 7 de type numérique, mais que toute la chaîne d'asservissement située derrière le convertisseur numérique analogique 8 jusqu'à la commande d'asservissement de l'axe du moteur 4 est de type analogique. Il s'agit bien donc là d'une structure hybride dont la partie proprement commande d'asservissement est analogique et permet d'utiliser au niveau du moteur 4 les matériels (palpeurs, potentiomètres, etc...) habituellement utilisés dans les appareils de ce genre et vendus couramment dans le commerce.
- Enfin, le fait que le signal d'asservissement εG+εβ, injecté par la ligne 19 dans l'amplificateur de puissance 3, est adapté aux variations de G et de β permet (à l'inverse de ce qui se produisait dans l'art antérieur décrit sur la figure 1) de contrôler les valeurs que prend le discriminant Δ=β2-4 JG de l'équation en boucle fermée définie plus haut et de parvenir, à un pourcentage près défini que l'on peut choisir aussi proche qu'on le souhaite de l'asservissement parfait, à une commande très précise de l'angle réel de position θr(t) en fonction de l'angle de consigne θc(t).
- Dans une variante de réalisation de la figure 2, le calculateur numérique 7, au lieu de partir des positions angulaires de consigne 9 c pour calculer l'inertie ramenée J, reçoit la valeur θr instaurée de la position angulaire de l'arbre du moteur 4 par la ligne en pointillé 30 au travers d'un convertisseur analogique numérique 31 disposé sur cette ligne 30.
- Dans le schéma de la figure 3, on retrouve exactement les éléments de la figure 2 portant les mêmes nombres de référence. Dans ce cas toutefois, on recherche une adaptation pratiquement exacte des variations du gain G et de l'amortissement P pour compenser complètement les variations de la charge inertielle ramenée à l'axe du moteur J pour chaque position de déploiement du robot articulé commandé et chaque valeur des charges manipulées. Pour ce faire, on utilise un système dont l'équation en boucle fermée est donnée par l'équation (3) précédente c'est-à-dire indépendante de la variable inertielle J. C'est pourquoi, l'unité de contrôle 7, qui effectue les mêmes calculs que dans le cas de la structure de la figure 2, élabore en plus les produits instantanés JG et Jβ, qui, après transformation en signaux analogiques dans le convertisseur 8, alimentent respectivement l'entrée 10 du premier multiplicateur 9 et l'entrée 16 du second multiplicateur 14.
- Le schéma de la figure 3 représente par conséquent une structure conforme à l'invention qui corrige complètement les défauts d'adaptation des gains G et des amortissements a en fonctionnement, pour toutes les valeurs successives de la masse inertielle J ramenée sur l'axe du moteur 4. On obtient ainsi à l'aide de cette structure un asservissement d'une qualité très supérieure à ceux de l'art antérieur comme on l'illustrera ci-après par quelques figures relevées sur des systèmes réels.
- Toutefois, un dernier perfectionnement peut encore être apporté à la structure de la figure 3, et concerne la correction des accélérations angulaires que cette dernière structure n'est pas capable de prendre en compte. A cet effet, une troisième variante de mise en oeuvre de la structure à commande analogique objet de l'invention est représentée sur la figure 4 où l'on retrouve avec les mêmes nombres de références l'ensemble des éléments des figures 2 et 3 auxquels est venue s'ajouter une ligne 20 qui introduit la grandeur analogique J d2θc/dt2 calculée par le calculateur 7 et in-, troduite dans le deuxième sommateur 18.
- Pour illustrer les. performances obtenues à l'aide des dispositifs des figures 3 et 4, on donnera maintenant des courbes d'enregistrement d'évolution de l'angle d'asservissement réel 9 en fonction de l'angle de consigne θc.
- Les figures 5a, 5b et 5c sont relatives à l'asservissement en rotation d'un moteur à partir d'un angle de consigne 9c dont l'évolution souhaitée dans le temps est représentée sur la figure 5a, le temps étant exprimé en secondes et l'angle en degrés. Si l'on effectue l'asservissement à l'aide d'un système proportionnel dérivé connu, du genre de celui que décrit la figure 1, on obtient pour l'angle réel θr la courbe de la figure 5b qui montre des troubles transitoires importants dans la zone 25.
- Si l'on utilise pour effectuer le même asservissement le montage de la figure 4, on obtient la courbe d'enregistrement de la figure 5c où l'on voit que les perturbations transistoires de la zone 25 sont, sinon effacées, du moins très fortement atténuées.
- Sur les figures 6a, 6b et 6c on montre l'intérêt de la correction supplémentaire de l'accélération angulaire à l'aide d'une structure conforme à celle de la figure 4. La figure 6a montre la variation de consi- gne θc souhaitée pour un moteur asservi ; la figure 6b montre l'évolution de l'angle de rotation réel θr à l'aide d'un système du type proportionnel dérivé du genre de celui de la figure 1 et la figure 6b montre l'asservissement obtenu et la variation de l'angle réel 9r lorsque l'on corrige à la fois les adaptations du gain et de l'amortissement ainsi que les effets d'accélérations. L'observation de la façon dont est reproduite la zone 26a de variation de la courbe de consigne, en 26b et 26c sur les figures 6b et 6c permet d'observer le progrès technique réalisé avec les structures d'asservissement objet de l'invention.
- Il est bien entendu que font également partie de l'invention des réalisations manuelles dans lesquelles un calculateur numérique calculerait à chaque instant les inerties J et où un opérateur modifierait à l'aide de boutonsde réglage les valeurs du gain G et de l'amortissement β.
- D'autre part, les configurations décrites sur les figures 2, 3 et 4 sont les meilleures réalisables dans l'état actuel de la technique ; mais il est également possible, selon l'invention, d'utiliser un calculateur numérique pour engendrer le signal de commande du moteur 4. La solution analogique décrite est préférée car elle n'est pas sujette aux vibrations du moteur qui accompagnent souvent une réalisation numérique.
Claims (5)
1. Structure de commande pour boucle d'asservissement de la position en rotation (9) d'un moteur (4) dont la charge inertielle (J) ramenée sur l'axe de rotation est variable, du type de celles qui élaborent pour la détermination du couple (f) du moteur (4) un signal comportant au moins deux termes correcteurs de la forme Gε+βε' , G et β représentant le gain et l'amortissement de la boucle d'asservissement pour une valeur J0 de la charge inertielle, e le signal d'erreur de position angulaire θ et ε' sa dérivée par rapport au temps caractérisée en ce qu'elle comprend des moyens (7, 8, 2) pour adapter instantanément, lors de chaque variation de la charge inertielle ramenée, les valeurs du gain G et de l'amortissement P pour que la rotation réelle θr du moteur asservi (4) reste, à un pourcentage près défini, égale à l'angle de consigne θc.
2. Structure hybride de commande analogique selon la revendication 1, caractérisée en ce que lesdits moyens d'adaptation comprennent en combinaison :
- une unité de contrôle numérique (7) qui garde en mémoire les valeurs de l'angle de rotation, reçoit les données sur l'évolution de la charge du moteur (4), et qui, à partir d'un programme établi et des données précédentes, calcule les valeurs successives de l'inertie ramenée J, et, pour chaque valeur de celle-ci les valeurs G et β pour maintenir l'adaptation des variables β, G et J à un pourcentage défini près ;
- un convertisseur numérique-analogique (8) qui transforme les grandeurs précédentes en signaux analogiques ;
- une boucle de rétroaction (6) permettant de recueillir la valeur réelle θr de l'angle de rotation du moteur (4) et d'établir, dans un premier sommateur (1), le signal d'erreur instantané ε =θc (t)-θr(t) ;
- un circuit correcteur (2) chargé d'élaborer le signal analogique représentatif de la somme Gε+βε' et se composant de deux branches en parallèle recevant à l'entrée le signal f, la première branche comportant un premier multiplicateur analogique (9) à deux entrées (10, 11) recevant les signaux ε et G, la deuxième branche comportant un différentiateur (13) produisant le signal dérivé ε' et un deuxième multiplicateur (14) analogique à deux entrées (15, 16) recevant les signauz' et ß, les deux branches en parallèle aboutissant à un deuxième sommateur (18) ;
- la sortie (19) de ce deuxième sommateur (18) alimentant l'amplificateur de puissance (3) chargé d'appliquer au moteur (4) le couple correspondant.
3. Structure selon la revendication 2, caractérisée en ce que pour obtenir une équation en boucle fermée indépendante de la valeur instantanée de l'inertie ramenée J, l'unité de contrôle (7) calcule en outre les produits JG et Jβ et les injecte respectivement, après passage dans le convertisseur numérique-analogique (8), dans l'entrée de gain (10) du premier multiplicateur (9) et dans l'entrée d'amortissement (16) du deuxième multiplicateur (14).
4. Structure selon la revendication 3, cà- ractérisée en ce que pour corriger les effets, dus à l'accélération angulaire, l'unité de contrôle calcule en outre la quantité Jd2θc/dt2 qui est introduite, après codage analogique dans le convertisseur numérique analogique (8), dans le deuxième sommateur (18) situé à la sortie du circuit correcteur (2).
5. Structure selon la revendication 2, caractérisée en ce que l'unité de contrôle est un microprocesseur.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR8201235 | 1982-01-27 | ||
FR8201235A FR2520523A1 (fr) | 1982-01-27 | 1982-01-27 | Structure de commande analogique pour boucles d'asservissement de la position en rotation d'un moteur a charge inertielle variable |
Publications (1)
Publication Number | Publication Date |
---|---|
EP0085008A1 true EP0085008A1 (fr) | 1983-08-03 |
Family
ID=9270355
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP83400154A Withdrawn EP0085008A1 (fr) | 1982-01-27 | 1983-01-21 | Structure de commande analogique pour boucles d'asservissement de la position en rotation d'un moteur à charge inertielle variable |
Country Status (4)
Country | Link |
---|---|
US (1) | US4549261A (fr) |
EP (1) | EP0085008A1 (fr) |
JP (1) | JPS58129604A (fr) |
FR (1) | FR2520523A1 (fr) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0163934A2 (fr) * | 1984-06-05 | 1985-12-11 | Stäubli International AG | Système de commande d'un robot manipulateur avec résolution du mouvement commandé |
EP0254211A2 (fr) * | 1986-07-22 | 1988-01-27 | Hitachi, Ltd. | Système de commande pour corriger la position d'un appareil muni d'un servomécanisme |
CN108638074A (zh) * | 2018-06-13 | 2018-10-12 | 杭州电子科技大学 | 一种能够消除回程误差的多自由度机械臂回转方法 |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6062115U (ja) * | 1983-10-05 | 1985-05-01 | 三菱電機株式会社 | 可動体の制御装置 |
JPH07113856B2 (ja) * | 1985-03-20 | 1995-12-06 | 東芝機械株式会社 | 追従誤差制御装置 |
JPS62212802A (ja) * | 1986-03-14 | 1987-09-18 | Fanuc Ltd | ロボツトア−ムの制御装置 |
US4845416A (en) * | 1987-02-13 | 1989-07-04 | Caterpillar Inc. | Electronic valve actuator |
GB8806574D0 (en) * | 1988-03-19 | 1988-04-20 | Hepworth Eng Ltd | Machine tool error compensation systems |
JPH0454885A (ja) * | 1990-06-19 | 1992-02-21 | Mitsubishi Electric Corp | サーボモータ用監視装置 |
US7904182B2 (en) | 2005-06-08 | 2011-03-08 | Brooks Automation, Inc. | Scalable motion control system |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3422965A (en) * | 1967-02-13 | 1969-01-21 | Westinghouse Electric Corp | Manipulator apparatus |
DE2656433A1 (de) * | 1976-12-14 | 1978-06-15 | Fraunhofer Ges Forschung | Verfahren und anordnung zur regelung von manipulatoren und industriellen robotern |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3250903A (en) * | 1961-09-27 | 1966-05-10 | Vasu George | Amplitude ratio computer and control system |
US3968352A (en) * | 1974-05-17 | 1976-07-06 | Sperry Rand Corporation | Torque control system for reaction wheel assemblies and the like |
US4052598A (en) * | 1976-05-03 | 1977-10-04 | Hycom Incorporated | Control system with fast response |
US4243923A (en) * | 1979-01-22 | 1981-01-06 | Massachusetts Institute Of Technology | Servo-controlled mobility device |
US4330752A (en) * | 1979-05-14 | 1982-05-18 | Optimetrix Corporation | Position control circuit |
US4272818A (en) * | 1979-07-19 | 1981-06-09 | The Bendix Corporation | Position feedback control system for a numerically controlled machine tool |
US4398241A (en) * | 1980-08-07 | 1983-08-09 | The Singer Company | Digital control circuit for an analog servo |
US4396975A (en) * | 1980-10-01 | 1983-08-02 | Fujitsu Fanuc Limited | Position control system for a closed loop type numerical-controlled machine tool |
US4387421A (en) * | 1981-03-06 | 1983-06-07 | General Electric Company | Optimal and adaptive control of variable speed AC motor drives |
-
1982
- 1982-01-27 FR FR8201235A patent/FR2520523A1/fr active Granted
-
1983
- 1983-01-21 EP EP83400154A patent/EP0085008A1/fr not_active Withdrawn
- 1983-01-26 US US06/460,996 patent/US4549261A/en not_active Expired - Fee Related
- 1983-01-27 JP JP58012099A patent/JPS58129604A/ja active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3422965A (en) * | 1967-02-13 | 1969-01-21 | Westinghouse Electric Corp | Manipulator apparatus |
DE2656433A1 (de) * | 1976-12-14 | 1978-06-15 | Fraunhofer Ges Forschung | Verfahren und anordnung zur regelung von manipulatoren und industriellen robotern |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0163934A2 (fr) * | 1984-06-05 | 1985-12-11 | Stäubli International AG | Système de commande d'un robot manipulateur avec résolution du mouvement commandé |
EP0163934A3 (fr) * | 1984-06-05 | 1988-10-05 | Stäubli International AG | Système de commande d'un robot manipulateur avec résolution du mouvement commandé |
EP0254211A2 (fr) * | 1986-07-22 | 1988-01-27 | Hitachi, Ltd. | Système de commande pour corriger la position d'un appareil muni d'un servomécanisme |
EP0254211A3 (en) * | 1986-07-22 | 1989-01-04 | Hitachi, Ltd. | Position correcting control system for servomechanism device |
CN108638074A (zh) * | 2018-06-13 | 2018-10-12 | 杭州电子科技大学 | 一种能够消除回程误差的多自由度机械臂回转方法 |
CN108638074B (zh) * | 2018-06-13 | 2020-04-07 | 杭州电子科技大学 | 一种能够消除回程误差的多自由度机械臂回转方法 |
Also Published As
Publication number | Publication date |
---|---|
FR2520523B1 (fr) | 1984-03-09 |
JPS58129604A (ja) | 1983-08-02 |
FR2520523A1 (fr) | 1983-07-29 |
US4549261A (en) | 1985-10-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2124327B1 (fr) | Dispositif de détermination de la position angulaire d'un rotor d'une machine électrique tournante polyphasée et machine électrique tournante comprenant un tel dispositif | |
EP0085008A1 (fr) | Structure de commande analogique pour boucles d'asservissement de la position en rotation d'un moteur à charge inertielle variable | |
EP1790421B1 (fr) | Dispositif d'asservissement pour un vibrateur à rotors déséquilibrés | |
WO2006131664A1 (fr) | Dispositif de reglage automatique des asservissements d'un simulateur mecanique de mouvements et dispositif associe | |
EP3338147B1 (fr) | Système de régulation d'un paramètre régulé | |
FR2679345A1 (fr) | Systeme et procede de commande d'attitude de vaisseau spatial. | |
EP0516537A1 (fr) | Dispositif d'atténuation des vibrations périodiques d'une structure mécanique | |
FR2900360A1 (fr) | Procede et dispositif de reglage de parametres de fonctionnement d'un robot, programme et support d'enregistrement pour ce procede | |
WO2005062143A1 (fr) | Procede et dispositif de commande des deplacements d'une partie mobile d'un robot multi-axes | |
EP2116912A1 (fr) | Procédé et dispositif de rejet robuste de perturbations périodiques dans une boucle de contrôle de position d'un axe | |
FR2874204A1 (fr) | Systeme de commande de vol electriques pour les gouvernes de profondeur d'un aeronef | |
EP1753947B1 (fr) | Procede de controle d'une consigne de couple a appliquer aux roues d'une transmission automatisee pour vehicule automobile et dispositif correspondant. | |
EP1399790B1 (fr) | Procede et dispositif de controle de vitesse angulaire d'une chaine electromecanique peu amortie | |
FR2627603A1 (fr) | Systeme de commande de fonctionnement synchronise pour machine a commande numerique | |
EP0469508B1 (fr) | Procédé et dispositif d'estimation de flux d'induction magnétique d'un moteur asynchrone, en vue notamment de la commande de ce moteur par régulation de flux | |
EP1406141B1 (fr) | Procédé et dispositif pour commander automatiquement la poussée d'un moteur d'un aéronef | |
WO1992011117A1 (fr) | Procede de commande d'un systeme mecanique flexible motorise a configuration variable, tel qu'un bras robot par exemple | |
EP0532374B1 (fr) | Dispositif pour la commande du régime des moteurs d'un aéronef | |
EP0522924A1 (fr) | Actionneur rotatif apte à engendrer sur le volant de manoeuvre d'un système de commande, un couple résistant variable selon une loi adaptative | |
FR3107367A1 (fr) | Mesure de fonction de transferts dans un système mécatronique | |
EP0469509A1 (fr) | Procédé et dispositif de commande de moteur asynchrone par régulation de flux d'induction magnétique | |
EP0715400A1 (fr) | Dispositif de régulation désensibilisée de la tension statorique d'un alternateur | |
EP0434490B1 (fr) | Dispositif de commande du fonctionnement d'au moins deux moteurs thermiques accouplés sur un même arbre d'entraînement d'un alternateur | |
WO2015040238A1 (fr) | Procédé et dispositif de réglage d'un système mécanique actionné | |
FR2730469A1 (fr) | Vaisseau spatial a commande precise d'assiette et procede pour cette commande |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
AK | Designated contracting states |
Designated state(s): BE CH DE GB IT LI NL SE |
|
17P | Request for examination filed |
Effective date: 19840116 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE APPLICATION IS DEEMED TO BE WITHDRAWN |
|
18D | Application deemed to be withdrawn |
Effective date: 19860226 |
|
RIN1 | Information on inventor provided before grant (corrected) |
Inventor name: MOUHAMED, MAYEZ AL |