CH698856B1 - Regulation system of a gantry with double drive means. - Google Patents
Regulation system of a gantry with double drive means. Download PDFInfo
- Publication number
- CH698856B1 CH698856B1 CH00662/09A CH6622009A CH698856B1 CH 698856 B1 CH698856 B1 CH 698856B1 CH 00662/09 A CH00662/09 A CH 00662/09A CH 6622009 A CH6622009 A CH 6622009A CH 698856 B1 CH698856 B1 CH 698856B1
- Authority
- CH
- Switzerland
- Prior art keywords
- drive means
- head
- inertia
- calculation module
- coefficients
- Prior art date
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C9/00—Travelling gear incorporated in or fitted to trolleys or cranes
- B66C9/16—Travelling gear incorporated in or fitted to trolleys or cranes with means for maintaining alignment between wheels and track
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Control Of Position Or Direction (AREA)
- Feedback Control In General (AREA)
Abstract
L’invention se rapporte à un dispositif de régulation (11) d’un portique (1) comportant une poutre (3) sur laquelle est montée mobile une tête (5) et dont chaque extrémité comprend un moyen d’entraînement linéaire (2, 4), ledit système de régulation comportant un dispositif de supervision (13) destiné à fournir la position cible de la tête (5), un dispositif de génération de consigne (14, 16) destiné à fournir la position cible de chacun des moyens d’entraînement (2, 4), un dispositif d’asservissement (15, 17) en boucle fermée pour chacun desdits moyens d’entraînement destiné à fournir un signal de commande audit moyen d’entraînement afin de faire tendre la position réelle de la tête (5) vers la position cible Selon l’invention, le système de régulation (11) comprend en outre un dispositif de compensation (19) comportant une unité de commande corrective (25) destinée à fournir un signal de correction pour chaque signal de commande fourni par chacun desdits dispositifs d’asservissement en fonction de la position réelle de chacun desdits moyens d’entraînement afin de déplacer le portique (1) sans provoquer de rotation de la poutre (3) quelle que soit la position de ladite tête. L’invention concerne le domaine des systèmes de positionnement industriels.The invention relates to a device (11) for regulating a gantry (1) comprising a beam (3) on which is mounted movable a head (5) and of which each end comprises a linear drive means (2, 4), said control system having a supervisory device (13) for providing the target position of the head (5), a set-point generating device (14, 16) for providing the target position of each of the means of a drive (2, 4), a closed-loop servo (15, 17) for each of said drive means for supplying a control signal to said drive means to bias the actual position of the head (5) to the target position According to the invention, the control system (11) further comprises a compensation device (19) having a corrective control unit (25) for providing a correction signal for each control signal provided by r each of said servo devices as a function of the actual position of each of said drive means to move the gantry (1) without causing rotation of the beam (3) regardless of the position of said head. The invention relates to the field of industrial positioning systems.
Description
Domaine de l’inventionField of the invention
[0001] L’invention se rapporte à un système de régulation d’un portique à plusieurs moyens d’entraînement linéaires et, plus particulièrement, un tel système comportant un dispositif de compensation prenant en compte toutes les forces perturbatrices dudit portique. [0001] The invention relates to a system for regulating a gantry with several linear drive means and, more particularly, such a system comprising a compensation device taking into account all the disturbing forces of said gantry.
Arrière-plan de l’inventionBackground of the invention
[0002] Les portiques à multiples moyens d’entraînement linéaires sont connus pour la difficulté à réguler leur mouvement. En effet, comme illustré à la fig. 1 , un portique 1 comporte une poutre 3 sur laquelle est généralement monté mobile un chariot 10, une charge utile 22 étant elle-même mobile par rapport au chariot 10. Afin que la charge utile 22 puisse se mouvoir selon trois dimensions X, Y et Z, le portique 3 comporte quatre moyens d’entraînement linéaires 2, 4, 6 et 8. Afin de déplacer la charge utile 22 selon l’axe X, chaque extrémité de la poutre 3 est reliée à un moyen d’entraînement linéaire 2, 4 à l’aide d’interfaces flexibles 7 et 9. Dans le but de déplacer la charge utile 22 selon l’axe Y, sur une des faces principales de la poutre 3 est monté le chariot 10 à l’aide d’un troisième moyen d’entraînement 6. Enfin, la charge utile 22 est déplacée selon l’axe Z par un quatrième moyen d’entraînement 8 qui est monté sur le chariot 10. Par souci de clarté, dans la suite du texte, la tête 5 désigne l’ensemble formé par le moyen d’entraînement 6, le chariot 10, le moyen d’entraînement 8 et la charge utile 22. [0002] Gantry cranes with multiple linear drive means are known for the difficulty in regulating their movement. Indeed, as illustrated in FIG. 1, a gantry 1 comprises a beam 3 on which a carriage 10 is generally mounted movably, a payload 22 itself being movable relative to the carriage 10. So that the payload 22 can move in three dimensions X, Y and Z, the gantry 3 comprises four linear drive means 2, 4, 6 and 8. In order to move the payload 22 along the X axis, each end of the beam 3 is connected to a linear drive means 2, 4 using flexible interfaces 7 and 9. In order to move the payload 22 along the Y axis, on one of the main faces of the beam 3 is mounted the carriage 10 using a third drive means 6. Finally, the payload 22 is moved along the Z axis by a fourth drive means 8 which is mounted on the carriage 10. For the sake of clarity, in the remainder of the text, the head 5 denotes the assembly formed by the drive means 6, the carriage 10, the drive means 8 and the payload 22.
[0003] On comprend, à l’aide de l’explication ci-dessus, qu’il est difficile d’amener la tête 5 à un positionnement précis selon l’axe X. En effet, considérer chacun des moyens d’entraînement linéaires 2, 4 comme des axes indépendants aboutit à une détérioration des performances à cause du couplage mécanique qui les lie. Le mouvement d’un des moyens d’entraînement 2, 4 génère des forces perturbatrices sur l’autre moyen d’entraînement 4, 2 qui peuvent nuire à sa performance. It is understood, with the aid of the above explanation, that it is difficult to bring the head 5 to precise positioning along the X axis. Indeed, consider each of the linear drive means 2, 4 as independent axes leads to a deterioration in performance due to the mechanical coupling between them. Movement of one of the drive means 2, 4 generates disruptive forces on the other drive device 4, 2 which can adversely affect its performance.
[0004] Ainsi, notamment, les systèmes actuels de régulation ne permettent pas d’éviter que la poutre 3 imprime une rotation autour de l’axe Z ce qui rend nécessaire l’utilisation des interfaces flexibles 7 et 9. [0004] Thus, in particular, the current control systems do not make it possible to prevent the beam 3 from imparting a rotation around the Z axis, which makes it necessary to use the flexible interfaces 7 and 9.
[0005] De telles interfaces sont proposées dans le brevet EP 1 810 776 et évitent d’imposer des contraintes excessives sur les éléments de liaison. Dans certains cas, on peut même utiliser ce degré de liberté supplémentaire dans l’application. Un exemple d’une telle utilisation est donné dans le brevet EP 1 107 067 pour un portique utilisé dans le domaine de la lithographie qui nécessite de petites corrections angulaires autour de l’axe Z. Ce degré de liberté supplémentaire requiert une structure de commande dédiée dont on trouve un exemple dans les brevets US 2007/0 035 266 et US 6 163 116 dans lesquels on utilise une linéarisation des fonctions trigonométriques et des régulateurs indépendants pour les axes X et la rotation . [0005] Such interfaces are proposed in patent EP 1 810 776 and avoid imposing excessive stresses on the connecting elements. In some cases, you can even use this extra degree of freedom in the application. An example of such use is given in patent EP 1 107 067 for a gantry used in the field of lithography which requires small angular corrections around the Z axis. This additional degree of freedom requires a dedicated control structure. an example of which can be found in patents US 2007/0 035 266 and US 6 163 116 in which linearization of the trigonometric functions and independent regulators for the X axes and rotation are used.
[0006] Le problème principal d’une telle structure est toutefois d’avoir à régler différemment chacun des régulateurs qui sont associés à des comportements dynamiques très différents. On préférera dès lors une structure de commande plus conventionnelle telle que celle décrite dans le brevet EP 1 321 837 qui a cette fois l’inconvénient de ne pas tenir compte du couplage mécanique entre les axes et a recours à des techniques spéciales pour éviter les forces antagonistes qui peuvent apparaître dans la commande. [0006] The main problem with such a structure, however, is having to adjust each of the regulators differently, which are associated with very different dynamic behaviors. We will therefore prefer a more conventional control structure such as that described in patent EP 1 321 837, which this time has the drawback of not taking into account the mechanical coupling between the axes and uses special techniques to avoid the forces. antagonists that may appear in the command.
[0007] Le couplage mécanique est, par exemple, considéré dans le brevet US 7 183 739 qui propose d’introduire des termes de découplage dans la commande du système. Dans ce brevet toutefois, seul l’écart entre les positions de consigne ou mesuré est pris en compte, ce qui n’est pas utilisable lorsque les inerties changent, en particulier à cause du mouvement de la tête 5 selon l’axe Y. [0007] Mechanical coupling is, for example, considered in US Pat. No. 7,183,739 which proposes to introduce decoupling terms in the control of the system. In this patent, however, only the difference between the set or measured positions is taken into account, which cannot be used when the inertias change, in particular because of the movement of the head 5 along the Y axis.
Résumé de l’inventionSummary of the invention
[0008] Le but de la présente invention est de pallier tout ou partie les inconvénients cités précédemment en proposant un système de régulation qui prend en compte toutes les forces perturbatrices du portique afin de le piloter plus précisément. The aim of the present invention is to overcome all or part of the drawbacks mentioned above by proposing a regulation system which takes into account all the disturbing forces of the gantry in order to control it more precisely.
[0009] A cet effet, l’invention se rapporte à un système de régulation selon la revendication 1 ou la revendication 6. Grâce au système de régulation selon l’invention, le portique 1 est déplacé selon l’axe X avec des moyens d’entraînement 2, 4 qui sont synchronisés c’est-à-dire que la poutre 3 garde en permanence un angle par rapport à l’axe Z sensiblement nul. De plus, le mouvement obtenu est réalisé avec un écart minimal par rapport à la consigne. [0009] To this end, the invention relates to a control system according to claim 1 or claim 6. Thanks to the control system according to the invention, the gantry 1 is moved along the X axis with means of 'drive 2, 4 which are synchronized, that is to say that the beam 3 permanently keeps an angle with respect to the axis Z substantially zero. In addition, the movement obtained is carried out with a minimum deviation from the setpoint.
Description sommaire des dessinsBrief description of the drawings
[0010] D’autres particularités et avantages ressortiront clairement de la description qui en est faite ci-après, à titre indicatif et nullement limitatif, en référence aux dessins annexés, dans lesquels: la fig. 1 est une représentation schématique d’un exemple de portique selon l’invention; la fig. 2 est une représentation schématique d’un exemple de système de régulation selon l’invention; la fig. 3 est une représentation schématique d’un exemple de modèle mécanique équivalent du portique selon l’invention; la fig. 4 est un schéma fonctionnel de l’un exemple d’unité de commande corrective du dispositif de compensation selon l’invention; la fig. 5 est un schéma fonctionnel d’un exemple de module de calcul dynamique du dispositif d’asservissement selon l’invention; la fig. 6 est un schéma fonctionnel d’une variante de l’unité de commande corrective d’un exemple de dispositif de compensation selon l’invention.[0010] Other features and advantages will emerge clearly from the description which is given below, by way of indication and in no way limiting, with reference to the accompanying drawings, in which: FIG. 1 is a schematic representation of an example of a gantry according to the invention; fig. 2 is a schematic representation of an example of a control system according to the invention; fig. 3 is a schematic representation of an example of an equivalent mechanical model of the gantry according to the invention; fig. 4 is a block diagram of an example of a corrective control unit of the compensation device according to the invention; fig. 5 is a functional diagram of an example of a dynamic calculation module of the control device according to the invention; fig. 6 is a block diagram of a variant of the corrective control unit of an example of a compensation device according to the invention.
Description détaillée des modes de réalisation préférésDetailed description of the preferred embodiments
[0011] Comme illustré à la fig. 2 , l’invention se rapporte à un système de régulation généralement annoté 11. Préférentiellement selon l’invention, le système de régulation 11 est destiné à déplacer la poutre 3 de telle sorte qu’elle reste sensiblement parallèle à l’axe Y mais également avec un écart minimal par rapport à la position de consigne. As illustrated in FIG. 2, the invention relates to a generally annotated regulation system 11. Preferably according to the invention, the regulation system 11 is intended to move the beam 3 so that it remains substantially parallel to the Y axis but also with a minimum deviation from the setpoint position.
[0012] Dans l’explication ci-après, le dispositif de régulation 11 portera principalement sur le déplacement selon l’axe X car c’est le mouvement qui est le plus difficile à maîtriser dans la configuration des fig. 1 et 3 . Cependant, bien évidemment, le dispositif de régulation 11 est également destiné à commander les moyens d’entraînement 6 et 8, c’est-à-dire la charge utile 22 selon les axes Y et Z. [0012] In the following explanation, the regulating device 11 will mainly relate to the movement along the X axis because it is the movement which is the most difficult to control in the configuration of FIGS. 1 and 3. However, of course, the regulating device 11 is also intended to control the drive means 6 and 8, that is to say the payload 22 along the Y and Z axes.
[0013] Le système de régulation 11 comporte un dispositif de supervision 13, un dispositif de génération de consigne 14, 16 pour chacun des moyens d’entraînement 2, 4, un dispositif d’asservissement 15, 17 pour chacun des moyens d’entraînement 2, 4, un dispositif de compensation 19, un dispositif d’amplification de puissance 21, 23 pour chacun des moyens d’entraînement 2, 4 ainsi qu’un capteur de position 18, 20 pour chacun des moyens d’entraînement 2, 4. The regulation system 11 comprises a supervision device 13, a setpoint generation device 14, 16 for each of the drive means 2, 4, a control device 15, 17 for each of the drive means 2, 4, a compensation device 19, a power amplification device 21, 23 for each of the drive means 2, 4 as well as a position sensor 18, 20 for each of the drive means 2, 4 .
[0014] Le dispositif de supervision 13 est destiné à fournir la position cible de la charge utile 22 dans l’espace de travail du portique 1, notamment selon l’axe X, la position cible et la position angulaire cible autour de l’axe Z de la charge utile 22. Les dispositifs de génération de consigne 14, 16 sont destinés à fournir les positions cible respectivement des moyens 2, 4 à partir de la position cible de la charge utile 22 fournie par le dispositif de supervision 13. Ainsi, par exemple, dans le cas d’une position angulaire cible nulle, les dispositifs de génération de consigne 14, 16 fournissent deux positions cible et identiques. The monitoring device 13 is intended to provide the target position of the payload 22 in the workspace of the gantry 1, in particular along the X axis, the target position and the target angular position around the axis Z of the payload 22. The setpoint generation devices 14, 16 are intended to supply the target positions respectively of the means 2, 4 from the target position of the payload 22 supplied by the supervision device 13. Thus, for example, in the case of a zero target angular position, the reference generation devices 14, 16 provide two target and identical positions.
[0015] Préférentiellement, la position angulaire cible est maintenue à zéro pendant les déplacements de la poutre 3 selon l’axe X et utilisée en fin de mouvement pour effectuer une correction angulaire. Mais cette rotation ne modifie en rien l’invention et n’est pas davantage expliquée dans la suite de la description. [0015] Preferably, the target angular position is maintained at zero during the movements of the beam 3 along the X axis and used at the end of the movement to make an angular correction. However, this rotation does not in any way modify the invention and is not further explained in the following description.
[0016] Les capteurs 18 et 20 sont destinés à fournir les positions réelles et de chacun des moyens d’entraînement 2, 4. De tels organes étant très connus, ils ne seront pas d’avantage expliqués ci-après. [0016] The sensors 18 and 20 are intended to provide the actual positions and of each of the drive means 2, 4. As such members are very well known, they will not be explained further below.
[0017] Comme visible à la fig. 2 , les dispositifs d’asservissement 15, 17 comportent en données d’entrée respectivement la position cible et la position réelle du premier moyen d’entraînement 2, la position cible et la position réelle du deuxième moyen d’entraînement 4. Les dispositifs d’asservissement 15 et 17 permettent alors de fournir en sortie respectivement les signaux de commande afin de faire tendre chaque position réelle vers leur consigne, respectivement avec un écart minimal. Les dispositifs d’asservissement 15 et 17 seront expliqués plus en détail ci-après. As visible in FIG. 2, the servo devices 15, 17 comprise as input data respectively the target position and the actual position of the first drive means 2, the target position and the actual position of the second drive means 4. The devices d The servo-control 15 and 17 then make it possible to respectively supply the control signals at output in order to make each real position tend towards their reference, respectively with a minimum difference. The control devices 15 and 17 will be explained in more detail below.
[0018] Le dispositif de compensation 19 comporte en données d’entrée les positions réelles des premier et deuxième moyens d’entraînement 2, 4 et les signaux de commande issus des dispositifs d’asservissement respectivement 15, 17. Le dispositif de compensation 19 permet de fournir en sortie respectivement les signaux de commande corrigés Le dispositif de compensation 19 sera expliqué plus en détail ci-après. The compensation device 19 comprises in input data the actual positions of the first and second drive means 2, 4 and the control signals from the servo devices 15, 17 respectively. The compensation device 19 allows to output respectively the corrected control signals The compensation device 19 will be explained in more detail below.
[0019] Les dispositifs d’amplification de puissance 21, 23 sont destinés chacun à fournir, à partir de chaque signal de commande corrigé la force correspondant à chacun des moyens d’entraînement 2, 4. De tels dispositifs étant également très connus, ils ne seront pas non plus d’avantage expliqués ci-après. The power amplification devices 21, 23 are each intended to provide, from each corrected control signal the force corresponding to each of the drive means 2, 4. Such devices are also very well known, they will not be further explained below.
[0020] Afin de pouvoir prendre en compte toutes les forces perturbatrices, un modèle caractéristique du portique 1 est utilisé comme visible à la fig. 3 . Le modèle caractéristique comprend les moyens d’entraînement 2, 4 qui ont des caractéristiques respectives de coefficients de frottement de Coulomb et visqueux mais également de masses Les moyens d’entraînement 2, 4 sont reliés chacun à des interfaces 7, 9 qui ont des caractéristiques respectives de coefficients de frottement visqueux et élastique Enfin, la poutre 3 et la tête 5 ont des caractéristiques respectives de masses et de longueurs Les valeurs de ces caractéristiques peuvent être déterminées par diverses méthodes telles que, par exemple, celles divulguées dans le document EP 1 467 266 ou par une séquence d’acquisitions temporelles de grandeurs physiques du système auquel on applique des consignes de mouvement. In order to be able to take into account all the disturbing forces, a characteristic model of the gantry 1 is used as shown in FIG. 3. The characteristic model comprises the drive means 2, 4 which have respective characteristics of Coulomb and viscous coefficients of friction but also of masses. The drive means 2, 4 are each connected to interfaces 7, 9 which have characteristics respective viscous and elastic coefficients of friction Finally, the beam 3 and the head 5 have respective characteristics of masses and lengths The values of these characteristics can be determined by various methods such as, for example, those disclosed in document EP 1 467 266 or by a sequence of temporal acquisitions of physical quantities of the system to which movement instructions are applied.
[0021] D’après le modèle ci-dessus, on comprend que, suivant la position de la tête 5 par rapport à la longueur de la poutre 3, le centre de gravité du portique 1 change. Il devient donc nécessaire de fournir une force différente pour chaque moyen d’entraînement 2, 4 si le centre de gravité de la tête 5 n’est pas parfaitement centré par rapport à la longueur de la poutre 3. From the above model, it is understood that, depending on the position of the head 5 relative to the length of the beam 3, the center of gravity of the gantry 1 changes. It therefore becomes necessary to provide a different force for each drive means 2, 4 if the center of gravity of the head 5 is not perfectly centered with respect to the length of the beam 3.
[0022] Dans l’explication ci-après, la tête 5 comporte ainsi les coordonnées et qui ont pour référentiel le centre d’une des faces principales de la poutre 3 comme illustré à la fig. 3 . Ces coordonnées représentent la position du centre de gravité de la tête 5 dans ce référentiel. On comprend donc que la coordonnée sera successivement positive ou négative afin de prendre en compte les modifications de forces perturbatrices. Cela permet de manière dynamique de minimiser en permanence l’angle que réalise la poutre 3 autour de l’axe Z. Les coordonnées et n’influencent pas la présente invention et ne sont plus mentionnées dans la suite du texte. Préférentiellement, afin de simplifier les équations, les coefficients de frottement visqueux et les coefficients élastique des interfaces 7, 9 sont regroupés sous la forme In the explanation below, the head 5 thus includes the coordinates and which have as reference the center of one of the main faces of the beam 3 as illustrated in FIG. 3. These coordinates represent the position of the center of gravity of the head 5 in this frame of reference. It is therefore understood that the coordinate will be successively positive or negative in order to take into account the modifications of disturbing forces. This dynamically makes it possible to permanently minimize the angle that the beam 3 achieves around the Z axis. The coordinates and do not influence the present invention and are no longer mentioned in the following text. Preferably, in order to simplify the equations, the viscous friction coefficients and the elastic coefficients of the interfaces 7, 9 are grouped together in the form
[0023] A partir du modèle caractéristique de la fig. 3 et en faisant l’hypothèse que la tête 5 reste immobile par rapport à la poutre 3 durant le mouvement des moyens d’entraînement 2 et 4, on peut déterminer les équations permettant de calculer les forces correspondantes à chacun des moyens d’entraînement 2, 4 selon les relations: [0023] From the characteristic model of FIG. 3 and by assuming that the head 5 remains stationary relative to the beam 3 during the movement of the drive means 2 and 4, the equations can be determined making it possible to calculate the forces corresponding to each of the drive means 2 , 4 according to the relations:
où: or:
avec: with:
[0024] Une approximation linéaire des fonctions trigonométriques est utilisée pour le calcul de l’angle du fait que la différence entre les deux positions et des deux moyens d’entraînement 2 et 4, qui permet les mouvements autour de l’axe Z, est de très faible amplitude devant la longueur de la poutre 3. En cas de formes géométriques complexes, il va de soi que le calcul des inerties de la relation (5) peut être affiné par l’homme de l’art. A linear approximation of the trigonometric functions is used for the calculation of the angle because the difference between the two positions and of the two drive means 2 and 4, which allows the movements around the Z axis, is of very small amplitude compared to the length of the beam 3. In the case of complex geometric shapes, it goes without saying that the calculation of the inertias of relation (5) can be refined by those skilled in the art.
[0025] Comme expliqué ci-dessus, dans le but de rendre nul en permanence l’angle que réalise la poutre 3 autour de l’axe Z, le système de régulation 11 comporte un dispositif de compensation 19. Ce dernier consiste ainsi à réaliser une estimation des perturbations liées à la poutre 3 de la relation (3) qu’il faut compenser pour chaque moyen d’entraînement 2, 4. Le dispositif de compensation 19 comporte une unité de commande corrective 25 comme visible à la fig. 2 qui comprend un module de calcul dynamique. Le module de calcul dynamique vérifie le schéma fonctionnel de la fig. 4 correspondant aux relations: As explained above, in order to permanently nullify the angle that the beam 3 achieves around the Z axis, the regulation system 11 comprises a compensation device 19. The latter thus consists in achieving an estimate of the disturbances linked to the beam 3 of relation (3) that must be compensated for for each drive means 2, 4. The compensation device 19 comprises a corrective control unit 25 as visible in FIG. 2 which includes a dynamic calculation module. The dynamic calculation module checks the functional diagram in fig. 4 corresponding to the relations:
et and
où: – représente une estimation du signal de correction à appliquer pour respectivement le premier et le deuxième moyens d’entraînement 2, 4; – représentent les coefficients permettant d’effectuer la correction; – représente la position réelle du premier moyen d’entraînement 2; – représente la position réelle du deuxième moyen d’entraînement 4; – et représente l’opérateur de Laplace. or: - represents an estimate of the correction signal to be applied for the first and second drive means 2, 4, respectively; - represent the coefficients used to make the correction; - represents the real position of the first drive means 2; - represents the real position of the second drive means 4; - and represents the operator of Laplace.
[0026] Afin de pouvoir éliminer les problèmes de couplage entre les moyens d’entraînement 2 et 4, c’est-à-dire les différences entre leur position et et, incidemment, obtenir un angle sensiblement nul, le module de calcul dynamique de l’unité de commande corrective 25 utilise, pour les relations (6) et (7), les valeurs: In order to be able to eliminate the problems of coupling between the drive means 2 and 4, that is to say the differences between their position and and, incidentally, obtain a substantially zero angle, the dynamic calculation module of the corrective control unit 25 uses, for relations (6) and (7), the values:
[0027] On peut classer ces coefficients dans l’ordre décroissant de leur importance: – est le coefficient de la commande corrective 25 relatif à l’inertie globale de la poutre 3 et de la tête 5. Il est absolument nécessaire pour obtenir de bonnes performances du système de régulation 11. – est le coefficient de la commande corrective 25 relatif à la répartition asymétrique de l’inertie de la tête 5 entre les axes et [0027] These coefficients can be classified in decreasing order of their importance: - is the coefficient of the corrective control 25 relative to the overall inertia of the beam 3 and of the head 5. It is absolutely necessary to obtain good performance from the regulation system 11. - is the coefficient of the corrective command 25 relating to the asymmetric distribution of the inertia of the head 5 between the axes and
– est le coefficient de la commande corrective 25 relatif à la constante élastique des liaisons flexibles 7, 9 de la poutre 3. – est le coefficient de la commande corrective 25 relatif à l’inertie en rotation de la poutre 3 avec la tête 5. – est le coefficient de la commande corrective 25 relatif à la constante de frottement visqueux des liaisons flexibles 7, 9 de la poutre 3. - is the coefficient of the corrective control 25 relating to the elastic constant of the flexible connections 7, 9 of the beam 3. - is the coefficient of the corrective control 25 relating to the rotational inertia of the beam 3 with the head 5. - is the coefficient of the corrective control 25 relative to the viscous friction constant of the flexible connections 7, 9 of the beam 3.
[0028] A l’aide de cette liste décroissante, on comprend que s’il est nécessaire de réduire le temps de calcul du dispositif de compensation 19, par exemple, pour des raisons de limitations matérielles de la puissance de calcul du processeur à disposition, il suffit de négliger autant de coefficients de moindre importance que nécessaire jusqu’à ladite limitation. On peut également choisir de négliger certains coefficients en fonction du système ou de l’application considérés. Using this decreasing list, we understand that if it is necessary to reduce the computing time of the compensation device 19, for example, for reasons of hardware limitations of the computing power of the processor available , it suffices to neglect as many coefficients of lesser importance as necessary up to said limitation. You can also choose to neglect certain coefficients depending on the system or application considered.
[0029] A titre d’exemple, dans un système construit au moyen de lames ressort pour les liaisons flexibles 7 et 9, le coefficient relatif à la constante de frottement visqueux peut être éliminé car négligeable. De plus, si le mouvement de rotation est inhibé par une configuration particulière du portique 1, le coefficient relatif à l’inertie en rotation de la poutre 3 avec la tête 5 devient superflu. [0029] For example, in a system constructed by means of leaf springs for the flexible connections 7 and 9, the coefficient relating to the viscous friction constant can be eliminated because it is negligible. In addition, if the rotational movement is inhibited by a particular configuration of the gantry 1, the coefficient relating to the rotational inertia of the beam 3 with the head 5 becomes superfluous.
[0030] Dans une variante de la présente invention, le dispositif de compensation 19, comme visible à la fig. 6 , comporte les positions cible et comme entrées supplémentaires. Ainsi, l’unité de commande corrective 25 peut utiliser les positions réelles et les positions cible et ou une de leur combinaison. In a variant of the present invention, the compensation device 19, as visible in FIG. 6, has target positions and as additional inputs. Thus, the corrective control unit 25 can use the actual positions and the target positions and or a combination thereof.
[0031] En effet, l’estimation du signal de correction requiert la connaissance de la dérivée double des positions réelles et représentée par le terme s2 dans les relations (6) et (7). Ce calcul peut être rendu difficile par la présence de bruit dans les mesures de positions et ce qui peut rendre obligatoire l’utilisation de filtres impliquant une dégradation des performances de l’unité de commande corrective 25. In fact, the estimation of the correction signal requires knowledge of the double derivative of the real positions and represented by the term s2 in relations (6) and (7). This calculation can be made difficult by the presence of noise in the position measurements and which can make compulsory the use of filters involving a degradation of the performance of the corrective control unit 25.
[0032] Par conséquent, il peut être préférable d’employer la dérivée double des positions de consigne et qui ont l’avantage de n’être entachées d’aucun bruit perturbateur. [0032] Therefore, it may be preferable to use the double derivative of the setpoint positions which have the advantage of not being affected by any disturbing noise.
[0033] Préférentiellement, l’utilisation d’une telle combinaison des positions réelles et cible de ladite variante de l’unité de commande corrective 25 est utilisée pour remplacer les positions réelles par les positions cible pour le calcul des coefficients et Preferably, the use of such a combination of the real and target positions of said variant of the corrective control unit 25 is used to replace the real positions with the target positions for the calculation of the coefficients and
[0034] Le module de calcul dynamique de l’unité de commande corrective 25 vérifie alors le schéma fonctionnel de la figure 6 et les relations (6) et (7) sont remplacées par les relations suivantes: The dynamic calculation module of the corrective control unit 25 then checks the functional diagram of FIG. 6 and the relationships (6) and (7) are replaced by the following relationships:
et and
[0035] Pour ces deux variantes de l’unité de commande corrective 25, comme on peut le voir dans les relations (8), seuls les coefficients et vont changer en fonction de la position de la tête 5 par rapport à la poutre 3. Grâce au dispositif de compensation 19, la poutre 3 du portique 1 avance ainsi toujours sensiblement parallèlement à l’axe Y. En théorie, les forces appliquées par le dispositif de compensation 19 permettent de découpler virtuellement, au moyen l’unité de commande corrective 25, les moyens d’entraînement 2, 4 du portique 1. Il devient donc nécessaire d’inclure, dans le système de régulation 11, un dispositif d’asservissement 15, 17 pour chaque moyen d’entraînement 2, 4 virtuellement indépendants. For these two variants of the corrective control unit 25, as can be seen in relations (8), only the coefficients and will change depending on the position of the head 5 relative to the beam 3. Thanks to the compensation device 19, the beam 3 of the gantry 1 thus always advances substantially parallel to the Y axis. In theory, the forces applied by the compensation device 19 make it possible to virtually decouple, by means of the corrective control unit 25. , the drive means 2, 4 of the gantry 1. It therefore becomes necessary to include, in the regulation system 11, a control device 15, 17 for each drive means 2, 4 virtually independent.
[0036] De plus, les termes calculés par l’unité de commande corrective 25 ne sont que des estimations des forces réelles appliquées sur le système physique. Les dispositifs d’asservissement 15, 17 permettent donc également de rejeter les perturbations extérieures aux moyens d’entraînement 2 et 4, en partie dues aux imperfections et imprécisions du modèle. [0036] In addition, the terms calculated by the corrective control unit 25 are only estimates of the actual forces applied to the physical system. The control devices 15, 17 therefore also make it possible to reject disturbances external to the drive means 2 and 4, in part due to imperfections and inaccuracies in the model.
[0037] Chaque dispositif d’asservissement 15, 17 fonctionne de manière indépendante en boucle fermée et comporte un module de calcul dynamique qui préférentiellement vérifie le schéma fonctionnel de la fig. 5 correspondant à la relation: Each slaving device 15, 17 operates independently in a closed loop and comprises a dynamic calculation module which preferably checks the functional diagram of FIG. 5 corresponding to the relation:
où: – représente le signal de commande du moyen d’entraînement ; – représentent les coefficients permettant d’effectuer l’asservissement du moyen d’entraînement ; – représente la position consigne du moyen d’entraînement ; – représente la position réelle du moyen d’entraînement ; – et représente l’opérateur de Laplace. or: - represents the control signal of the drive means; - represent the coefficients allowing the control of the drive means; - represents the setpoint position of the drive means; - represents the actual position of the drive means; - and represents the operator of Laplace.
[0038] Ce type de dispositif d’asservissement est cité à titre d’exemple et peut être remplacé par toute autre topologie équivalente comme, par exemple, du type PID, polynomial ou à boucles cascadées. This type of control device is cited by way of example and can be replaced by any other equivalent topology such as, for example, of the PID, polynomial or cascaded loop type.
[0039] Préférentiellement, on déterminera avant l’utilisation effective du portique 1 les coefficients par une méthode du type «placement de pôles» qui est une méthode connue pour déterminer de tels coefficients de dispositifs d’asservissement comme ceux 15, 17. D’autres méthodes peuvent toutefois être utilisées sans influencer la présente invention. L’utilisation de tels coefficients constants doit permettre d’obtenir le même comportement dynamique entre les premier et deuxième moyens d’entraînement 2, 4. Par conséquent, chaque dispositif d’asservissement 15, 17 doit vérifier les relations: Preferably, the coefficients will be determined before the actual use of the gantry 1 by a method of the "pole placement" type which is a known method for determining such coefficients of control devices such as those 15, 17. D ' other methods can however be used without influencing the present invention. The use of such constant coefficients must make it possible to obtain the same dynamic behavior between the first and second drive means 2, 4. Therefore, each servo device 15, 17 must verify the relationships:
[0040] Préférentiellement, comme visible à la fig. 2 , le dispositif de compensation 19 comporte également des modules additionneurs 27 et 29 afin de compenser chaque signal de commande de chaque dispositif d’asservissement 15, 17 avec chaque signal de correction du dispositif de compensation 19 afin de fournir deux signaux de commande corrigés aptes à servir de données d’entrée pour respectivement les dispositifs d’amplification de puissance 21, 23. Preferably, as visible in FIG. 2, the compensation device 19 also comprises adder modules 27 and 29 in order to compensate each control signal from each servo device 15, 17 with each correction signal from the compensation device 19 in order to provide two suitable corrected control signals. to serve as input data for the power amplification devices 21, 23 respectively.
[0041] On observe dans l’équation (12) que les paramètres des deux dispositifs d’asservissement 15, 17 ne dépendent pas de la position de la tête 5. En effet, la modification de la répartition de l’inertie de la poutre 3 entre les positions et est entièrement prise en compte par le dispositif de compensation 19 au niveau de son unité de commande corrective 25. It is observed in equation (12) that the parameters of the two control devices 15, 17 do not depend on the position of the head 5. Indeed, the modification of the distribution of the inertia of the beam 3 between the positions and is fully taken into account by the compensation device 19 at its corrective control unit 25.
[0042] Il existe une troisième variante de l’unité de commande corrective 25 présentée ci-dessus qui permet de réduire le volume de calculs à effectuer par l’unité de commande corrective 25. Elle consiste à transformer le modèle de la fig. 3 en un modèle qui ne comporte plus que 3 masses équivalentes et Ces masses équivalentes ne sont plus des grandeurs physiques, mais des paramètres équivalents qui dépendent de la position de la tête 5 selon l’axe Y par la relation suivante: There is a third variant of the corrective control unit 25 presented above which makes it possible to reduce the volume of calculations to be carried out by the corrective control unit 25. It consists in transforming the model of FIG. 3 in a model which has only 3 equivalent masses and These equivalent masses are no longer physical quantities, but equivalent parameters which depend on the position of the head 5 along the Y axis by the following relation:
On peut aussi écrire l’inertie équivalente de l’ensemble constitué de la poutre 3 et de la tête 5 au moyen de l’équation suivante: We can also write the equivalent inertia of the assembly consisting of beam 3 and head 5 by means of the following equation:
[0043] En dérivant les équations dynamiques, on peut à nouveau calculer les coefficients requis pour l’unité de commande corrective 25, qui diffèrent à présent de l’équation (8): By deriving the dynamic equations, we can again calculate the coefficients required for the corrective control unit 25, which now differ from equation (8):
[0044] On observe ci-dessus que les calculs sont réduits pour l’unité de commande corrective 25, car un des coefficients est toujours nul. En contrepartie, on doit à présent faire dépendre les coefficients des dispositifs d’asservissement 15, 17 de la position de la tête 5 selon l’axe Y. En effet, l’équation (12) devient: [0044] It is observed above that the calculations are reduced for the corrective control unit 25, because one of the coefficients is always zero. On the other hand, we must now make the coefficients of the control devices 15, 17 depend on the position of the head 5 along the Y axis. Indeed, equation (12) becomes:
[0045] On voit que les coefficients dépendent à présent des masses équivalentes qui dépendent de la position de la tête 5. Ainsi, l’économie de temps de calculs réalisée au niveau de l’unité de commande corrective 25 est annulée par un surcroît de calculs au niveau des dispositifs d’asservissement 15 et 17. De plus, rendre variables les coefficients des dispositifs d’asservissement 15, 17 mène à des difficultés théoriques pour démontrer la stabilité et la robustesse du système de régulation 11. It can be seen that the coefficients now depend on the equivalent masses which depend on the position of the head 5. Thus, the saving in calculation time carried out at the level of the corrective control unit 25 is canceled out by an increase in calculations at the level of the control devices 15 and 17. In addition, making the coefficients of the control devices 15, 17 variable leads to theoretical difficulties in demonstrating the stability and robustness of the regulation system 11.
[0046] Grâce aux deux premières variantes du système de régulation 11, le portique 1 est déplacé selon l’axe X avec des moyens d’entraînement 2, 4 qui sont synchronisés c’est-à-dire que la poutre 3 garde en permanence un angle par rapport à l’axe Z sensiblement nul. De plus, le mouvement obtenu est réalisé avec un écart minimal par rapport à la consigne Thanks to the first two variants of the regulation system 11, the gantry 1 is moved along the X axis with drive means 2, 4 which are synchronized, that is to say that the beam 3 keeps permanently an angle with respect to the Z axis substantially zero. In addition, the movement obtained is carried out with a minimum deviation from the setpoint.
[0047] Bien entendu, la présente invention ne se limite pas à l’exemple illustré mais est susceptible de diverses variantes et modifications qui apparaîtront à l’homme de l’art. En particulier, les calculs des coefficients et peuvent être affinés par une détermination dynamique des coefficients de frottement et en fonction de la température mesurée sur chacune des interfaces 7 et 9. [0047] Of course, the present invention is not limited to the example illustrated but is susceptible to various variations and modifications which will be apparent to those skilled in the art. In particular, the calculations of the coefficients and can be refined by a dynamic determination of the friction coefficients and as a function of the temperature measured on each of the interfaces 7 and 9.
Claims (14)
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| FR0853033A FR2930936B1 (en) | 2008-05-07 | 2008-05-07 | SYSTEM FOR CONTROLLING A DOUBLE-MEDIUM DRIVING GANTRY |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CH698856A2 CH698856A2 (en) | 2009-11-13 |
| CH698856B1 true CH698856B1 (en) | 2014-07-15 |
Family
ID=40076981
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CH00662/09A CH698856B1 (en) | 2008-05-07 | 2009-04-28 | Regulation system of a gantry with double drive means. |
Country Status (3)
| Country | Link |
|---|---|
| CH (1) | CH698856B1 (en) |
| DE (1) | DE102009008900B4 (en) |
| FR (1) | FR2930936B1 (en) |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE102012207110A1 (en) * | 2012-04-27 | 2013-10-31 | Homag Holzbearbeitungssysteme Ag | Vibration damping system |
| EP2783791B1 (en) | 2013-03-27 | 2015-11-18 | Etel S. A.. | Positioning device in the form of a portal |
| EP2849011B1 (en) | 2013-09-11 | 2019-03-06 | Etel S. A.. | Positioning device |
| DE102013226448A1 (en) | 2013-12-18 | 2015-06-18 | Etel S.A. | positioning |
| EP3670067B1 (en) | 2018-12-20 | 2022-07-27 | Etel S.A. | Positioning device in portal design |
| DE102019112611B3 (en) * | 2019-05-14 | 2020-10-29 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Method for determining a control parameter of an actuator and an actuator for carrying out such a method |
Family Cites Families (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5085824A (en) * | 1991-01-31 | 1992-02-04 | General Electric Company | Nuclear refueling platform drive system |
| FI100594B (en) * | 1996-09-13 | 1998-01-15 | Kci Kone Cranes Internat Oy | A system for controlling a device, such as a crane jetty, which moves on wheels on rails |
| US5917300A (en) * | 1997-03-10 | 1999-06-29 | Convolve, Inc. | Method and apparatus for the control of gantry machines |
| EP1107067B1 (en) * | 1999-12-01 | 2006-12-27 | ASML Netherlands B.V. | Positioning apparatus and lithographic apparatus comprising the same |
| JP3537416B2 (en) * | 2001-12-19 | 2004-06-14 | ファナック株式会社 | Servo control device |
| JP3923047B2 (en) * | 2003-03-04 | 2007-05-30 | ファナック株式会社 | Synchronous control device |
| DE10316977A1 (en) | 2003-04-12 | 2004-10-21 | Etel S.A. | Method for analyzing a drive system |
| JP4391883B2 (en) * | 2004-05-19 | 2009-12-24 | 住友重機械工業株式会社 | MOBILE POSITION CONTROL DEVICE AND STAGE DEVICE USING THE CONTROL DEVICE |
| NL1027851C2 (en) * | 2004-12-22 | 2006-06-27 | Assembleon Nv | Method for controlling a dynamic system as well as such a device. |
| US8109395B2 (en) * | 2006-01-24 | 2012-02-07 | Asm Technology Singapore Pte Ltd | Gantry positioning system |
-
2008
- 2008-05-07 FR FR0853033A patent/FR2930936B1/en active Active
-
2009
- 2009-02-13 DE DE102009008900.4A patent/DE102009008900B4/en active Active
- 2009-04-28 CH CH00662/09A patent/CH698856B1/en unknown
Also Published As
| Publication number | Publication date |
|---|---|
| FR2930936A1 (en) | 2009-11-13 |
| FR2930936B1 (en) | 2010-08-13 |
| CH698856A2 (en) | 2009-11-13 |
| DE102009008900B4 (en) | 2018-01-04 |
| DE102009008900A1 (en) | 2009-11-12 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CH698856B1 (en) | Regulation system of a gantry with double drive means. | |
| EP1713173B1 (en) | Method for adjusting parameters of an electric motor and variable speed drive using such a method | |
| FR2904163A1 (en) | METHOD FOR ADJUSTING PARAMETERS OF A SYNCHRONOUS MOTOR AND SPEED VARIATOR USING SUCH A METHOD | |
| WO2006131664A1 (en) | Device for automatically adjusting servo controls of a movement mechanical simulator and an associated device | |
| EP3472676B1 (en) | Method for compensating for coriolis, centrifugal and gravitational torques in a movement simulator and movement simulator system | |
| EP3338147B1 (en) | System for controlling a controlled parameter | |
| FR2925669A1 (en) | MEASUREMENT BY GYROSCOPIC SYSTEM | |
| FR2900360A1 (en) | METHOD AND DEVICE FOR SETTING OPERATING PARAMETERS OF A ROBOT, PROGRAM, AND RECORDING MEDIUM FOR THIS METHOD | |
| FR3077638A1 (en) | Method for measuring the unbalance of elastic shaft rotors by means of displacement sensors | |
| FR3104856A1 (en) | Method for determining the position and / or speed of a rotor of an electrical machine by processing signals from a position sensor | |
| EP3158213A1 (en) | Torque estimator for double clutch | |
| FR2931003A1 (en) | METHOD AND DEVICE FOR THE ROBUST REJECTION OF PERIODIC INTERRUPTIONS IN AN AXIS POSITION CONTROL LOOP | |
| WO2015036718A1 (en) | Determination of torque in a motor vehicle power transmission chain | |
| CA2861954C (en) | Control of a permanent-magnet electric machine | |
| EP3287237A1 (en) | Screwing device with optimised output torque measurement, and method for determining the corresponding output torque | |
| CA2827403C (en) | Method for calibrating a torquemeter | |
| EP2558819B1 (en) | Gyroscopic measurement in a navigation system | |
| EP1406141B1 (en) | Process and device to automatically control the thrust of an aircraft engine | |
| FR2854848A1 (en) | Piloted connection for motor vehicle internal combustion engine and transmission has pilot module for actuator using torque signal for clutch control | |
| WO2002097546A1 (en) | Method and device for controlling angular speed of an electromechanical chain with low damping | |
| EP3721300B1 (en) | Method for optimising the performance of a servo control system of a mechatronic system, and suitable device | |
| EP2618163A1 (en) | Method for measuring a physical parameter and electronic circuit to interface with a capacitive sensor for implementing same | |
| FR2876339A1 (en) | AUTOMOTIVE VEHICLE REAR WHEEL TURNING CONTROL IN BRAKING CONDITION WITH ASYMMETRIC ADHESION | |
| FR3107367A1 (en) | Transfer function measurement in a mechatronic system | |
| EP3785000A1 (en) | Method and system for processing a temperature measurement signal delivered by a sensor |