EP3305710A1 - Method for controlling an anti-oscillatory crane with a third-order filter - Google Patents
Method for controlling an anti-oscillatory crane with a third-order filter Download PDFInfo
- Publication number
- EP3305710A1 EP3305710A1 EP17190875.9A EP17190875A EP3305710A1 EP 3305710 A1 EP3305710 A1 EP 3305710A1 EP 17190875 A EP17190875 A EP 17190875A EP 3305710 A1 EP3305710 A1 EP 3305710A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- load
- max
- trol
- pulsation
- setpoint
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C13/00—Other constructional features or details
- B66C13/04—Auxiliary devices for controlling movements of suspended loads, or preventing cable slack
- B66C13/06—Auxiliary devices for controlling movements of suspended loads, or preventing cable slack for minimising or preventing longitudinal or transverse swinging of loads
- B66C13/063—Auxiliary devices for controlling movements of suspended loads, or preventing cable slack for minimising or preventing longitudinal or transverse swinging of loads electrical
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C23/00—Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes
- B66C23/16—Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes with jibs supported by columns, e.g. towers having their lower end mounted for slewing movements
Definitions
- the gross control setpoint (suspended load speed setpoint) expressed by the driver of the machine is advantageously carried out a planning of the profile of the speed reference that we will apply to the drive motors, that is to say that we plan the evolution over time (and more particularly the rate of change per unit of time) of the value of the instruction of execution (trolley speed reference value), according to an evolution profile which best reflects the desired control setpoint but which is also and above all compatible with the ability of the motors to provide a response that is at each moment up to said performance instruction.
- the proposed third-order filter simplifies the implementation of appropriate saturations, during the processing of the control setpoint, and thus the implementation of "intelligent" dynamic limits of the execution instruction, which make it possible to draw the best of the drive motors while ensuring a permanent, precise and reliable control of the movements of the point of attachment and the suspended load.
- control method according to the invention advantageously makes it possible to control the hoist by an open-loop servocontrol, simply by applying the execution instruction (speed reference) to the drive motor concerned, without Require no measurement of the effective dangling (that is, without the need for feedback on the actual angle of the balloon), which limits the number of sensors and the computing power necessary to control, and therefore reduces the complexity, congestion, and energy consumption of the steering system.
- the present invention relates to a method for controlling the movement of a load 1 suspended at a point of attachment H of a hoist 2.
- the hoist 2 is designed so as to be able to move the point of attachment H , and consequently the suspended load 1, according to a component of yaw rotation ⁇ about a first vertical axis (ZZ '), called " axis of orientation ", and / or according to a radial component R , corresponding to a movement called" distribution ", here in translation along a second axis (DD ') said” distribution axis "intersecting said axis of orientation (ZZ '), as illustrated in the Figures 1 and 2 .
- the hoist 2 may in particular form a tower crane, whose mast 3 materializes the axis of orientation (ZZ '), and whose arrow 4 materializes the axis of distribution (DD'), as it is illustrated on the figure 1 .
- the point of attachment H is preferably formed by a carriage 5, which can advantageously be guided in translation along the distribution axis (DD '), along the arrow 4.
- the orientation movement ⁇ , and, respectively, the dispensing movement R , and more particularly the drive movement of the carriage 5 in translation R along the arrow 4, can be provided by any drive motor 7, 8 suitable, preferably electric, and more particularly by at least one (electric) motor 8 and, respectively, a motor (electric) distribution 7.
- the load 1 is suspended at the point of attachment H by a suspension device 6, such as a suspension cable.
- a suspension device such as a suspension cable.
- said suspension device will be assimilated to such a suspension cable 6, for convenience.
- the suspended load 1 may also preferably be moved in a vertical component, called "lifting", so as to vary the height at which the suspended load 1 relative to the ground.
- the method comprises a control instruction acquisition step (a) during which a setpoint known as a "control setpoint" V u is acquired that is representative of a traveling speed V load that the driver of the hoist 2 wishes to confer on the suspended load 1.
- the method according to the invention then comprises a step (b) of processing during which is developed, from said control setpoint V u , here by means of a processing module 10, an instruction called "instruction d ' V trol , which is intended to be applied to at least one drive motor 7, 8 to move the suspended load 1, and, more particularly, to move the carriage 5 to which said load 1 is suspended.
- the method makes it possible to control the speed, rather than the trajectory, and more particularly to control the speed of the carriage 5, from a speed reference V u which corresponds to the desired speed. for suspended load 1.
- the execution instruction V trol will preferably express the speed setpoint that must reach the point of attachment H (that is to say, the speed setpoint that must reach the carriage 5).
- the method according to the invention is valid both for controlling the orientation movement ⁇ and for controlling the dispensing movement R , or for controlling any combination of these two movements simultaneously.
- each mobile member considered a Frenet coordinate system making it possible to express the radial component V r (according to the distribution movement R ) and the orthoradial component V ⁇ (according to the tangent to the orientation movement ⁇ ) of the speed of the movable member in question, as shown in particular in FIG. figure 5 .
- the carriage 5 necessarily has a finite (bounded) acceleration.
- V ⁇ load d 2 d t 2 V load the speed of the suspended load (driving speed) V load .
- the treatment step (b) advantageously comprises a regulation sub-step (b4) C 3 during which the driving instruction V u is processed so as to confer on said control setpoint V u of the properties of differentiability third with respect to time and of continuity with respect to time, in order to generate, from said control setpoint V u , a filtered control setpoint V f which is of class C 3 , then the execution setpoint V trol is set from said filtered control setpoint V f .
- the regularization C 3 can be carried out using interpolation polynomials.
- control setpoint V u is interpolated, and more particularly several or all of the values considered among the succession of different values taken by the control setpoint V u during a given time interval, by means of a polynomial.
- Such a polynomial thus provides a class C 3 planning of the control set.
- control setpoint V u is applied to regulate C 3 said control setpoint, a third order filter F3 in order to generate the filtered control setpoint V f which is of class C 3 .
- the sub-step (b4) preferably constitutes a third-order filter sub-step in the course of which a third-order filter F3 is applied to the control setpoint V u in order to generate an instruction of filtered control V f which is three times differentiable (and more exactly regularity class C 3 ).
- the regularization C3, and more particularly the third-order filtering is performed by means of a third-order filtering module 12, formed by a computer or electronic computer.
- the filtered control setpoint V f is intrinsically defined, and more generally "planned", so as to gradually converge towards the control setpoint V u , without ever being too stiff.
- This conversion formula simple and fast to execute, has the advantage of being intrinsically an anti-dangling function.
- the above conversion formula comes from a simplified model of pendulum, in which it is considered that the swing angle ⁇ is almost zero, that is to say that the suspended load 1 is not balanced not (or almost no) with respect to the carriage 5.
- the determination of the execution instruction V trol according to the invention with regularization C 3 on the one hand and use of the anti-dangling conversion formula mentioned above on the other hand, however, it will be possible to generate an execution instruction (trolley speed reference) V trol already optimized, not generating a dangling (intrinsically), so that the dancer compensation task assigned to the closed loop of the servo will be greatly simplified. (since this will only reduce possible dangling caused by the only disturbances external to the control system).
- drive motors 7, 8 have, by their nature, limited (finite) speed, acceleration, and torque capabilities.
- V trol execution instruction is compatible with these capabilities, so that the motors 7, 8 can actually execute said V trol execution instruction , and thus generate, as a result of the application of said V trol performance instruction to said motors 7, 8, movements of the carriage 5 and the suspended load 1 without dangling, which are consistent with the movements that are expected with respect to said performance instruction.
- said parameter chosen as representative of the maximum acceleration MAX admissible by the drive motor 7.8 may be the pulsation ⁇ of the third order filter F3, in the form of a so-called "calculated pulsation" pulse ⁇ 0 which will be determined in particular according to said maximum acceleration value permissible at MAX .
- the inventors have indeed established that there is a link between pulsation and maximum acceleration.
- the processing step (b) may therefore preferably comprise a sub-step (b1) for adjusting the pulsation of the third-order filter F3, during which the pulsation ⁇ , ⁇ 0 of said filter of the filter is calculated.
- third order F3 from a value a MAX which is representative of the maximum acceleration that the driving motor 7, 8 can give to the point of attachment H to which the load 1 is suspended.
- the step (b) processing will preferably comprise a sub-step (b1) for adjusting the pulsation ⁇ of the third order filter F3, during which the third order filter's pulsation ⁇ is adjusted, and more particularly the calculated pulsation ⁇ 0 , depending on the value of the control setpoint V u , V JOY applied by the driver of the hoist at time t considered.
- the value of the pulsation ⁇ of the third order filter F3 is modified according to whether the control set point V u , V JOY is lower or on the contrary higher than a reference speed V thresh which is defined from the value of maximum speed V MAX that the driving motor 7, 8 can give to the point of attachment H to which the load 1 is suspended.
- the pulsation ⁇ will be varied so as to increase said pulsation ⁇ and thus use a pulsation considered as high, called "high value" ⁇ high , and therefore a more reactive filter F3, when the absolute value of the pilot setpoint (that is to say the amplitude of the speed reference) V u , V JOY is low compared to the maximum permissible speed V MAX , and decreasing on the contrary said pulsation ⁇ in favor of a lower pulsation so-called "low value” ⁇ low , when the absolute value of the driving setpoint V u , V JOY will increase to approach the maximum permissible speed V MAX .
- the dual purpose of this adaptation (in real time) of the pulsation ⁇ is to optimize the reactivity of the third order filter 3 (constraint No. 2) by increasing said pulsation ⁇ when possible, because the response time of the filter F3 is inversely proportional to said pulsation ⁇ (with the coefficients c 1 , c 2 chosen as indicated above, the response time at 5% is of the order of 4 / ⁇ ), while respecting the constraint No. 3 related not exceeding the maximum acceleration capacity of the drive motor 7, 8, which sets an allowable upper limit for said pulsation ⁇ .
- the inventors have empirically found that, in order to avoid destabilizing the third order filter F3, especially during transitions between the high value ⁇ high and the low value ⁇ low , the (calculated) pulse ⁇ , ⁇ 0 should be two once differentiable (in relation to time).
- the filter of the third order F3 uses as pulsation ⁇ a filtered calculated pulse ⁇ F.
- V u 0 m / s.
- the pulse ⁇ , ⁇ F of the third order filter F3 is then close to, or equal to, its high value ⁇ high .
- V u V MAX .
- V u V MAX .
- the first saturation law SAT1 is applied to the raw setpoint (in speed) V JOY , before the third order filtering F3, so as to form (at the output of the first saturation module 15) the control setpoint V u which is then sent to the third order filter F3.
- the solution proposed by the inventors consists in limiting the execution setpoint V trol when it reaches a predefined allowable limit (typically +/- V MAX ), by suitably saturating the driving setpoint V u .
- the processing step (b) preferably comprises a sub-step (b3) of secondary saturation, which is intended to keep the execution instruction (ie the setpoint of speed of the point of attachment H ) V trol when said performance instruction V trol reaches substantially the maximum speed V MAX that the drive motor 7, 8 can give to the point of attachment H (that is to say say in practice to the carriage 5).
- V trol performance set constant As indicated above, it is sought to keep the constant V trol performance set constant or to decrease it when it reaches the maximum permissible speed V max .
- V u the driving setpoint
- the step (b) of treatment preferably comprises, according to a characteristic which can constitute an invention in its own right. but which will preferably be implemented in addition to the first saturation law SAT1, a substep (b5) of saturation of the third derivative of the filtered control setpoint during which the third (temporal) derivative V ⁇ is applied to f of the filtered control set V f a third saturation law SAT3 whose saturation thresholds depend on the maximum acceleration a MAX (typically as defined above) that the drive motor 7, 8 can give to the point d H hook to which the load is suspended 1.
- the control of the crane is carried out - in a fairly intuitive way for the driver - in distribution (modification of the radius r) and in orientation (modification of the azimuth ⁇ ), the driving setpoint V u , V JOY , as well as the execution instruction V trol , will each comprise a distribution component, intended for the engine 7 distribution (which allows to act on the spoke) and an orientation component, for the motor 8 orientation (which allows to to act on the azimuth).
- the most appropriate coordinate system will be the spherical coordinate system, in which the position of the carriage 5 is located (and driven) by its azimuth (orientation of the luffing arrow in yaw), its declination (orientation of the luffing arrow in pitch) and its radius (distance from the carriage relative to the articulated base of the luffing jib).
- the length L of the suspension cable 6 can be known in real time by means of a sensor measuring the absolute rotation of the winch or the hoisting motor which generates the winding of said suspension cable 6.
- r load (0) r trol (0), where "0" corresponds to an initial moment when the system is at rest .
- the invention as such relates to the implementation of a regularization C 3 , and more particularly to the implementation of the third order filter F 3 , respectively of all or some of the laws of saturation, regardless of the type of calculation used to determine the components of the V trol execution instruction .
- the invention also relates to a control box for a lifting vehicle, comprising one and / or the other of the modules (that is to say computers, electronic and / or computer) for regularization C 3 / filtering third order 12, conversion 13, pulse adjustment 14, or saturation 15, 16, 17 described above, and a hoist 2 equipped with such a control box.
- a control box for a lifting vehicle comprising one and / or the other of the modules (that is to say computers, electronic and / or computer) for regularization C 3 / filtering third order 12, conversion 13, pulse adjustment 14, or saturation 15, 16, 17 described above, and a hoist 2 equipped with such a control box.
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Control And Safety Of Cranes (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
La présente invention concerne un procédé de commande du déplacement d'une charge (1) suspendue à un point d'accroche (H) d'un engin de levage (2), ledit procédé comprenant une étape (a) d'acquisition au cours de laquelle on acquiert une « consigne de pilotage » (V u ) représentative de la vitesse de déplacement que le conducteur souhaite conférer à la charge (1) suspendue, puis une étape (b) de traitement au cours de laquelle on élabore, à partir de ladite consigne de pilotage (Vu), une consigne dite « consigne d'exécution » (V trol ) qui est appliquée à un moteur d'entraînement (7, 8) afin de déplacer la charge suspendue (1), l'étape (b) de traitement comportant une sous-étape (b4) de régularisation C 3 par filtrage du troisième ordre au cours de laquelle on applique à la consigne de pilotage (V u ) un filtre du troisième ordre (F3) afin de générer une consigne de pilotage filtrée (V f ) de classe de régularité C 3 , puis l'on définit la consigne d'exécution (V trol ) à partir de ladite consigne de pilotage filtrée (V f ).The present invention relates to a method for controlling the movement of a load (1) suspended at a point of attachment (H) of a hoist (2), said method comprising a step (a) of acquisition during from which a "steering setpoint" (V u) representative of the traveling speed that the driver wishes to give to the suspended load (1) is acquired, followed by a processing step (b) during which, starting from of said steering setpoint (Vu), a so-called "instruction setpoint" (V trol) which is applied to a drive motor (7, 8) in order to move the suspended load (1), the step ( b) processing comprising a third order filtering sub-step (b4) C 3 by means of which a third order filter (F3) is applied to the control setpoint (V u) in order to generate a setpoint of filtered control (V f) of regularity class C 3, then the setpoint is defined execution (V trol) from said filtered control setpoint (V f).
Description
La présente invention se rapporte au domaine général des engins de levage, du genre grues, et plus particulièrement du genre grues à tour, qui comportent un point d'accroche mobile, du genre chariot, auquel on peut suspendre une charge à déplacer, dite « charge suspendue », et qui sont équipés d'un système de pilotage permettant de réaliser la mise en mouvement et le contrôle du déplacement de ladite charge suspendue.The present invention relates to the general field of lifting gear, of the crane type, and more particularly of the type tower cranes, which comprise a mobile attachment point, of the trolley type, which can be suspended a load to move, called " suspended load ", and which are equipped with a control system for carrying out the movement and control of the displacement of said suspended load.
La présente invention se rapport plus particulièrement aux procédés de commande destinés à gérer le système de pilotage de tels engins de levage.The present invention relates more particularly to control methods for managing the steering system of such lifting gear.
Généralement, de tels procédés de commande, qui sont destinés à fournir une assistance au pilotage de l'engin, comprennent une étape d'acquisition d'une consigne de pilotage, au cours de laquelle on recueille la consigne de vitesse qui est exprimée par le conducteur de l'engin de levage et qui correspond à la vitesse que ledit conducteur souhaite conférer à la charge suspendue, puis une étape de traitement au cours de laquelle on élabore, à partir de ladite consigne de pilotage, une consigne d'exécution qui est appliquée au(x) moteurs(s) d'entraînement qui permettent de déplacer ladite charge suspendue.Generally, such control methods, which are intended to provide assistance in the control of the machine, comprise a step of acquiring a control instruction, during which the speed instruction is collected which is expressed by the driver of the lifting machine and which corresponds to the speed that said driver wishes to give to the suspended load, then a processing step during which is developed from said driving instruction, a performance instruction which is applied to the drive motor (s) that move said suspended load.
En outre, afin d'assurer la précision et la sécurité des opérations de transport de la charge suspendue, les procédés de commande connus cherchent généralement à contrôler, et plus particulièrement à limiter, l'amplitude des oscillations pendulaires, ou « ballant », auxquelles la charge suspendue peut être sujette lors des mouvements du chariot.In addition, in order to ensure the precision and safety of the suspended load transport operations, the known control methods generally seek to control, and more particularly to limit, the amplitude of the oscillatory oscillations, or "swinging", to which the suspended load may be subject to carriage movement.
A cet effet, il est en particulier connu de combattre le ballant par un asservissement en boucle fermée, dans lequel on mesure les valeurs réelles de position et de vitesse du chariot, ainsi que la valeur de l'angle de ballant de la charge, pour pouvoir générer une correction de la consigne qui est appliquée aux moteurs qui actionnent le chariot et qui vise à réduire ledit ballant.For this purpose, it is known in particular to combat the ballast by a closed loop servo, in which the actual values of the position and speed of the carriage are measured, as well as the value of the swing angle of the load, for to be able to generate a correction of the setpoint which is applied to the motors which actuate the carriage and which aims at reducing said dangling.
Si un tel système permet effectivement d'atténuer le ballant, il peut toutefois présenter certains inconvénients.If such a system effectively mitigates the dangling, it may however have some disadvantages.
En effet, un tel asservissement en boucle fermée impose la mise en oeuvre de nombreux capteurs, destinés par exemple à mesurer l'angle réel de ballant, ce qui accroît la complexité, et par conséquent le coût, ainsi que le risque de défaillance, du système de pilotage, et plus globalement de l'engin de levage équipé dudit système de pilotage.Indeed, such a closed-loop servocontrol imposes the implementation of numerous sensors, intended for example to measure the actual angle of the ballooning, which increases the complexity, and consequently the cost, as well as the risk of failure, of the control system, and more generally of the hoist equipped with said steering system.
En outre, la complexité du modèle mathématique utilisé par un tel système de pilotage, ainsi que la quantité des données à mesurer et à traiter, tendent à mobiliser des ressources relativement importantes et coûteuses en termes de puissance de calcul, de mémoire, et d'énergie.In addition, the complexity of the mathematical model used by such a control system, as well as the quantity of data to be measured and processed, tend to mobilize relatively large and expensive resources in terms of computing power, memory, and memory. energy.
Par ailleurs, l'assistance au pilotage ainsi offerte peut avoir tendance à amortir excessivement les réponses (réactions) de l'engin de levage aux consignes du conducteur (ou « grutier »), en faussant ainsi la perception intuitive du comportement de l'engin que peut avoir ledit conducteur, et notamment en donnant audit conducteur la désagréable impression que l'engin manque de réactivité et n'exécute pas fidèlement ses consignes.Moreover, the piloting assistance thus offered may tend to excessively dampen the responses (reactions) of the hoist to the instructions of the driver (or "crane operator"), thereby distorting the intuitive perception of the behavior of the machine that can have said driver, and in particular by giving the driver the unpleasant impression that the machine lacks responsiveness and does not faithfully implement his instructions.
Les objets assignés à l'invention visent par conséquent à remédier aux inconvénients susmentionnés et à proposer un nouveau procédé de commande du déplacement d'une charge suspendue qui assure un déplacement à la fois rapide et doux de la charge suspendue, avec une maîtrise efficace du ballant, qui procure au conducteur un ressenti fidèle permettant un pilotage très libre, réactif et relativement intuitif, et qui soit, malgré ces performances, particulièrement simple et économe à mettre en oeuvre.The objects assigned to the invention therefore seek to overcome the aforementioned drawbacks and to propose a new method for controlling the movement of a suspended load which ensures a fast and gentle displacement of the suspended load, with effective control of the dangling, which gives the driver a loyal feeling allowing a very free, responsive and relatively intuitive control, and which is, despite these performances, particularly simple and economical to implement.
Les objets assignés à l'invention sont atteints au moyen d'un procédé de commande du déplacement d'une charge suspendue à un point d'accroche d'un engin de levage, ledit procédé comprenant une étape (a) d'acquisition de consigne de pilotage, au cours de laquelle on acquiert une consigne dite « consigne de pilotage » qui est représentative d'une vitesse de déplacement que le conducteur de l'engin de levage souhaite conférer à la charge suspendue, puis une étape (b) de traitement au cours de laquelle on élabore, à partir de ladite consigne de pilotage, une consigne dite « consigne d'exécution » qui est destinée à être appliquée à au moins un moteur d'entraînement afin de déplacer la charge suspendue, le procédé étant caractérisé en ce que l'étape (b) de traitement comporte une sous-étape (b4) de régularisation C3 au cours de laquelle on traite la consigne de pilotage de manière à conférer à ladite consigne de pilotage des propriétés de dérivabilité troisième par rapport au temps et de continuité par rapport au temps, afin de générer à partir de ladite consigne de pilotage une consigne dite « consigne de pilotage filtrée » qui est de classe C3, puis l'on définit la consigne d'exécution à partir de ladite consigne de pilotage filtrée.The objects assigned to the invention are achieved by means of a method of controlling the movement of a load suspended at a point of attachment of a hoist, said method comprising a step (a) of acquisition of instructions in the course of which is acquired a setpoint called "steering set" which is representative of a speed of movement that the driver of the hoist wishes to give to the suspended load, and then a step (b) of treatment during which a so-called "execution instruction" instruction, which is intended to be applied to at least one drive motor, is developed from said driving instruction in order to move the suspended load, the method being characterized in that the processing step (b) comprises a regulation sub-step (b4) C 3 during which the driving instruction is processed in such a way as to confer on said steering instruction drifting properties third unit with respect to time and continuity with respect to time, in order to generate, from said control setpoint, a so-called "filtered control setpoint" which is of class C 3 , then the execution instruction is defined from said filtered control setpoint.
Plus préférentiellement, la sous-étape (b4) de régularisation C3 peut consister en une sous-étape (a4) de filtrage du troisième ordre au cours de laquelle on applique à la consigne de pilotage un filtre du troisième ordre afin de générer une consigne de pilotage filtrée qui est de classe C3.More preferably, the regulation sub-step (b4) C 3 may consist of a sub-step (a4) of third-order filtering during which a third-order filter is applied to the control setpoint in order to generate a setpoint filtered pilot which is class C 3 .
Par « être de classe C3 », on indique, au sens mathématique du terme, que le paramètre considéré, ici la consigne de pilotage filtrée, ou plus précisément la fonction qui représente l'évolution dudit paramètre considéré en fonction du temps, c'est-à-dire ici la fonction représentant l'évolution de la consigne de pilotage filtrée en fonction du temps, est trois fois dérivable (différentiable) par rapport au temps, et que ladite fonction, ainsi que ses dérivées temporelles première, seconde et troisième sont continues.By "being of class C 3 ", it is indicated, in the mathematical sense of the term, that the parameter considered, here the filtered control setpoint, or more precisely the function which represents the evolution of said parameter considered as a function of time, c ' that is to say here the function representing the evolution of the filtered control set as a function of time, is three times differentiable (with respect to time), and that said function, as well as its temporal derivatives first, second and third are continuous.
Avantageusement, la régularisation C3 de la consigne de pilotage (consigne de vitesse pour la charge suspendue), et plus particulièrement l'utilisation à cet effet d'un filtre du troisième ordre appliqué à ladite consigne de pilotage, permet de s'assurer que la consigne de pilotage filtrée, qui sera ensuite effectivement utilisée pour définir la consigne d'exécution appliquée aux moteurs d'entraînement, est de classe C3.Advantageously, the regulation C 3 of the control setpoint (speed setpoint for the suspended load), and more particularly the use for this purpose of a third-order filter applied to said control setpoint, makes it possible to ensure that the filtered control setpoint, which will then be effectively used to define the execution setpoint applied to the drive motors, is class C 3 .
Avantageusement, une consigne de pilotage filtrée, ainsi régularisée C3, présente des conditions de régularité exceptionnelles (en ce sens qu'elle est ici trois fois dérivable, et que ses dérivées temporelles première, seconde et troisième sont continues), et par conséquent des propriétés mathématiques de continuité et de bornage que ne possède généralement pas la consigne de pilotage brute, telle qu'elle est définie et modifiée en temps réel par le conducteur de l'engin.Advantageously, a filtered control setpoint, thus regularized C 3 , has exceptional regularity conditions (in that it is here three times differentiable, and that its first, second and third time derivatives are continuous), and consequently mathematical properties of continuity and boundary that does not generally have the raw control setpoint, as defined and modified in real time by the driver of the machine.
En effet, on rappellera que le conducteur de l'engin est susceptible de faire varier la consigne de pilotage à tout instant, de manière imprévisible.Indeed, it will be recalled that the driver of the machine is likely to vary the steering set at any time, unpredictably.
En fonction des différentes situations auxquelles ledit conducteur de l'engin doit réagir, la consigne de pilotage (qui prend ici la forme d'une consigne de vitesse pour la charge suspendue) peut donc varier d'une part en signe, lorsque le conducteur de l'engin décide de changer le sens du mouvement (gauche/droite, éloignement/rapprochement), et d'autre part en amplitude (intensité), lorsque le conducteur passe d'un mouvement qu'il souhaite rapide à un mouvement plus lent (décélération), ou inversement (accélération).Depending on the different situations to which the driver of the machine must react, the control setpoint (which here takes the form of a speed reference for the suspended load) can therefore vary from one hand to another when the driver of the machine decides to change the direction of the movement (left / right, distance / approximation), and secondly in amplitude (intensity), when the driver goes from a movement that he wishes fast to a slower movement ( deceleration), or conversely (acceleration).
En outre, la vitesse de ces changements de consigne de pilotage peut considérablement varier, selon la fréquence et la rapidité avec laquelle le conducteur de l'engin actionne les commandes pour opérer des changements ou des corrections de trajectoire.In addition, the speed of these control setpoint changes can vary considerably, depending on the frequency and speed with which the driver of the machine actuates the commands to make changes or corrections of trajectory.
La consigne de pilotage brute peut donc présenter en pratique certaines variations brusques, de type échelons, assimilables mathématiquement à des discontinuités.The gross piloting instruction can therefore present in practice some abrupt variations of ladder type that can be mathematically assimilated to discontinuities.
De même, en raison notamment de ces discontinuités, les dérivées temporelles (typiquement d'ordre un et d'ordre deux) de la consigne de pilotage, qui seront de préférence utilisées dans la modélisation du comportement de la charge suspendue et dans l'élaboration de la consigne d'exécution, pourraient présenter ponctuellement, si elles étaient calculées directement, sans régularisation (filtrage) appropriée, certaines divergences ou certaines discontinuités, si bien que la consigne d'exécution résultante serait de nature à provoquer des réactions saccadées ou instables de la charge suspendue.Likewise, due in particular to these discontinuities, the time derivatives (typically of order one and of order two) of the control setpoint, which will preferably be used in the modeling of the behavior of the suspended load and in the elaboration of the execution instruction, could present punctually, if they were calculated directly, without appropriate regularization (filtering), certain divergences or discontinuities, so that the resulting instruction of execution would be likely to cause jerky or unstable reactions of the suspended charge.
C'est pourquoi le procédé selon l'invention lisse avantageusement la consigne de pilotage avant que celle-ci ne soit effectivement appliquée au(x) moteur(s) d'entraînement, ce qui permet d'éliminer du signal de commande (consigne d'exécution) les instabilités, discontinuités et autres divergences qui seraient de nature à provoquer des à-coups et l'apparition (ou l'entretien) d'un ballant.This is why the method according to the invention advantageously smooths the control setpoint before it is actually applied to the (x) drive motor (s), which eliminates the control signal (instruction d). execution) instabilities, discontinuities and other divergences that would be likely to cause jolts and the appearance (or maintenance) of a ballant.
On peut ainsi obtenir un mouvement de la charge suspendue qui est particulièrement régulier et stable, quelle que soit la nature dudit mouvement (c'est-à-dire quelle que soit la forme de la trajectoire voulue par le conducteur de l'engin), et quelles que soient la vitesse et l'amplitude dudit mouvement voulues par le conducteur de l'engin.It is thus possible to obtain a movement of the suspended load which is particularly regular and stable, irrespective of the nature of the said movement (that is to say whatever the shape of the trajectory desired by the driver of the machine), and regardless of the speed and amplitude of said movement desired by the driver of the machine.
Avantageusement, et tel que cela sera détaillé ci-après, la régularité C3 conférée à la consigne de pilotage permet en outre de définir ensuite la consigne d'exécution, à partir de ladite consigne de pilotage, au moyen d'un modèle mathématique simplifié qui non seulement est simple et rapide à exécuter, mais qui, surtout, produit une consigne d'exécution qui est intrinsèquement non génératrice de ballant, c'est-à-dire une consigne d'exécution qui, lorsqu'elle est appliquée aux moteurs d'actionnement, ne provoque pas (ne peut pas provoquer d'elle-même) l'apparition d'un ballant.Advantageously, and as will be detailed hereinafter, the regularity C 3 conferred on the control setpoint furthermore makes it possible to subsequently define the execution instruction, from said control instruction, by means of a simplified mathematical model. which not only is simple and quick to execute, but which, above all, produces an execution instruction which is inherently non-generating dangling, that is to say a performance instruction which, when it is applied to the engines actuation, does not cause (can not cause of itself) the appearance of a ballant.
Par ailleurs, le procédé selon l'invention autorise notamment un réglage libre et précis des coefficients, ainsi que de la pulsation, du filtre du troisième ordre qui est appliqué à la consigne de pilotage, ce qui permet de conserver en toutes circonstances une convergence rapide de la vitesse de la charge suspendue vers la consigne de vitesse exprimée par le conducteur de l'engin.Furthermore, the method according to the invention notably allows a free and precise adjustment of the coefficients, as well as the pulsation, of the third-order filter which is applied to the control setpoint, which makes it possible to maintain rapid convergence in all circumstances. the speed of the load suspended towards the speed reference expressed by the driver of the machine.
En d'autres termes, le procédé procure un pilotage dynamique et réactif.In other words, the method provides a dynamic and responsive control.
Ensuite, le procédé selon l'invention permet avantageusement d'optimiser l'utilisation du ou des moteurs d'entraînement, en ceci qu'il permet de tirer les meilleures performances possibles dudit ou desdits moteurs, notamment en termes de vitesse ou d'accélération conférée au point d'accroche et à la charge, tout en respectant à tout moment les limites matérielles dudit ou desdits moteurs.Next, the method according to the invention advantageously makes it possible to optimize the use of the drive motor or motors, in that it makes it possible to derive the best possible performance from said motor or said motors, in particular by terms of speed or acceleration conferred to the point of attachment and the load, while respecting at all times the material limits of said engine (s).
On comprend en effet que si un moteur ne peut pas atteindre la consigne qui lui est fixée parce que ladite consigne est trop élevée au regard des capacités dudit moteur, alors l'entraînement réel du point d'accroche souffrira d'une insuffisance par rapport à l'entraînement souhaité, si bien que le mouvement dudit point d'accroche (et donc le mouvement de la charge suspendue) qui sera effectivement obtenu ne correspondra pas au mouvement voulu.It is understood that if an engine can not reach the setpoint which is fixed to it because said setpoint is too high with respect to the capabilities of said engine, then the actual training of the hooking point will suffer from an insufficiency with respect to the desired training, so that the movement of said point of attachment (and thus the movement of the suspended load) that will be obtained will not correspond to the desired movement.
Or, la consigne d'exécution étant par définition calculée justement pour obtenir (théoriquement) un mouvement (mouvement voulu) régulier et sans ballant, on comprendra que si, en pratique, le moteur d'entraînement n'exécute pas correctement ladite consigne d'exécution, alors le système de pilotage ne se comportera pas comme souhaité, et qu'il pourra en résulter l'apparition d'un ballant et une certaine perte de contrôle des mouvements du point d'accroche et de la charge.However, the execution instruction being by definition calculated precisely to obtain (theoretically) a movement (desired movement) regular and without dangling, it will be understood that if, in practice, the drive motor does not execute correctly said instruction d ' execution, then the control system will not behave as desired, and that may result in the appearance of a ballant and some loss of control of the movements of the point of attachment and load.
Ici, grâce à l'invention, on peut paramétrer la régularisation C3, et plus particulièrement on peut paramétrer le filtrage du troisième ordre, et le cas échéant faire évoluer ce paramétrage de la régularisation C3 (respectivement du filtrage) au fil du temps, de manière à ce que la consigne d'exécution, tout en favorisant une réponse rapide du système de pilotage, n'excède pas les capacités effectives des moteurs d'entraînement en matière de vitesse maximale et d'accélération maximale.Here, thanks to the invention, it is possible to parameterize the regularization C 3 , and more particularly it is possible to parameterize the filtering of the third order, and if necessary to modify this parameterization of the regularization C 3 (or filtering, respectively) over time , so that the execution instruction, while promoting rapid response of the control system, does not exceed the actual capacity of the drive motors in terms of maximum speed and maximum acceleration.
A ce titre, on notera notamment que d'une part l'accélération maximale que l'on peut conférer au point d'accroche (chariot) est directement dépendante de la capacité d'accélération maximale des moteurs d'entraînement qui servent à déplacer ledit point d'accroche, et que d'autre part il existe mathématiquement, du fait des lois physiques de la dynamique, une relation entre l'accélération du point d'accroche (accélération du chariot) et la dérivée troisième de la vitesse de la charge suspendue.In this respect, it will be noted in particular that on the one hand the maximum acceleration that can be imparted to the point of attachment (carriage) is directly dependent on the maximum acceleration capacity of the drive motors used to move said point of attachment, and that on the other hand there exists mathematically, because of the physical laws of dynamics, a relationship between the acceleration of the point of attachment (acceleration of the carriage) and the third derivative of the speed of the load suspended.
Par conséquent, lorsque l'on régularise C3 la consigne de pilotage brute (consigne de vitesse de charge suspendue) exprimée par le conducteur de l'engin, conformément à l'invention, on réalise avantageusement une planification du profil de la consigne de vitesse que l'on va appliquer aux moteurs d'entraînement, c'est-à-dire que l'on planifie l'évolution dans le temps (et plus particulièrement les taux d'évolution par unité de temps) de la valeur de la consigne d'exécution (valeur de consigne de vitesse de chariot), selon un profil d'évolution qui reflète au mieux la consigne de pilotage souhaitée mais qui est également et surtout compatible avec la capacité des moteurs à fournir une réponse qui soit à chaque instant à la hauteur de ladite consigne d'exécution.Therefore, when one corrects C 3 the gross control setpoint (suspended load speed setpoint) expressed by the driver of the machine, according to the invention, is advantageously carried out a planning of the profile of the speed reference that we will apply to the drive motors, that is to say that we plan the evolution over time (and more particularly the rate of change per unit of time) of the value of the instruction of execution (trolley speed reference value), according to an evolution profile which best reflects the desired control setpoint but which is also and above all compatible with the ability of the motors to provide a response that is at each moment up to said performance instruction.
De la sorte, la consigne d'exécution est en pratique toujours "réalisable", c'est-à-dire que ladite consigne d'exécution est intrinsèquement telle que ledit système de pilotage réel est toujours capable de "réaliser" (d'atteindre) effectivement ladite consigne d'exécution qu'on lui applique, et donc de fournir une réponse réelle qui est conforme au comportement qu'on attend dudit système de pilotage, et plus particulièrement conforme au comportement que l'on attend du chariot (tel que ledit comportement attendu est défini par la consigne d'exécution).In this way, the execution instruction is in practice always "realizable", that is to say that said execution instruction is intrinsically such that said real control system is still capable of "realizing" (to achieve ) actually said performance instruction that is applied to him, and therefore to provide a real response that is consistent with the behavior expected of said steering system, and more particularly consistent with the behavior expected of the truck (such as said expected behavior is defined by the execution instruction).
Ainsi, la consigne d'exécution ne prend jamais le système de pilotage réel en défaut.Thus, the execution instruction never takes the actual control system into default.
Plus particulièrement, le filtre du troisième ordre proposé simplifie la mise en oeuvre de saturations appropriées, lors du traitement de la consigne de pilotage, et donc la mise en oeuvre de limitations dynamiques "intelligentes" de la consigne d'exécution, qui permettent de tirer le meilleur parti des moteurs d'entraînement tout en garantissant un contrôle permanent, précis et fiable, des mouvements du point d'accroche et de la charge suspendue.More particularly, the proposed third-order filter simplifies the implementation of appropriate saturations, during the processing of the control setpoint, and thus the implementation of "intelligent" dynamic limits of the execution instruction, which make it possible to draw the best of the drive motors while ensuring a permanent, precise and reliable control of the movements of the point of attachment and the suspended load.
Enfin, on notera que le procédé de commande selon l'invention permet avantageusement de piloter l'engin de levage par un asservissement en boucle ouverte, simplement en appliquant la consigne d'exécution (consigne de vitesse) au moteur d'entraînement concerné, sans requérir aucune mesure du ballant effectif (c'est-à-dire sans qu'il soit nécessaire d'obtenir un retour d'information sur l'angle réel du ballant), ce qui limite le nombre de capteurs ainsi que la puissance de calcul nécessaires au pilotage, et par conséquent réduit la complexité, l'encombrement, et la consommation d'énergie du système de pilotage.Finally, it will be noted that the control method according to the invention advantageously makes it possible to control the hoist by an open-loop servocontrol, simply by applying the execution instruction (speed reference) to the drive motor concerned, without Require no measurement of the effective dangling (that is, without the need for feedback on the actual angle of the balloon), which limits the number of sensors and the computing power necessary to control, and therefore reduces the complexity, congestion, and energy consumption of the steering system.
D'autres objets, caractéristiques et avantages de l'invention apparaîtront plus en détail à la lecture de la description qui suit, ainsi qu'à l'aide des dessins annexés, fournis à titre purement illustratif et non limitatif, parmi lesquels :
- La
figure 1 illustre, selon une vue schématique en perspective, l'agencement général d'un exemple d'engin de levage piloté par un procédé selon l'invention. - La
figure 2 illustre, selon une vue schématique de côté, le principe général d'un modèle mécanique de pendule qui sous-tend le procédé selon l'invention. - La
figure 3 illustre, sous forme d'un schéma-bloc, le calcul de la pulsation applicable au filtre du troisième ordre ainsi que la saturation préliminaire de la consigne de pilotage, qui précède le filtrage du troisième ordre. - La
figure 4 illustre, sous forme d'un schéma-bloc, le principe de mise en oeuvre d'une étape (b) de traitement selon l'invention, et plus particulièrement le détail d'un filtre du troisième ordre selon l'invention. - La
figure 5 illustre, selon une vue schématique de dessus, la correspondance entre les systèmes de coordonnées cartésiennes et de coordonnées cylindriques permettant d'exprimer les consignes de pilotage, puis les consignes d'exécution, dans des repères appropriés. - La
figure 6 illustre, sous forme d'un schéma-bloc, la mise en oeuvre du procédé selon l'invention pour commander d'une part un moteur d'orientation (l'« orientation » désignant la composante de giration en lacet, autour d'un axe (ZZ') dit « axe d'orientation ») et d'autre part un moteur de distribution (la « distribution » désignant la composante radiale d'éloignement ou de rapprochement par rapport à l'axe (ZZ') d'orientation), à partir d'une consigne de pilotage exprimée en coordonnées cylindriques, comprenant une composante radiale et une composante angulaire. - La
figure 7 illustre, de façon schématique, une consigne de pilotage filtrée obtenue en réponse à une consigne de pilotage brute de type échelon, ainsi qu'une consigne d'exécution qui est déterminée à partir de ladite consigne de pilotage filtrée, tel que cela est illustré sur lafigure 6 , au moyen d'une formule de conversion issue du modèle mécanique de lafigure 2 .
- The
figure 1 illustrates, in a schematic perspective view, the general arrangement of an example of lifting gear driven by a method according to the invention. - The
figure 2 illustrates, in a schematic side view, the general principle of a mechanical pendulum model which underlies the method according to the invention. - The
figure 3 illustrates, in the form of a block diagram, the computation of the pulsation applicable to the third order filter as well as the preliminary saturation of the control setpoint, which precedes the filtering of the third order. - The
figure 4 illustrates, in the form of a block diagram, the principle of implementing a processing step (b) according to the invention, and more particularly the detail of a third-order filter according to the invention. - The
figure 5 illustrates, in a schematic top view, the correspondence between the Cartesian coordinate systems and cylindrical coordinates for expressing the control instructions, and the instructions for execution, in appropriate marks. - The
figure 6 illustrates, in the form of a block diagram, the implementation of the method according to the invention for controlling on the one hand an orientation motor (the "orientation" designating the gyration component in yaw, around a axis (ZZ ') called "axis of orientation") and secondly a distribution motor (the "distribution" designating the radial component of distance or approximation relative to the axis (ZZ') of orientation ), from a control set expressed in cylindrical coordinates, comprising a radial component and an angular component. - The
figure 7 illustrates, schematically, a filtered control setpoint obtained in response to a step-type raw control setpoint, and an execution setpoint which is determined from said filtered control setpoint, as illustrated on FIG. thefigure 6 , using a conversion formula derived from the mechanical model of thefigure 2 .
La présente invention concerne un procédé de commande du déplacement d'une charge 1 suspendue à un point d'accroche H d'un engin de levage 2.The present invention relates to a method for controlling the movement of a
L'engin de levage 2 est conçu de manière à pouvoir déplacer le point d'accroche H, et par conséquent la charge suspendue 1, selon une composante de rotation en lacet Θ autour d'un premier axe vertical (ZZ'), dit « axe d'orientation », et/ou selon une composante radiale R, correspondant à un mouvement dit « de distribution », ici en translation le long d'un second axe (DD') dit « axe de distribution » sécant audit axe d'orientation (ZZ'), tel que cela est illustré sur les
L'engin de levage 2 pourra notamment former une grue à tour, dont le mât 3 matérialise l'axe d'orientation (ZZ'), et dont la flèche 4 matérialise l'axe de distribution (DD'), tel que cela est illustré sur la
Par simple commodité de description, on considérera une telle configuration de grue à tour dans ce qui suit, et plus particulièrement une configuration de grue à tour à flèche 4 horizontale, étant bien entendu qu'il est parfaitement envisageable d'appliquer le principe de l'invention à d'autres engins de levage, et notamment à des grues mobiles ou à des grues à flèche relevable.For the sake of simplicity of description, such a tower crane configuration will be considered in the following, and more particularly a configuration of a tower crane with
On notera O l'intersection de l'axe de distribution (DD') et de l'axe d'orientation (ZZ').Note the intersection O of the dispensing axis (DD ') and the orientation axis (ZZ').
Le point d'accroche H est de préférence formé par un chariot 5, qui pourra avantageusement être guidé en translation selon l'axe de distribution (DD'), le long de la flèche 4.The point of attachment H is preferably formed by a
Par commodité, on pourra assimiler le chariot 5 et le point d'accroche H dans ce qui suit.For convenience, we can assimilate the
Le mouvement d'orientation Θ, et, respectivement, le mouvement de distribution R, et plus particulièrement le mouvement d'entraînement du chariot 5 en translation R le long de la flèche 4, pourront être assurés par tout moteur d'entraînement 7, 8 approprié, de préférence électrique, et plus particulièrement par au moins un moteur (électrique) d'orientation 8 et, respectivement, un moteur (électrique) de distribution 7.The orientation movement Θ, and, respectively, the dispensing movement R , and more particularly the drive movement of the
La charge 1 est suspendue au point d'accroche H par un dispositif de suspension 6, tel qu'un câble de suspension. Dans ce qui suit, ledit dispositif de suspension sera donc assimilé à un tel câble de suspension 6, par commodité.The
La charge 1 suspendue pourra de préférence également être déplacée selon une composante verticale, dite « de levage », de sorte à pouvoir faire varier la hauteur à laquelle se trouve la charge suspendue 1 par rapport au sol.The suspended
De préférence, on pourra à cet effet faire varier la longueur L du câble de suspension 6, typiquement au moyen d'un treuil entraîné par un moteur (de préférence électrique) de levage, de manière à pouvoir modifier la distance de la charge suspendue 1 au point d'accroche H, et ainsi soit faire s'élever la charge 1 par un raccourcissement de la longueur L (par enroulement du câble de suspension 6), soit au contraire faire descendre ladite charge 1 par un allongement de ladite longueur L (par déroulement du câble 6).Preferably, it will be possible for this purpose to vary the length L of the
Par commodité, on pourra désigner par « système de pilotage » l'ensemble permettant d'assurer la mise en mouvement et le contrôle du déplacement de la charge suspendue 1, ledit ensemble comprenant typiquement le ou les modules (calculateurs) 10, 12, 13, 14, 15, 16, 17 permettant la mise en oeuvre du procédé selon l'invention, ainsi que le ou les moteurs d'entraînement 7, 8 (actionneurs), et le cas échéant les organes mobiles (effecteurs) de l'engin entraînés par lesdits moteurs d'entraînement 7, 8; lesdits organes mobiles correspondront ici d'une part au mât 3 et à la flèche 4, orientables en lacet selon le mouvement d'orientation Θ, et d'autre part au chariot 5 assurant le mouvement de distribution R le long de la flèche 4.For convenience, the term "steering system" may be used to designate the movement and the control of the displacement of the suspended
Selon l'invention, le procédé comprend une étape (a) d'acquisition de consigne de pilotage au cours de laquelle on acquiert une consigne dite « consigne de pilotage » Vu qui est représentative d'une vitesse de déplacement Vload que le conducteur de l'engin de levage 2 souhaite conférer à la charge suspendue 1.According to the invention, the method comprises a control instruction acquisition step (a) during which a setpoint known as a "control setpoint" V u is acquired that is representative of a traveling speed V load that the driver of the hoist 2 wishes to confer on the suspended
Le procédé selon l'invention comprend ensuite une étape (b) de traitement au cours de laquelle on élabore, à partir de ladite consigne de pilotage Vu, ici au moyen d'un module de traitement 10, une consigne dite « consigne d'exécution » Vtrol, qui est destinée à être appliquée à au moins un moteur d'entraînement 7, 8 afin de déplacer la charge suspendue 1, et, plus particulièrement, afin de déplacer le chariot 5 auquel est suspendu ladite charge 1.The method according to the invention then comprises a step (b) of processing during which is developed, from said control setpoint V u , here by means of a
On notera que, avantageusement, le procédé permet de réaliser un asservissement en vitesse, plutôt qu'en trajectoire, et plus particulièrement un asservissement de la vitesse du chariot 5, à partir d'une consigne de vitesse Vu qui correspond à la vitesse souhaitée pour la charge suspendue 1.It will be noted that, advantageously, the method makes it possible to control the speed, rather than the trajectory, and more particularly to control the speed of the
A ce titre, la consigne d'exécution Vtrol exprimera donc de préférence la consigne de vitesse que doit atteindre le point d'accroche H (c'est-à-dire la consigne de vitesse que doit atteindre le chariot 5).As such, the execution instruction V trol will preferably express the speed setpoint that must reach the point of attachment H (that is to say, the speed setpoint that must reach the carriage 5).
En d'autres termes, le procédé comprend de préférence une étape (a) au cours de laquelle le conducteur définit (librement) et exprime (volontairement) une consigne de pilotage sous forme d'une consigne de vitesse qu'il souhaite voire suivie par la charge suspendue 1, puis une étape (b) de traitement au cours de laquelle ladite consigne de pilotage (consigne en vitesse de charge suspendue) est traitée, ici plus particulièrement filtrée par un filtre du troisième ordre, pour être convertie en une consigne correspondante de vitesse du chariot 5, formant la consigne d'exécution (en vitesse) Vtrol qui est appliquée au moteur d'entraînement 7,8 adéquat.In other words, the method preferably comprises a step (a) during which the driver defines (freely) and expresses (voluntarily) a driving instruction in the form of a speed instruction he wishes or even followed by the suspended
On notera du reste que le procédé offre au conducteur de l'engin une grande liberté de manoeuvre, puisque ledit conducteur peut fixer librement, à tout instant, et selon l'amplitude qu'il choisit, la consigne de pilotage (consigne de vitesse) Vu qu'il désire voir exécutée par la charge 1, et ce sans être par exemple contraint de respecter une trajectoire fixe prédéterminée.It will be noted moreover that the method offers the operator of the machine a great freedom of maneuver, since said driver can fix freely, at any moment, and according to the amplitude that he chooses, the control setpoint (speed setpoint) V u it wants to be executed by the
On notera par ailleurs que le procédé selon l'invention est valable aussi bien pour le pilotage du mouvement d'orientation Θ que pour le pilotage du mouvement de distribution R, ou pour le pilotage d'une combinaison simultanée quelconque de ces deux mouvements.It will be noted moreover that the method according to the invention is valid both for controlling the orientation movement Θ and for controlling the dispensing movement R , or for controlling any combination of these two movements simultaneously.
Du point de vue formel, on remarquera que l'on peut avantageusement repérer la position des organes mobiles, à savoir le point d'accroche H/chariot 5 d'une part, la charge 1 suspendue d'autre part, et exprimer les mouvements desdits organes mobiles, soit dans un repère cartésien (O, X, Y, Z) associé à la base (considérée fixe) de l'engin de levage 2, soit dans un repère de type "polaire" (O, r, θ) utilisant des coordonnées cylindriques, voire sphériques.From the formal point of view, it will be noted that the position of the movable members, namely the point of attachment H /
Par convention, on pourra ainsi noter, dans ledit repère cartésien :
- Ptrol x et Ptrol y les positions en X (premier axe horizontal), respectivement en Y (second axe horizontal, perpendiculaire au premier axe horizontal X), du chariot 5 (l'indice « trol » désignant le chariot ou « trolley ») ;
- Vtrol x et Vtrol y les composantes de vitesse en X, respectivement en Y,
dudit chariot 5 ; - Pload x et Pload y les positions en X, respectivement en Y, de la
charge 1 suspendue (l'indice « load » désignant la charge suspendue 1) ; - Vload x et Vload y les composantes de vitesse en X, respectivement en Y, de ladite
charge suspendue 1, qui correspondent aux composantes de la vitesse (voulue) de lacharge suspendue 1, et donc, en pratique, aux composantes de la consigne de pilotage Vu.
- P trol x and P trol y the positions in X (first horizontal axis), respectively in Y (second horizontal axis, perpendicular to the first horizontal axis X), of the carriage 5 (the index "trol" denoting the trolley or "trolley");
- V trol x and V trol y speed components in X, respectively Y, said
carriage 5; - P load x and P load y the positions in X, respectively in Y, of the suspended load 1 (the "load" index denoting the suspended load 1);
- V load x and V load y the speed components in X, respectively in Y, of said suspended
load 1, which correspond to the components of the (wanted) speed of the suspendedload 1, and therefore, in practice, to the components of the pilot setpoint V u .
Lorsque l'on utilisera les coordonnées cylindriques (r, θ), on pourra plus particulièrement attacher à chaque organe mobile considéré un repère de Frénet permettant d'exprimer la composante radiale Vr (selon le mouvement de distribution R) et la composante orthoradiale Vθ (selon la tangente au mouvement d'orientation Θ) de la vitesse de l'organe mobile considéré, tel que cela est notamment illustré sur la
Ainsi, sur ladite
Tel que cela est illustré sur les
Ledit organe de commande 11 pourra notamment prendre la forme d'un joystick, ou bien d'un ensemble de manettes, qui permettra au conducteur d'exprimer la consigne de vitesse d'orientation (vitesse de lacet, orthoradiale) Vload θ et la consigne de vitesse de distribution (vitesse radiale) Vload r qu'il souhaite imprimer à la charge suspendue 1.Said
Par simple commodité de notation, la consigne de pilotage Vu brute, telle qu'elle est exprimée par le conducteur de l'engin au niveau de l'organe de commande 11, c'est-à-dire le signal fourni par le joystick en entrée du système de pilotage, sera de préférence référencée VJOY sur les figures susmentionnées.By simple convenience of notation, the driving instruction V u brute, as expressed by the driver of the machine at the
Afin de mieux expliquer l'invention, quelques éléments de mécanique théorique permettant de modéliser un système pendulaire vont maintenant être exposés, en référence à la
On notera que l'explication donnée ici dans un plan, en référence à une seule dimension de déplacement, selon l'axe X, que l'on considère parallèle à la flèche 4 et à l'axe de distribution (DD'), reste valable en trois dimensions.Note that the explanation given here in a plane, with reference to a single dimension of displacement, along the axis X, which is considered parallel to the
D'après le principe fondamental de la dynamique (loi de Newton), et en négligeant d'éventuels efforts externes tels que le vent, on a :
- M représente la masse de la
charge suspendue 1 ; -
a load représente l'accélération de la charge suspendue 1 (que l'on considère ici portée par la direction horizontale X) ; -
T représente la tension du câble desuspension 6 ; -
g représente la gravité (accélération de pesanteur).
- M represents the mass of the suspended
load 1; -
at load represents the acceleration of the suspended load 1 (considered here borne by the horizontal direction X); -
T represents the tension of thesuspension cable 6; -
boy Wut represents gravity (gravitational acceleration).
L'équation ci-dessus implique que le vecteur
En faisant l'hypothèse des petits angles, on peut également écrire :
- Ptrol la position (ici en X) du
chariot 5, - Pload la position (ici en X) de la
charge 1, et - L la longueur du câble de
suspension 6.
- P trol the position (here in X) of the
carriage 5, - P load the position (here in X) of the
load 1, and - L the length of the
suspension cable 6.
On en déduit la relation suivante entre la position Ptrol du chariot d'une part, et la position Pload de la charge suspendue et la vitesse Vload de la charge d'autre part :
En pratique, grâce à la formule de conversion ci-dessus, on peut donc calculer la consigne de vitesse du chariot Vtrol, c'est-à-dire concrètement la consigne d'exécution Vtrol, à partir de la valeur de la vitesse Vload que l'on souhaite conférer à la charge suspendue, c'est-à-dire à partir de la consigne de pilotage Vu.In practice, thanks to the conversion formula above, it is therefore possible to calculate the speed reference of the trolley V trol , that is to say specifically the execution instruction V trol , from the value of the speed V load that one wishes to confer to the suspended load, that is to say from the control setpoint V u .
Toutefois, il est également nécessaire de prendre en considération le fait que, dans le système de pilotage réel, le chariot 5 a nécessairement une accélération finie (bornée). Cette condition matérielle impose que, d'un point de vue mathématique, l'accélération du chariot, c'est-à-dire la dérivée temporelle de la vitesse du chariot,
Or, le calcul de la vitesse du chariot (consigne d'exécution) Vtrol selon la formule de conversion ci-dessus fait intervenir la dérivée temporelle seconde
Au regard de cette formule de conversion, l'accélération du chariot
Il s'ensuit que la condition d'existence et de bornage de l'accélération du chariot V̇trol impose que la dérivée temporelle troisième V̈load de la vitesse de la charge Vload existe et soit bornée, c'est-à-dire que la vitesse de la charge suspendue Vload (et par conséquent la consigne de pilotage Vu qui va servir à fixer ladite vitesse de la charge suspendue) soit trois fois dérivable, et que sa dérivée troisième soit continue (et bornée).It follows that the condition of existence and of bounding of the acceleration of the V̇ trol carriage imposes that the third time derivative V̈ load of the speed of the load V load exists and is bounded, that is to say that the speed of the suspended load V load (and consequently the control setpoint V u which will serve to fix said speed of the suspended load) is three times differentiable, and that its third derivative is continuous (and bounded).
En d'autres termes, on doit s'assurer que la consigne de pilotage Vu effectivement utilisée pour calculer (selon la formule de conversion ci-dessus) la consigne d'exécution Vtrol est (à tout moment, et en toutes circonstances) de classe C3, et ce alors même que ladite consigne de pilotage Vu est initialement exprimée par le conducteur de l'engin, et acquise sensiblement en temps réel, sous une forme brute VJOY qui est susceptible de varier de façon imprévisible au fil du temps, au libre choix du conducteur, et qui ne possède donc pas nécessairement ces propriétés de régularité C3.In other words, it must be ensured that the driving instruction V u actually used to calculate (according to the conversion formula above) the execution instruction V trol is (at all times and in all circumstances) of class C 3 , even though said driving instruction V u is initially expressed by the driver of the machine, and acquired substantially in real time, in a raw form V JOY which is likely to vary unpredictably with the wire. time, at the free choice of the driver, and therefore does not necessarily have these properties of regularity C 3 .
C'est notamment pourquoi, selon l'invention, l'étape (b) de traitement comporte avantageusement une sous-étape (b4) de régularisation C3 au cours de laquelle on traite la consigne de pilotage Vu de manière à conférer à ladite consigne de pilotage Vu des propriétés de dérivabilité troisième par rapport au temps et de continuité par rapport au temps, afin de générer, à partir de ladite consigne de pilotage Vu, une consigne de pilotage filtrée Vf qui est de classe C3, puis l'on définit la consigne d'exécution Vtrol à partir de ladite consigne de pilotage filtrée Vf.This is particularly why, according to the invention, the treatment step (b) advantageously comprises a regulation sub-step (b4) C 3 during which the driving instruction V u is processed so as to confer on said control setpoint V u of the properties of differentiability third with respect to time and of continuity with respect to time, in order to generate, from said control setpoint V u , a filtered control setpoint V f which is of class C 3 , then the execution setpoint V trol is set from said filtered control setpoint V f .
Selon une variante possible de mise en oeuvre, la régularisation C3 peut être réalisée en utilisant des polynômes d'interpolation.According to one possible variant of implementation, the regularization C 3 can be carried out using interpolation polynomials.
Selon cette variante, on interpole la consigne de pilotage Vu, et plus particulièrement plusieurs voire la totalité des valeurs considérées parmi la succession des différentes valeurs prises par la consigne de pilotage Vu au cours d'un intervalle de temps donné, au moyen d'un polynôme.According to this variant, the control setpoint V u is interpolated, and more particularly several or all of the values considered among the succession of different values taken by the control setpoint V u during a given time interval, by means of a polynomial.
Ledit polynôme possède intrinsèquement une classe de régularité (au moins) C3, et fournit donc une approximation à la fois précise et de classe C3 de la consigne de pilotage, sous forme d'une consigne de pilotage filtrée Vf de type polynomial.Said polynomial intrinsically possesses a class of regularity (at least) C 3 , and thus provides an accurate and class-specific approximation C 3 of the control setpoint, in the form of a filtered control setpoint V f of polynomial type.
Un tel polynôme procure donc une planification de classe C3 de la consigne de pilotage.Such a polynomial thus provides a class C 3 planning of the control set.
Toutefois, selon une autre variante particulièrement préférentielle et plus simple à mettre en oeuvre que la variante par interpolation polynomiale, lors de la sous-étape (b4) de régularisation C3, on applique à la consigne de pilotage Vu, pour régulariser C3 ladite consigne de pilotage, un filtre du troisième ordre F3 afin de générer la consigne de pilotage filtrée Vf qui est de classe C3.However, according to another particularly preferred variant which is simpler to implement than the variant by polynomial interpolation, during the regulation sub-step (b4) C 3 , the control setpoint V u is applied to regulate C 3 said control setpoint, a third order filter F3 in order to generate the filtered control setpoint V f which is of class C 3 .
En d'autres termes, la sous-étape (b4) constitue de préférence une sous-étape de filtrage du troisième ordre au cours de laquelle on applique à la consigne de pilotage Vu un filtre du troisième ordre F3 afin de générer une consigne de pilotage filtrée Vf qui est trois fois dérivable (et plus exactement de classe de régularité C3).In other words, the sub-step (b4) preferably constitutes a third-order filter sub-step in the course of which a third-order filter F3 is applied to the control setpoint V u in order to generate an instruction of filtered control V f which is three times differentiable (and more exactly regularity class C 3 ).
De préférence, la régularisation C3, et plus particulièrement le filtrage du troisième ordre, s'effectue au moyen d'un module de filtrage du troisième ordre 12, formé par un calculateur, électronique ou informatique.Preferably, the regularization C3, and more particularly the third-order filtering, is performed by means of a third-
Le filtrage du troisième ordre F3 peut s'écrire sous forme d'une fonction de transfert :
- ω la pulsation du filtre du troisième ordre F3 ;
- c1, c2 les coefficients, respectivement du premier ordre et du second ordre, utilisés par ledit filtre du troisième ordre F3.
- ω the pulsation of the third order filter F3;
- c 1 , c 2 the coefficients, respectively of the first order and the second order, used by said third order filter F3.
Dans le domaine temporel, le filtre du troisième ordre F3 se traduit par l'équation différentielle suivante :
Afin d'optimiser le filtre du troisième ordre F3, on choisira de préférence : c1 = 2,15 et c2 = 1,75, tel que cela apparaît sur la
Ces valeurs permettent en effet d'optimiser la réactivité du filtre F3, en minimisant son temps réponse à 5% (c'est-à-dire le temps nécessaire pour faire converger la réponse vers une consigne de type échelon avec une erreur inférieure à 5% de la valeur dudit échelon), tout en limitant le dépassement (« overshoot »).These values make it possible to optimize the reactivity of the filter F3, by minimizing its response time to 5% (ie the time required to converge the response to a step-type setpoint with an error of less than 5%). % of the value of said step), while limiting the overshoot.
On notera que, selon une variante possible de mise en oeuvre de l'invention, on pourrait utiliser directement la consigne de pilotage filtrée Vf en tant que consigne d'exécution Vtrol appliquée aux moteurs d'entraînement 7, 8, c'est-à-dire que l'on pourrait poser : Vtrol = Vf.It will be noted that, according to one possible variant of implementation of the invention, the filtered control setpoint V f could be used directly as the execution setpoint V trol applied to the
En effet, grâce à la régularisation C3, obtenue ici par le filtrage du troisième ordre, la consigne de pilotage filtrée Vf est intrinsèquement définie, et plus globalement « planifiée », de sorte à converger progressivement vers la consigne de pilotage Vu, sans jamais être « trop raide ».Indeed, thanks to the regularization C 3 , obtained here by the filtering of the third order, the filtered control setpoint V f is intrinsically defined, and more generally "planned", so as to gradually converge towards the control setpoint V u , without ever being too stiff.
De la sorte, ladite consigne de pilotage filtrée Vf, régularisé C3, est effectivement réalisable, les moteurs d'entraînement 7, 8 étant capables de suivre ladite consigne de pilotage filtrée Vf.In this way, said filtered control setpoint V f , regularized C 3 , is actually achievable, the
Ainsi, dans l'exemple illustré sur la
Toutefois, selon une autre variante particulièrement préférentielle de mise en oeuvre de l'invention, après avoir déterminé la consigne de pilotage filtrée Vf, la consigne d'exécution peut ensuite être définie (et calculée) comme suit, en appliquant la formule de conversion mentionnée plus haut :
- Vf la consigne de pilotage filtrée (régularisée C3), ici plus préférentiellement issue du filtre du troisième ordre F3,
- L la longueur du câble de
suspension 6 qui relie la charge suspendue au point d'accroche, - g la gravité.
- V f filtered control setpoint (regularized C 3 ), here more preferably from the third order filter F3,
- L the length of the
suspension cable 6 which connects the suspended load to the point of attachment, - g gravity.
Cette formule de conversion, simple et rapide à exécuter, présente l'avantage d'être intrinsèquement une fonction anti-ballant.This conversion formula, simple and fast to execute, has the advantage of being intrinsically an anti-dangling function.
Ainsi, utiliser la formule de conversion ci-dessus est avantageusement équivalent à appliquer à la consigne de pilotage filtrée Vf une fonction (supplémentaire) anti-ballant, qui permet de produire une consigne d'exécution Vtrol non génératrice de ballant.Thus, using the above conversion formula is advantageously equivalent to applying to the filtered piloting set V f an (additional) anti-dangling function, which makes it possible to produce a non- ballistic V trol execution instruction.
En effet, la formule de conversion ci-dessus provient d'un modèle de pendule simplifié, dans lequel on considère que l'angle de ballant β est quasi-nul, c'est-à-dire que la charge suspendue 1 ne se balance pas (ou quasiment pas) par rapport au chariot 5.Indeed, the above conversion formula comes from a simplified model of pendulum, in which it is considered that the swing angle β is almost zero, that is to say that the suspended
Avantageusement, cela signifie, de manière réciproque, qu'une consigne d'exécution Vtrol élaborée à partir de ce modèle est telle que, si ladite consigne d'exécution est effectivement exécutée fidèlement par les moteurs d'entraînement 7, 8, et donc par le chariot 5, ladite consigne d'exécution Vtrol ne peut pas, en elle-même, provoquer de ballant.Advantageously, this means, reciprocally, that a V trol execution instruction developed from this model is such that, if said execution instruction is actually faithfully executed by the
La
La conversion de la consigne filtrée Vf en consigne d'exécution Vtrol pourra être opérée par tout module de conversion (calculateur) 13 approprié, du genre circuit électronique ou module programmé informatiquement.The conversion of the filtered setpoint V f to the execution setpoint V trol can be performed by any appropriate conversion module (computer) 13 of the electronic circuit type or computer programmed module.
On remarquera par ailleurs que la détermination de la consigne d'exécution Vtrol selon l'invention peut avantageusement être réalisée sans qu'il soit nécessaire de connaître, et a fortiori sans qu'il soit nécessaire de mesurer, la masse M de la charge suspendue 1, dans la mesure où ce paramètre (la masse M de la charge 1) n'intervient pas dans les formules employées pendant l'étape (b) de traitement, et notamment n'intervient pas dans la définition du filtre du troisième ordre F3 ou dans la formule de conversion susmentionnée.It will also be noted that the determination of the V trol execution instruction according to the invention can advantageously be carried out without it being necessary to know, and even more so without it being necessary to measure, the mass M of the load. suspended 1, insofar as this parameter (the mass M of the load 1) does not intervene in the formulas used during step (b) of treatment, and in particular does not intervene in the definition of the third order filter F3 or in the aforementioned conversion formula.
On peut donc faire l'économie d'une mesure de la masse M de la charge suspendue 1 ou d'un traitement de ce paramètre de masse M, ce qui permet, ici encore, de simplifier la structure de l'engin de levage 2, et de simplifier et d'accélérer l'exécution du procédé.It is therefore possible to economize on a measurement of the mass M of the suspended
Avantageusement, les effets anti-ballant intrinsèquement procurés d'une part par la régularisation C3 elle-même, et d'autre part par l'utilisation d'une formule de conversion non génératrice de ballant, se combineront pour offrir un asservissement optimisé du mouvement de la charge suspendue 1, totalement dépourvu de ballant.Advantageously, the anti-dangling effects intrinsically provided on the one hand by the C 3 regularization itself, and on the other hand by the use of a non-dangling conversion formula, will combine to offer optimized servocontrol of the movement of the suspended
Compte tenu des aptitudes du procédé à générer une consigne d'exécution qui ne provoque pas de ballant, on pourra, de façon particulièrement préférentielle, mettre en oeuvre l'asservissement selon l'invention en boucle ouverte.Given the ability of the method to generate a performance instruction that does not cause a ballad, we can, particularly preferably, implement the servo according to the invention in open loop.
Ainsi, on pourra notamment piloter l'engin de levage 2, et plus particulièrement les déplacements du chariot 5 (ici typiquement en orientation Θ et en distribution R), en appliquant "en aveugle" la consigne d'exécution (ici de préférence une consigne de vitesse) Vtrol au(x) moteur(s) d'entraînement 7, 8, sans prévoir d'asservissement qui viserait à réduire ensuite le ballant réel qui résulterait éventuellement de l'application de cette consigne d'exécution ou bien encore qui résulterait de perturbations extérieures.Thus, it will be possible in particular to control the hoist 2, and more particularly the movements of the carriage 5 (here typically in orientation Θ and in distribution R ), by applying "blindly" the instruction of execution (here preferably a set speed) V trol the (x) drive motor (s) 7, 8, without providing slaving that would aim to reduce then the actual dangling that might result from the application of this performance instruction or even who result from external disturbances.
En particulier, on pourra ainsi piloter l'engin de levage 2 sans avoir à utiliser de retour (« feedback ») mesuré ou calculé de l'angle de ballant effectif (réel) de la charge suspendue 1, ni de retour mesuré ou calculé de la vitesse angulaire du ballant effectif de ladite charge suspendue 1 et, de préférence, sans avoir à utiliser de retour mesuré de la vitesse effective (réelle) du déplacement du point d'accroche H.In particular, it will thus be possible to drive the hoist 2 without having to use a measured or calculated feedback ("feedback") of the actual (real) swing angle of the suspended
En utilisant en boucle ouverte le procédé selon l'invention, on peut donc avantageusement obtenir un excellent contrôle du déplacement de la charge suspendue 1, et plus particulièrement offrir au conducteur de l'engin d'excellentes possibilités de contrôle manuel du déplacement de la charge suspendue, au moyen d'un procédé qui allie simplicité et rapidité d'exécution, tout en simplifiant la structure de l'engin de levage 2, et notamment en faisant l'économie de capteurs destinés à mesurer le ballant.By using the method according to the invention in an open loop, it is therefore advantageously possible to obtain excellent control of the displacement of the suspended
Ceci étant, le procédé selon l'invention reste toutefois parfaitement compatible, en variante de réalisation, avec un asservissement en boucle fermée, selon lequel on détermine tout d'abord la consigne d'exécution Vtrol conformément à l'invention, en faisant notamment intervenir le filtrage du troisième ordre, puis on applique ensuite ladite consigne d'exécution Vtrol aux moteurs d'entraînement 7, 8 tout en prévoyant un asservissement en boucle fermée (tel que décrit plus haut) destiné à réduire activement un éventuel ballant, au cas où un tel ballant apparaîtrait malgré tout, en étant provoqué par des perturbations externes au système de pilotage, telles que des rafales de vent, par exemple.This being the case, the method according to the invention remains perfectly compatible, as an alternative embodiment, with a closed-loop servocontrol, according to which the execution instruction V trol is first determined in accordance with the invention, in particular by making intervening third-order filtering, then said V trol execution instruction is then applied to the
Avantageusement, selon une pareille variante de réalisation, la détermination de la consigne d'exécution Vtrol selon l'invention, avec régularisation C3 d'une part et utilisation de la formule de conversion anti-ballant mentionnée plus haut d'autre part, permettra toutefois de générer une consigne d'exécution (consigne de vitesse de chariot) Vtrol déjà optimisée, non génératrice de ballant (intrinsèquement), si bien que la tâche de compensation de ballant affectée à la boucle fermée de l'asservissement sera grandement simplifiée (puisqu'il s'agira seulement de réduire d'éventuels ballants provoqués par les seules perturbations externes au système de pilotage).Advantageously, according to such an alternative embodiment, the determination of the execution instruction V trol according to the invention, with regularization C 3 on the one hand and use of the anti-dangling conversion formula mentioned above on the other hand, however, it will be possible to generate an execution instruction (trolley speed reference) V trol already optimized, not generating a dangling (intrinsically), so that the dancer compensation task assigned to the closed loop of the servo will be greatly simplified. (since this will only reduce possible dangling caused by the only disturbances external to the control system).
On rappellera par ailleurs que les moteurs d'entraînement 7, 8 présentent, par nature, des capacités de vitesse, d'accélération, et de couple limitées (finies).It will also be recalled that the
Par conséquent, il est nécessaire que la consigne d'exécution Vtrol soit compatible avec ces capacités, afin que les moteurs 7, 8 puissent effectivement exécuter ladite consigne d'exécution Vtrol, et ainsi générer, comme résultat de l'application de ladite consigne d'exécution Vtrol auxdits moteurs 7, 8, des mouvements du chariot 5 et de la charge suspendue 1 sans ballant, qui soient conformes aux mouvements qui sont attendus au regard de ladite consigne d'exécution.Therefore, it is necessary that the V trol execution instruction is compatible with these capabilities, so that the
En d'autres termes, il est nécessaire de veiller à générer une consigne d'exécution Vtrol qui soit réalisable, c'est-à-dire cohérente et compatible avec les capacités matérielles effectives des moteurs d'entraînement 7, 8, de manière à ne pas chercher à solliciter le système de pilotage au-delà de ses capacités, et ainsi de manière à éviter toute situation dans laquelle une insuffisance d'un moteur 7, 8 conduirait le mouvement réel à différer du mouvement idéal attendu, et provoquerait par exemple l'apparition ou l'accentuation d'un ballant.In other words, it is necessary to take care to generate a V trol execution instruction which is feasible, that is to say coherent and compatible with the actual hardware capacities of the
En définitive, au regard des critères de stabilité, de rapidité de convergence, et de respect des capacités matérielles des moteurs d'entraînement 7, 8, on peut considérer que, globalement, la consigne de pilotage filtrée (consigne de vitesse filtrée) Vf doit répondre (simultanément) à quatre contraintes cumulées :
- Contrainte n°1 : la consigne de vitesse filtrée Vf(t) doit être trois fois dérivable, et plus particulièrement de classe C3 ;
- Contrainte n°2 : la consigne de vitesse filtrée Vf doit converger le plus rapidement possible vers la consigne de pilotage Vu (en réponse typiquement à une consigne de pilotage Vu formant un échelon constant) ;
- Contrainte n°3 : l'accélération du chariot 5 ne doit jamais dépasser la capacité d'accélération intrinsèque maximale du moteur d'entraînement 7, 8 correspondant, c'est-à-dire que l'on a en permanence : |V̇trol | ≤ aMAX, soit
- Contrainte n°4 : la consigne de vitesse du chariot (consigne d'exécution) Vtrol ne doit jamais dépasser la vitesse maximale que le moteur d'entraînement 7, 8 peut conférer au chariot 5, c'est-à-dire que l'on a en permanence: |Vtrol | ≤ VMAX soit:
- Constraint n ° 1: the filtered speed setpoint V f (t) must be three times differentiable, and more particularly of class C 3 ;
- Constraint No. 2: the filtered speed setpoint V f must converge as quickly as possible towards the control setpoint V u (in response typically to a control setpoint V u forming a constant step);
- Constraint No. 3: the acceleration of the
carriage 5 must never exceed the maximum intrinsic acceleration capacity of thecorresponding drive motor 7, 8, that is to say that there is always: V̇ trol | ≤ a MAX , eithermotor 7, 8 can give to the point of attachment H to which theload 1 is suspended (that is to say here to the carriage 5); - Constraint n ° 4: the trolley speed reference (execution instruction) V trol must never exceed the maximum speed that the
drive motor 7, 8 can give to thetrolley 5, that is to say that the trolley we always have: | V trol | ≤ V MAX is:drive motor 7, 8 can give to the point of attachment H to which theload 1 is suspended (that is to say here to the carriage 5).
La régularisation C3, et plus particulièrement l'application du filtre du troisième ordre F3, permet de satisfaire à la contrainte n°1 (consigne trois fois dérivable, et plus particulièrement de classe C3).The regularization C 3 , and more particularly the application of the third-order filter F3, makes it possible to satisfy the constraint n ° 1 (three-fold differentiable setpoint, and more particularly of class C 3 ).
On peut satisfaire à la contrainte n°2 (convergence rapide) en choisissant convenablement les coefficients c1, c2 dudit filtre du troisième ordre F3, comme indiqué ci-dessus, et d'autre part en adaptant la pulsation ω dudit filtre du troisième ordre F3 selon les circonstances, tel que cela sera détaillé ci-après.Stress No. 2 (fast convergence) can be satisfied by appropriately selecting the coefficients c1, c2 of said third order filter F3, as indicated above, and secondly by adapting the pulsation ω of said third order filter F3. depending on the circumstances, as will be detailed below.
On peut enfin satisfaire aux contraintes n°3 (limite d'accélération) et n°4 (limite de vitesse), c'est-à-dire s'assurer que la consigne d'exécution (consigne de vitesse du chariot) Vtrol est réalisable, en appliquant des fonctions de saturation SAT1, SAT2, SAT3 appropriées, qui seront détaillées dans ce qui suit.We can finally satisfy the constraints No. 3 (acceleration limit) and No. 4 (speed limit), that is to say, make sure that the execution instruction (instruction of trolley speed) V trol is achievable, by applying saturation functions SAT1, SAT2, SAT3 appropriate, which will be detailed in the following.
Ainsi, selon une caractéristique préférentielle qui peut constituer une invention à part entière, lors de la sous-étape (b4) de régularisation C3, on pourra faire intervenir, pour générer la consigne de pilotage filtrée Vf, un paramètre qui est représentatif de l'accélération maximale aMAX que le moteur d'entraînement 7, 8 peut conférer au point d'accroche H auquel est suspendue la charge 1, afin que la consigne d'exécution Vtrol qui découle de ladite consigne de pilotage filtrée Vf dépende de ladite accélération maximale de manière à être réalisable par ledit moteur d'entraînement 7,8.Thus, according to a preferred characteristic which can constitute an entirely separate invention, during the regulation sub-step (b4) C 3 , it is possible to use, to generate the filtered control setpoint V f , a parameter which is representative of the maximum acceleration MAX that the
Plus particulièrement, ledit paramètre choisi comme représentatif de l'accélération maximale aMAX admissible par le moteur d'entraînement 7,8 pourra être la pulsation ω du filtre du troisième ordre F3, sous forme d'une pulsation dite « pulsation calculée » ω0 qui sera déterminée en fonction notamment de ladite valeur d'accélération maximale admissible aMAX.More particularly, said parameter chosen as representative of the maximum acceleration MAX admissible by the drive motor 7.8 may be the pulsation ω of the third order filter F3, in the form of a so-called "calculated pulsation" pulse ω 0 which will be determined in particular according to said maximum acceleration value permissible at MAX .
Les inventeurs ont en effet établi qu'il existait un lien entre pulsation et accélération maximale admissible.The inventors have indeed established that there is a link between pulsation and maximum acceleration.
En effet, on a vu que l'accélération du chariot vaut
Supposons que l'on applique à l'instant t = 0 (instant initial), à une charge suspendue 1 au repos, c'est-à-dire à un système initialement à l'équilibre, une consigne Vu de type échelon.Suppose that we apply at time t = 0 (initial moment), to a load suspended 1 at rest, that is to say to a system initially at equilibrium, a setpoint V u of step type.
Le système étant initialement à l'équilibre, on peut alors considérer que l'accélération de la charge suspendue 1 est initialement nulle, c'est-à-dire que l'on a, à l'instant t=0 : V̇f (0) ≈ 0, du fait de l'inertie, tandis que l'accélération V̇trol du chariot 5 est maximale à ce même instant t=0, et vaut alors
La contrainte n°3 (limite d'accélération) impose donc :
c'est-à-dire :
that is to say :
Par conséquent, l'étape (b) de traitement peut donc comprendre de préférence une sous-étape (b1) de réglage de la pulsation du filtre du troisième ordre F3, au cours de laquelle on calcule la pulsation ω, ω0 dudit filtre du troisième ordre F3 à partir d'une valeur aMAX qui est représentative de l'accélération maximale que le moteur d'entraînement 7, 8 peut conférer au point d'accroche H auquel est suspendue la charge 1.Therefore, the processing step (b) may therefore preferably comprise a sub-step (b1) for adjusting the pulsation of the third-order filter F3, during which the pulsation ω, ω 0 of said filter of the filter is calculated. third order F3 from a value a MAX which is representative of the maximum acceleration that the driving
Par ailleurs, et dans la mesure où l'équation ci-dessus fait également apparaître, en conséquence de la contrainte n°3 (limite d'accélération), un lien entre la pulsation ω et la consigne de vitesse Vu, l'étape (b) de traitement comprendra de préférence une sous-étape (b1) de réglage de la pulsation ω du filtre du troisième ordre F3, au cours de laquelle on adapte la pulsation ω du filtre du troisième ordre, et plus particulièrement la pulsation calculée ω0, en fonction de la valeur de la consigne de pilotage Vu, VJOY appliquée par le conducteur de l'engin de levage à l'instant t considéré.Moreover, and to the extent that the equation above also shows, as a consequence of the constraint No. 3 (acceleration limit), a link between the pulsation ω and the speed reference V u , the step (b) processing will preferably comprise a sub-step (b1) for adjusting the pulsation ω of the third order filter F3, during which the third order filter's pulsation ω is adjusted, and more particularly the calculated pulsation ω 0 , depending on the value of the control setpoint V u , V JOY applied by the driver of the hoist at time t considered.
Plus préférentiellement, on modifie la valeur de la pulsation ω du filtre du troisième ordre F3 selon que la consigne de pilotage Vu, VJOY est inférieure ou au contraire supérieure à une vitesse de référence Vthresh qui est définie à partir de la valeur de vitesse maximale VMAX que le moteur d'entraînement 7, 8 peut conférer au point d'accroche H auquel est suspendue la charge 1.More preferably, the value of the pulsation ω of the third order filter F3 is modified according to whether the control set point V u , V JOY is lower or on the contrary higher than a reference speed V thresh which is defined from the value of maximum speed V MAX that the driving
En pratique, on fera varier la pulsation ω de sorte à augmenter ladite pulsation ω et ainsi utiliser une pulsation considérée comme grande, dite « valeur haute » ωhigh, et donc un filtre F3 plus réactif, lorsque la valeur absolue de la consigne de pilotage (c'est-à-dire l'amplitude de la consigne de vitesse) Vu, VJOY est faible au regard de la vitesse maximale admissible VMAX, et en diminuant au contraire ladite pulsation ω au profit d'une pulsation plus faible, dite « valeur basse » ωlow, lorsque la valeur absolue de la consigne de pilotage Vu, VJOY augmentera pour se rapprocher de la vitesse maximale admissible VMAX.In practice, the pulsation ω will be varied so as to increase said pulsation ω and thus use a pulsation considered as high, called "high value" ω high , and therefore a more reactive filter F3, when the absolute value of the pilot setpoint (that is to say the amplitude of the speed reference) V u , V JOY is low compared to the maximum permissible speed V MAX , and decreasing on the contrary said pulsation ω in favor of a lower pulsation so-called "low value" ω low , when the absolute value of the driving setpoint V u , V JOY will increase to approach the maximum permissible speed V MAX .
En particulier, lorsque la consigne de vitesse correspond à la vitesse maximale admissible : Vu = VMAX, la contrainte n°3 (limite d'accélération) imposera en effet :
En pratique, compte-tenu de ce qui précède, et tel que cela est illustré sur la
- on choisit Vthresh = k*VMAX,
avec 0 < k <1, par exemple k = 0,5 ; - si Vu ≤ Vthresh, alors on définit la pulsation calculée ω0 comme
- si Vu > Vthresh, alors on définit la pulsation calculée ω0 comme
- Vu la consigne de pilotage (ici égale à la consigne de pilotage brute VJOY),
- k un facteur de réglage choisi, compris
entre 0et 1, - L la longueur du câble de
suspension 6 qui relie lacharge suspendue 1 au point d'accroche H, - g la gravité (accélération de pesanteur),
- VMAX une valeur arbitraire (de réglage) que l'on considère comme représentative de la vitesse maximale que le moteur d'entraînement 7, 8 peut conférer au point d'accroche H auquel est suspendue la
charge 1 ; en pratique VMAX sera arbitrairement choisie en fonction des caractéristiques de l'engin de levage 2, de lacharge 1 prévue, et du moteur d'entraînement 7, 8 concerné, et pourra par exemple être égale à la valeur de vitesse maximale effective que le moteur d'entraînement 7, 8 est effectivement capable, d'après des essais, de conférer au chariot 5, ou bien, de préférence, être égale à une fraction (strictement inférieure à 100%, mais non nulle) de cette valeur de vitesse maximale effective ; - aMAX une valeur arbitraire (de réglage) que l'on considère comme représentative de l'accélération maximale que le moteur d'entraînement 7, 8 peut conférer au point d'accroche H auquel est suspendue la
charge 1 ; aMAX pourra par exemple être égale à la valeur maximale effective d'accélération du moteur, déterminée par des essais, ou bien, de préférence, être égale à une fraction (strictement inférieure à 100%, mais non nulle) de cette valeur maximale effective d'accélération.
- V thresh = k * V MAX is chosen, with 0 <k <1, for example k = 0.5;
- if V u ≤ V thresh , then we define the calculated pulsation ω 0 as
- if V u > V thresh , then we define the calculated pulsation ω 0 as
- V u the control setpoint (here equal to the raw control setpoint V JOY ),
- k a selected adjustment factor, between 0 and 1,
- L the length of the
suspension cable 6 which connects the suspendedload 1 to the point of attachment H , - g gravity (gravitational acceleration),
- V MAX an arbitrary value (of adjustment) which is considered as representative of the maximum speed that the driving
motor 7, 8 can give to the point of attachment H to which theload 1 is suspended; in practice V MAX will be arbitrarily chosen according to the characteristics of the hoist 2, theload 1 provided, and thedrive motor 7, 8 concerned, and may for example be equal to the maximum effective speed value that thedrive motor 7, 8 is actually capable, according to tests, of conferring on thecarriage 5, or, preferably, being equal to a fraction (strictly less than 100%, but not zero) of this value of maximum effective speed; - a MAX an arbitrary value (of adjustment) which is considered as representative of the maximum acceleration that the driving
motor 7, 8 can give to the point of attachment H to which theload 1 is suspended; a MAX could for example be equal to the maximum effective value of acceleration of the motor, determined by tests, or, preferably, be equal to a fraction (strictly less than 100%, but not zero) of this maximum effective value acceleration.
Le double objectif de cette adaptation (en temps réel) de la pulsation ω est d'optimiser la réactivité du filtre du troisième ordre 3 (contrainte n°2) en augmentant ladite pulsation ω lorsque cela est possible, car le temps de réponse du filtre F3 est inversement proportionnel à ladite pulsation ω (avec les coefficients c1, c2 choisis comme indiqué plus haut, le temps de réponse à 5% est de l'ordre de 4/ω), tout en respectant la contrainte n°3 liée au non-dépassement de la capacité maximale d'accélération du moteur d'entraînement 7, 8, qui fixe une limite supérieure admissible pour ladite pulsation ω.The dual purpose of this adaptation (in real time) of the pulsation ω is to optimize the reactivity of the third order filter 3 (constraint No. 2) by increasing said pulsation ω when possible, because the response time of the filter F3 is inversely proportional to said pulsation ω (with the coefficients c 1 , c 2 chosen as indicated above, the response time at 5% is of the order of 4 / ω), while respecting the constraint No. 3 related not exceeding the maximum acceleration capacity of the
On notera du reste que quelle que soit la loi retenue pour déterminer la pulsation ω, l'utilisation d'une pulsation ajustable permet de régler dynamiquement le filtre du troisième ordre F3, et d'intégrer directement et intrinsèquement au sein dudit filtre F3, de façon particulièrement simple, une partie des contraintes liées notamment aux capacités matérielles de vitesse et d'accélération des moteurs d'entraînement 7, 8.It will be noted moreover that whatever the law adopted to determine the pulsation ω, the use of an adjustable pulsation makes it possible to dynamically adjust the filter of the third order F3, and to integrate directly and intrinsically within said filter F3, particularly simple way, some of the constraints in particular the material capacities of speed and acceleration of the
L'ajustement de la pulsation ω du filtre du troisième ordre F3 pourra être réalisé par tout module d'ajustement de pulsation 14 approprié, formant un calculateur comprenant par exemple un circuit électronique ou un programme informatique adapté.The adjustment of the pulsation ω of the third order filter F3 can be achieved by any appropriate
Par ailleurs, les inventeurs ont constaté empiriquement que, pour éviter de déstabiliser le filtre du troisième ordre F3, notamment lors des transitions entre la valeur haute ωhigh et la valeur basse ωlow, la pulsation (calculée) ω, ω0 devait être deux fois dérivable (par rapport au temps).Furthermore, the inventors have empirically found that, in order to avoid destabilizing the third order filter F3, especially during transitions between the high value ω high and the low value ω low , the (calculated) pulse ω, ω 0 should be two once differentiable (in relation to time).
A ce titre, les inventeurs ont constaté qu'il était souhaitable de lisser la pulsation (calculée) ω, ω0, afin en particulier de garantir que ses évolutions dans le temps, et en particulier les transitions valeur haute ωhigh/valeur basse ωlow susmentionnées, soient continues et deux fois dérivables.As such, the inventors have found that it was desirable to smooth the (calculated) pulsation ω, ω 0 , in particular to ensure that its evolutions over time, and in particular the high value transitions ω high / low value ω low mentioned above, be continuous and twice differentiable.
C'est pourquoi, selon une caractéristique préférentielle qui peut constituer une invention à part entière, lors de la sous-étape (b1) de réglage de la pulsation ω du filtre du troisième ordre F3, on applique lors de la détermination de la pulsation ω, et plus particulièrement on applique à la pulsation calculée ω0, un filtre du second ordre F2, de manière à ce que le filtre du troisième ordre F3 utilise comme pulsation ω une pulsation calculée filtrée ωF.Therefore, according to a preferred characteristic which may constitute an entire invention, during the sub-step (b1) of adjusting the pulsation ω of the third order filter F3, it is applied during the determination of the pulsation ω , and more particularly one applies to the calculated pulsation ω 0 , a second order filter F2, so that the filter of the third order F3 uses as pulsation ω a filtered calculated pulse ω F.
Ladite pulsation calculée filtrée ωF est ainsi préférentiellement définie comme :
- ω0 la pulsation calculée (dite aussi « pulsation-cible »), obtenue comme indiqué plus haut, avant filtrage du second ordre F2,
- ωX la pulsation propre du filtre du second ordre F2, par exemple égale à 4 rad/s,
- m le coefficient d'amortissement du filtre du second ordre F2, de préférence égal à 0,7 (ce choix de valeur permettant d'obtenir un bon compromis entre temps de réponse faible et dépassement limité du filtre du second ordre).
- ω 0 the calculated pulsation (also called "target pulsation"), obtained as indicated above, before filtering the second order F2,
- ω X the proper pulsation of the second-order filter F2, for example equal to 4 rad / s,
- m the damping coefficient of the second order filter F2, preferably equal to 0.7 (this choice of value makes it possible to obtain a good compromise between low response time and limited second order filter overflow).
Par ailleurs, on constatera que si la pulsation ω du filtre du troisième ordre F3, et plus particulièrement la pulsation filtrée ω = ωF dudit filtre du troisième ordre F3, calculée comme décrit ci-dessus, varie continûment (c'est-à-dire régulièrement, sans discontinuité au sens mathématique du terme) pour converger vers la pulsation-cible calculée ω0, et plus particulièrement varie pour passer continûment de la valeur haute ωhigh à la valeur basse ωlow ou inversement, alors, dans l'absolu, pourraient se présenter certaines situations dans lesquelles l'inégalité
En effet, supposons par exemple que l'on se trouve initialement dans une situation dans laquelle le conducteur de l'engin sollicite peu ou pas le déplacement de la charge suspendue 1, de telle sorte que la consigne de pilotage (en vitesse) Vu est faible, voire nulle, si bien qu'elle est inférieure à la vitesse de référence : Vu < Vthresh, par exemple avec Vu = 0 m/s.Indeed, suppose, for example, that we are initially in a situation in which the driver of the machine does not request little or no movement of the suspended
La pulsation ω, ωF du filtre du troisième ordre F3 est alors proche de, voire égale à, sa valeur haute ωhigh.The pulse ω, ω F of the third order filter F3 is then close to, or equal to, its high value ω high .
Supposons maintenant que le conducteur de l'engin applique soudainement une consigne de vitesse Vu de forte amplitude, supérieure à la vitesse de référence Vthresh, et par exemple voisine de la vitesse maximale admissible : Vu = VMAX. En pratique, cela revient à appliquer au système de pilotage un échelon selon lequel le conducteur fait passer quasi-instantanément la consigne de pilotage Vu de sa valeur initiale faible, voire nulle (typiquement 0 m/s) à une valeur haute, typiquement VMAX.Suppose now that the driver of the machine suddenly applies a speed reference V u of high amplitude, higher than the reference speed V thresh , and for example close to the maximum permissible speed: V u = V MAX . In practice, this amounts to applying to the control system a step according to which the driver passes almost instantaneously the driving instruction V u from its initial low value, or even zero (typically 0 m / s) to a high value, typically V MAX .
Comme la consigne Vu = VMAX dépasse désormais la vitesse de référence Vthresh, le réglage automatique de la pulsation du filtre du troisième ordre, selon la sous-étape (b1), redéfinit la valeur de pulsation cible ω0, et en l'occurrence l'abaisse pour la fixer à la valeur basse : ω0 = ωlow.Since the setpoint V u = V MAX now exceeds the reference speed V thresh , the automatic setting of the third order filter's pulsation, according to the substep (b1), redefines the target pulse value ω 0 , and in 'instance lowers it to the low value: ω 0 = ω low .
Cependant, en raison du filtrage du second ordre F2 qui est appliqué pour obtenir la pulsation filtrée ωF, telle qu'elle est effectivement utilisée par le filtre du troisième ordre F3, la transition de ladite pulsation filtrée ωF depuis sa valeur haute ωhigh initiale jusqu'à sa (nouvelle) valeur-cible basse ω0 = ωlow n'est pas instantanée, mais au contraire relativement progressive, en ceci que ladite transition (en l'espèce, la diminution) de la pulsation, c'est-à-dire la convergence de la pulsation filtrée ωF vers la valeur basse ωlow, peut s'opérer plus lentement que le changement (ici l'augmentation) de la consigne de pilotage Vu, c'est-à-dire plus lentement que la convergence de la consigne de pilotage Vu vers sa valeur haute VMAX.However, because of the second order filtering F2 which is applied to obtain the filtered pulsation ω F , as actually used by the third order filter F3, the transition of said filtered pulsation ω F from its high value ω high initial to its (new) low target value ω 0 = ω low is not instantaneous, but on the contrary relatively progressive, in that said transition (in this case, the decrease) of the pulsation is that is, the convergence of the filtered pulsation ω F towards the low value ω low can take place more slowly than the change (here the increase) of the control setpoint V u , that is to say more slowly that the convergence of the control setpoint V u to its high value V MAX .
On comprendra donc que, pendant la brève durée qui est nécessaire pour adapter la pulsation ω, ωF du filtre du troisième ordre F3 à la nouvelle consigne de pilotage Vu, on peut donc temporairement se trouver dans une situation où coexistent une consigne de pilotage proche de sa valeur haute (Vu étant sensiblement égale à VMAX) et une pulsation ω, ωF également proche de sa valeur haute ωhigh, du fait que ladite pulsation "tarde" à diminuer pour atteindre sa valeur basse ωlow.It will therefore be understood that during the short time that is necessary to adapt the pulse ω, ω F of the third order filter F3 to the new setpoint V u pilot can therefore temporarily be in a situation where coexist a steering setpoint close to its high value (V u being substantially equal to V MAX ) and a pulse ω, ω F also close to its high value ω high because said pulsation "delays" to decrease to reach its low value ω low .
En pareil cas, l'accélération demandée au chariot 5 serait alors provisoirement sensiblement égale à
C'est notamment pourquoi, afin d'éviter une telle situation, et plus particulièrement afin de garantir que l'on satisfait en permanence à l'inégalité (posée par la contrainte n°3) :
Tel que cela est notamment illustré sur les
De préférence, la première loi de saturation SAT1 s'exprimera par :
- Vu la consigne de pilotage (ici égale à la consigne de pilotage brute VJOY),
- ωF la pulsation (et plus particulièrement la pulsation filtrée) du filtre du troisième ordre F3,
- L la longueur du câble de
suspension 6, - g la gravité et
- aMAX une valeur représentative de l'accélération maximale que le moteur d'entraînement 7, 8 peut conférer au point d'accroche H auquel est suspendue la charge 1 (ladite valeur d'accélération maximale étant de préférence définie comme indiqué plus haut).
- V u the control setpoint (here equal to the raw control setpoint V JOY ),
- ω F the pulsation (and more particularly the filtered pulsation) of the third order filter F3,
- L the length of the
suspension cable 6, - g gravity and
- a MAX represents a value representative of the maximum acceleration that the driving
motor 7, 8 can give to the point of attachment H to which the suspension is suspended. load 1 (said maximum acceleration value being preferably defined as indicated above).
De préférence, tel que cela est illustré sur les
Par ailleurs, dans certaines situations, lorsque la longueur L du câble de suspension 6 est importante, la consigne d'exécution Vtrol, et donc la vitesse du chariot 5, qui est donnée par la formule de conversion
La solution proposée par les inventeurs consiste à limiter la consigne d'exécution Vtrol lorsque celle-ci atteint une limite admissible prédéfinie (typiquement +/- VMAX), en saturant de manière adéquate la consigne de pilotage Vu.The solution proposed by the inventors consists in limiting the execution setpoint V trol when it reaches a predefined allowable limit (typically +/- V MAX ), by suitably saturating the driving setpoint V u .
Le principe est de recalculer la consigne de pilotage Vu lorsque la consigne d'exécution (et donc la vitesse du chariot 5) Vtrol atteint la vitesse maximale admissible VMAX, de manière à ce que la valeur absolue de ladite consigne d'exécution |Vtrol| reste (au plus) constante, voire diminue; en d'autres termes, on modifie la consigne de pilotage Vu afin de plafonner la consigne d'exécution Vtrol à sa valeur maximale admissible VMAX.The principle is to recalculate the control setpoint V u when the execution instruction (and therefore the speed of the carriage 5) V trol reaches the maximum permissible speed V MAX , so that the absolute value of said execution instruction | V trol | remains (at most) constant or even decreases; in other words, the control setpoint V u is modified in order to cap the execution setpoint V trol to its maximum allowable value V MAX .
C'est pourquoi l'étape (b) de traitement comprend de préférence une sous-étape (b3) de saturation secondaire, qui est destinée à maintenir constante ou à faire décroître la consigne d'exécution (c'est-à-dire la consigne de vitesse du point d'accroche H) Vtrol lorsque ladite consigne d'exécution Vtrol atteint sensiblement la vitesse maximale VMAX que le moteur d'entraînement 7, 8 peut conférer au point d'accroche H (c'est-à-dire en pratique au chariot 5).That is why the processing step (b) preferably comprises a sub-step (b3) of secondary saturation, which is intended to keep the execution instruction (ie the setpoint of speed of the point of attachment H ) V trol when said performance instruction V trol reaches substantially the maximum speed V MAX that the
Mathématiquement, si l'on souhaite maintenir la consigne d'exécution Vtrol constante, cela revient à poser V̇trol = 0, donc
Comme, en application du filtre du troisième ordre F3, on a :
Comme indiqué plus haut, on cherche à maintenir la consigne d'exécution Vtrol constante ou à la faire décroître, lorsqu'elle atteint la vitesse maximale admissible Vmax. En outre, en pratique, si la consigne de pilotage Vu est petite, cela indique en principe que l'on recherche une vitesse de chariot, donc une consigne d'exécution Vtrol, basse, c'est-à-dire qu'il n'y a alors pas de raison de conserver ladite consigne d'exécution Vtrol constante à sa valeur maximale VMAX, mais plutôt de la faire décroître.As indicated above, it is sought to keep the constant V trol performance set constant or to decrease it when it reaches the maximum permissible speed V max . In addition, in practice, if the driving setpoint V u is small, this indicates in principle that we are looking for a trolley speed, therefore a V trol , low execution instruction, that is to say that there is then no reason to keep said constant V trol performance instruction at its maximum value V MAX , but rather to decrease it.
C'est pourquoi, au cours de la sous-étape (b3) de saturation secondaire, on applique donc de préférence à la consigne de pilotage Vu, selon une caractéristique qui peut constituer une invention à part entière, une seconde loi de saturation SAT2 qui est exprimée par :
- Vu la consigne de pilotage (laquelle est de préférence issue du premier
module de saturation 15, après avoir subi la première loi de saturation SAT1, comme indiqué sur lafigure 4 ), - Vtrol la consigne d'exécution (vitesse de chariot), estimée ici par la formule de conversion :
- Vf la consigne de pilotage filtrée issue du filtre du troisième ordre F3, et
- c1, c2 les coefficients, respectivement du premier ordre et du second ordre, utilisés par le filtre du troisième ordre F3 (typiquement, on aura c1 = 2,15 et c2 = 1,75),
- ωF la pulsation (ici plus particulièrement la pulsation filtrée) du filtre du troisième ordre F3,
- L la longueur du câble de
suspension 6 qui relie lacharge suspendue 1 au point d'accroche H, - g la gravité.
- V u the control setpoint (which is preferably derived from the
first saturation module 15, after having undergone the first saturation law SAT1, as indicated on FIG.figure 4 ) - V trol the execution instruction (trolley speed), estimated here by the conversion formula:
- V f the filtered control setpoint from the third order filter F3, and
- c 1 , c 2 the coefficients, respectively of the first order and of the second order, used by the filter of the third order F3 (typically, we will have c 1 = 2.15 and c 2 = 1.75),
- ω F the pulsation (here more particularly the filtered pulsation) of the third order filter F3,
- L the length of the
suspension cable 6 which connects the suspendedload 1 to the point of attachment H , - g gravity.
Tel que cela est notamment illustré sur la
On notera que, par souci de stabilité, l'activation et la désactivation de cette seconde loi de saturation SAT2, au voisinage de la vitesse maximale admissible VMAX, pourront s'opérer de préférence par une commutation à hystérésis.It will be noted that, for the sake of stability, the activation and deactivation of this second saturation law SAT2, in the vicinity of the maximum permissible speed V MAX , may preferably be effected by hysteresis switching.
Plus particulièrement, la seconde loi de saturation SAT2 étant initialement inactive, celle-ci sera activée lorsque la consigne d'exécution Vtrol atteindra et dépassera un seuil d'enclenchement, légèrement supérieur à VMAX, et par exemple fixé à 1,04*VMAX (ce qui renforce l'intérêt de choisir VMAX légèrement en-deçà de la limite de vitesse physique véritable du moteur d'entraînement 7, 8 concerné, typiquement entre 95% et 98% de ladite limite physique), et être de nouveau désactivée lorsque la consigne d'exécution Vtrol redescendra sous un seuil d'extinction strictement inférieur au seuil d'enclenchement, et valant par exemple 1,01*VMAX.More particularly, the second saturation law SAT2 being initially inactive, it will be activated when the execution instruction V trol will reach and exceed a threshold of engagement, slightly higher than V MAX , and for example set at 1.04 * V MAX (which reinforces the interest of choosing V MAX slightly below the true physical speed limit of the driving
Par ailleurs, les inventeurs ont constaté que, même si la mise en oeuvre de la première loi de saturation SAT1 décrite plus haut permettait globalement de satisfaire à la contrainte n°3 (accélération du chariot devant rester inférieure à l'accélération maximale admissible aMAX), certaines combinaisons très particulières de consignes de pilotage pouvaient malgré tout prendre cette contrainte n°3 en défaut.Furthermore, the inventors have found that, even if the implementation of the first saturation law SAT1 described above generally made it possible to satisfy the constraint No. 3 (acceleration of the carriage having to remain below the maximum acceleration allowed at MAX ), some very particular combinations of piloting instructions could still take this constraint n ° 3 in default.
Or, comme indiqué plus haut, l'application d'une consigne d'exécution Vtrol qui ne respecterait les limites matérielles, notamment la capacité d'accélération, des moteurs d'entraînement 7, 8, risquerait de conduire à l'exécution d'un mouvement non conforme au mouvement attendu, et par conséquent à l'apparition d'un ballant.However, as indicated above, the application of a V trol performance instruction which does not respect the material limits, in particular the acceleration capacity, of the
C'est notamment pourquoi, afin de sécuriser le mouvement de la charge suspendue 1 et de garantir le contrôle et la précision dudit mouvement, l'étape (b) de traitement comprend de préférence, selon une caractéristique qui peut constituer une invention à part entière mais qui sera préférentiellement mise en oeuvre en complément de la première loi de saturation SAT1, une sous-étape (b5) de saturation de la dérivée troisième de la consigne de pilotage filtrée au cours de laquelle on applique à la dérivée (temporelle) troisième V̈f de la consigne de pilotage filtrée Vf une troisième loi de saturation SAT3 dont les seuils de saturation dépendent de l'accélération maximale aMAX (typiquement telle que définie plus haut) que le moteur d'entraînement 7, 8 peut conférer au point d'accroche H auquel est suspendue la charge 1.This is particularly why, in order to secure the movement of the suspended
La mise en oeuvre de cette troisième loi de saturation SAT3 peut avantageusement ajouter une précaution supplémentaire à celle procurée par la première loi de saturation SAT1, afin d'optimiser la sécurité de la commande en boucle ouverte selon l'invention.The implementation of this third saturation law SAT3 may advantageously add an additional precaution to that provided by the first saturation law SAT1, in order to optimize the security of the open-loop control according to the invention.
Plus préférentiellement, la troisième loi de saturation SAT3 pourra s'exprimer par :
- Vf la consigne de pilotage filtrée issue du filtre du troisième ordre F3,
- ωF la pulsation (ici plus particulièrement la pulsation filtrée) du filtre du troisième ordre F3,
- c1, c2 les coefficients, respectivement du premier ordre et du second ordre, utilisés par le filtre du troisième ordre F3,
- L la longueur du câble de
suspension 6 qui relie lacharge suspendue 1 au point d'accroche H, - g la gravité et
- aMAX une valeur représentative de l'accélération maximale que le moteur d'entraînement 7, 8 peut conférer au point d'accroche H auquel est suspendue la
charge 1, ladite valeur d'accélération maximale étant typiquement définie comme cela a été décrit plus haut.
- V f the filtered control setpoint from the third order filter F3,
- ω F the pulsation (here more particularly the filtered pulsation) of the third order filter F3,
- c 1 , c 2 the coefficients, respectively of the first order and the second order, used by the third order filter F3,
- L the length of the
suspension cable 6 which connects the suspendedload 1 to the point of attachment H , - g gravity and
- a MAX a value representative of the maximum acceleration that the driving
motor 7, 8 can give to the point of attachment H to which theload 1 is suspended, said maximum acceleration value being typically defined as described above; .
Tel que cela est notamment illustré sur la
On notera que, avantageusement, le raisonnement et les équations proposées ci-dessus trouvent à s'appliquer si l'on considère la situation réelle, en trois dimensions.It will be noted that, advantageously, the reasoning and the equations proposed above are applicable if we consider the real situation, in three dimensions.
En effet, si l'on considère la grue dans un repère cartésien tridimensionnel (X, Y, Z), où Z représente l'axe vertical, ici confondu avec le mât 3, on peut toujours écrire la loi de Newton :
En faisant l'hypothèse des petits angles de ballant, on a, en projection respectivement sur l'axe X et sur l'axe Y :
Selon une première possibilité de mise en oeuvre du procédé selon l'invention, on pourrait, dans l'absolu, conserver, pour le calcul de la consigne d'exécution Vtrol, et plus particulièrement pour le calcul des composantes cartésiennes Vtrol X et Vtrol Y de ladite consigne d'exécution, des expressions qui font apparaître l'accélération verticale aZ de la charge suspendue 1, de manière à pouvoir compenser également les effets potentiels de ladite accélération verticale de la charge suspendue 1 sur la génération de ballant.According to a first possibility of implementing the method according to the invention, it would be possible, in absolute terms, to keep, for the calculation of the execution instruction V trol , and more particularly for the calculation of the Cartesian components V trol X and V trol Y of said execution instruction, expressions which show the vertical acceleration Z of the suspended
Toutefois, selon une seconde possibilité préférentielle de mise en oeuvre du procédé selon l'invention, on pourra en pratique considérer, à titre d'hypothèse simplificatrice, que l'accélération de la charge suspendue aZ est négligeable au regard de la pesanteur g.However, according to a second preferred embodiment of the method according to the invention, it will be possible in practice to consider, by way of a simplifying hypothesis, that the acceleration of the load suspended at Z is negligible with regard to the gravity g.
En simplifiant en conséquence les expressions ci-dessus, on retrouve :
En dérivant (différentiant) ensuite ces expressions par rapport au temps, et en considérant, par simplification réaliste, que la vitesse de variation dL/dt de la longueur L du câble de suspension 6 est négligeable, on obtient :
Par ailleurs, on notera que le procédé selon l'invention est particulièrement polyvalent car il peut s'appliquer à tout type d'engin de levage 2, quelle que soit la configuration dudit engin de levage 2, dans la mesure où ledit procédé permet avantageusement de calculer de toute manière la consigne d'exécution Vtrol de manière simple dans un repère cartésien, quel que soit par ailleurs le système de coordonnées (cartésiennes, cylindriques ou sphériques), propre à l'engin de levage 2, dans lequel est d'abord exprimée la consigne de pilotage Vu, VJOY lorsqu'elle est fixée par le conducteur de l'engin, puis dans lequel la consigne d'exécution Vtrol doit être exprimée pour que ladite consigne d'exécution puisse être convenablement appliquée aux moteurs d'entraînement 7,8 concernés.Furthermore, it will be noted that the method according to the invention is particularly versatile since it can be applied to any type of hoist 2, whatever the configuration of said hoist 2, insofar as said method advantageously allows in any case, to calculate the execution instruction V trol in a simple way in a cartesian coordinate system, regardless of the coordinate system (Cartesian, cylindrical or spherical) specific to the hoist 2, in which is first expressed the driving instruction V u , V JOY when it is fixed by the driver of the machine, then in which the instruction V trol must be expressed so that said execution instruction can be properly applied to 7.8 drive motors involved.
En effet, il suffit tout d'abord de convertir en coordonnées cartésiennes, au moyen d'une matrice de transformation géométrique (du genre matrice de rotation), caractéristique de l'engin de levage 2 utilisé, et que l'on notera Rθ, les composantes de la consigne de pilotage Vu, VJOY initialement exprimées dans le système de coordonnées propre à l'engin de levage 2, puis de calculer la consigne d'exécution Vtrol dans ledit repère cartésien, et enfin de convertir à nouveau, au moyen d'une matrice de transformation inverse, que l'on notera R-θ, les composantes cartésiennes de ladite consigne d'exécution Vtrol en composantes exprimées dans le système de coordonnées propre à l'engin de levage 2, applicables aux moteurs d'entraînement 7, 8 qui gèrent respectivement le déplacement dudit engin 2 (et plus particulièrement du chariot 5) selon chacune desdites composantes.Indeed, it suffices first of all to convert into Cartesian coordinates, by means of a geometric transformation matrix (of the rotation matrix type), characteristic of the
Ainsi, dans le cas d'un engin de levage 2 formé par une grue à flèche horizontale (grue à tour à flèche horizontale), le système de coordonnées le plus approprié audit engin 2 sera un système de coordonnées cylindriques dans lequel la position de l'objet considéré est repérée par un rayon r (le long de la flèche) et un angle d'azimut θ (angle de lacer autour de l'axe d'orientation), tel que cela est illustré sur les
Le pilotage de la grue s'effectuant - de manière assez intuitive pour le conducteur - en distribution (modification du rayon r) et en orientation (modification de l'azimut θ), la consigne de pilotage Vu, VJOY, de même que la consigne d'exécution Vtrol, comprendront donc chacune une composante de distribution, destinée au moteur 7 de distribution (qui permet d'agir sur le rayon) et une composante d'orientation, destinée au moteur 8 d'orientation (qui permet de d'agir sur l'azimut).The control of the crane is carried out - in a fairly intuitive way for the driver - in distribution (modification of the radius r) and in orientation (modification of the azimuth θ), the driving setpoint V u , V JOY , as well as the execution instruction V trol , will each comprise a distribution component, intended for the
La première conversion (de la consigne de pilotage Vu, VJOY) depuis le système cylindrique vers le système cartésien pourra s'opérer au moyen d'une matrice de rotation Rθ, tandis que la seconde conversion (de la consigne d'exécution Vtrol) depuis le système cartésien vers le système cylindrique pourra s'opérer au moyen d'une matrice de rotation inverse R-θ.The first conversion (of the control setpoint V u , V JOY ) from the cylindrical system to the Cartesian system can be performed by means of a rotation matrix R θ , while the second conversion (of the execution instruction V trol ) from the Cartesian system to the cylindrical system can be operated by means of an inverse rotation matrix R -θ .
De manière analogue, dans le cas d'un engin de levage 2 formé par une grue à flèche relevable, le système de coordonnées le plus approprié sera le système de coordonnées sphériques, dans lequel la position du chariot 5 est repérée (et pilotée) par son azimut (orientation de la flèche relevable en lacet), sa déclinaison (orientation de la flèche relevable en tangage) et par son rayon (distance du chariot par rapport à la base articulée de la flèche relevable).Similarly, in the case of a hoist 2 formed by a luffing jib crane, the most appropriate coordinate system will be the spherical coordinate system, in which the position of the
Ici encore, les conversions vers et depuis le système cartésien seront opérées par des matrices de transformation géométrique appropriées, de manière à pouvoir gérer le moteur d'entraînement en azimut (lacet) de la flèche, le moteur d'entraînement en déclinaison (tangage) de la flèche, et le moteur d'entraînement en rayon (translation le long de la flèche).Here again, the conversions to and from the Cartesian system will be performed by appropriate geometrical transformation matrices, so as to be able to manage the azimuth drive motor (yaw) of the arrow, the drive motor in declination (pitch) of the boom, and the drive motor on the spoke (translation along the arrow).
Dans le cas d'un engin de levage 2 de type pont roulant, conçu pour réaliser des mouvements linéaires de translation selon un axe (X), ou selon deux axes perpendiculaires l'un à l'autre (X et Y), la consigne de pilotage pourra être directement exprimée dans un repère cartésien (X, Y), et ne nécessitera donc aucune conversion de coordonnées.In the case of a hoist 2 of the traveling crane type, designed to perform linear movements of translation along an axis (X), or along two axes perpendicular to each other (X and Y), the instruction can be directly expressed in a Cartesian coordinate system (X, Y), and therefore will not require any coordinate conversion.
En pratique, et tel que cela est illustré sur la
- la position de la
charge suspendue 1 est donnée dans un système de coordonnées adapté à l'engin de levage 2, ici préférentiellement en coordonnées cylindriques : rload, θload ; - la consigne de pilotage (brute) VJOY est exprimée par le conducteur de l'engin (via le joystick 11) sous forme d'une consigne de vitesse de charge suspendue Vload, dont les composantes correspondent au système de coordonnées considéré ; ici ladite consigne de vitesse de charge suspendue Vload, comprend (est décomposée en) une composante de vitesse de charge radiale souhaitée Vload r et une composante de vitesse de charge angulaire souhaitée Vload θ ;
- les composantes de la consigne de vitesse de charge suspendue Vload sont alors régularisées C3, et plus particulièrement filtrées à cet effet par le filtre du troisième ordre F3 ;
- ainsi, la première composante de la consigne de vitesse de charge suspendue, ici la composante de vitesse de charge radiale souhaitée Vload r, est régularisée C3, et plus particulièrement filtrée par le filtre du troisième ordre F3 (module de filtrage 12), pour obtenir une consigne de vitesse de charge radiale filtrée Vload rf (c'est-à-dire la première composante de la consigne de pilotage filtrée Vf) ;
- de même, la seconde composante de la consigne de vitesse de charge suspendue, ici la composante de vitesse de charge angulaire souhaitée Vload θ, est régularisée C3, et plus particulièrement est filtrée par le filtre du troisième ordre F3 (module de filtrage 12), pour obtenir une consigne de vitesse de charge angulaire filtrée, puis elle est multipliée par le rayon rload, qui correspond à la distance à laquelle la
charge suspendue 1 se trouve de l'axe de rotation vertical (ZZ'), de manière à obtenir une consigne de vitesse tangentielle (orthoradiale) filtrée Vload θf (c'est-à-dire la seconde composante de la consigne de pilotage filtrée Vf) ; - la consigne de vitesse de charge filtrée (consigne de pilotage filtrée Vf), dont les composantes, ici radiale et tangentielle, sont désormais connues, est alors exprimée dans un repère cartésien en appliquant une matrice de transformation géométrique, ici la matrice de rotation Rθload qui correspond à la position angulaire en lacet θload de la charge suspendue 1 : (Vload Xf, Vload Yf) = Rθload (Vload rf, Vload θf) ;
- sur chaque axe X et Y dudit repère cartésien, on peut alors déterminer, grâce à la formule de conversion (module de conversion 13), la composante correspondante de la consigne d'exécution (consigne de vitesse de chariot) Vtrol : Vtrol X = Vload Xf +
- la consigne d'exécution (consigne de vitesse de chariot) Vtrol, disponible en coordonnées cartésiennes est alors exprimée dans le système de coordonnées adapté à l'engin de levage, en l'espèce en coordonnées cylindriques, en appliquant une matrice de transformation géométrique inverse, ici une matrice de rotation inverse R-θtrol qui correspond à la position angulaire en lacet θtrol du chariot 5 : (Vtrol r, Vtrol θ) = R-θtrol (Vtrol X, Vtrol Y) ;
- les composantes de la consigne d'exécution Vtrol sont alors appliquées chacune à leur moteur d'entraînement 7, 8 respectif; ainsi, la composante radiale Vtrol r de la consigne d'exécution Vtrol est alors appliquée au moteur de
distribution 7, - tandis que la composante tangentielle Vtrol θ de ladite consigne d'exécution Vtrol est convertie en consigne de vitesse angulaire de chariot,
par multiplication par 1/rtrol, où rtrol représente la distance duchariot 5 à l'axe de rotation vertical (ZZ'), puis appliquée au moteur d'orientation (giration en lacet) 8.
- the position of the suspended
load 1 is given in a coordinate system adapted to the hoist 2, here preferably in cylindrical coordinates: r load , θ load ; - the driving instruction (gross) V JOY is expressed by the driver of the machine (via the joystick 11) in the form of a suspended load speed instruction V load , the components of which correspond to the coordinate system considered; Here, said suspended load speed setpoint V load comprises (is decomposed into) a desired radial load speed component V load r and a desired angular load speed component V load θ ;
- the components of the suspended load speed instruction V load are then regularized C 3 , and more particularly filtered for this purpose by the third order filter F3;
- thus, the first component of the suspended charge speed instruction, here the desired radial load speed component V load r , is regularized C 3 , and more particularly filtered by the third order filter F 3 (filter module 12), to obtain a filtered radial load speed reference V load rf (that is to say the first component of the filtered control setpoint V f );
- likewise, the second component of the suspended charge speed instruction, here the desired angular charge velocity component V load θ , is regularized C 3 , and more particularly is filtered by the third order filter F3 (filter module 12 ), to obtain a filtered angular load speed instruction, then it is multiplied by the radius r load , which corresponds to the distance at which the suspended
load 1 is from the vertical axis of rotation (ZZ '), so obtaining a filtered (orthoradial) tangential velocity instruction V load θf (that is to say the second component of the filtered control setpoint V f ); - the filtered charge speed reference (filtered piloting setpoint V f ), whose components, here radial and tangential, are now known, is then expressed in a Cartesian frame by applying a geometric transformation matrix, here the rotation matrix R θload which corresponds to the angular position in yaw θ load of the suspended load 1: (V load Xf , V load Yf ) = R θload (V load rf , V load θf ) ;
- on each X and Y axis of said Cartesian coordinate system, it is then possible to determine, by means of the conversion formula (conversion module 13), the corresponding component of the execution instruction (trolley speed reference) V trol : V trol X = V load Xf +
- the execution instruction (trolley speed reference) V trol , available in Cartesian coordinates is then expressed in the coordinate system adapted to the hoist, in this case in cylindrical coordinates, by applying a geometric transformation matrix inverse, here an inverse rotation matrix R- θtrol which corresponds to the angular position in yaw θ trol of the carriage 5: (V trol r , V trol θ ) = R- θtrol (V trol X , V trol Y );
- the components of the V trol instruction set are then each applied to their
respective drive motor 7, 8; thus, the radial component V trol r of the execution instruction V trol is then applied to thedistribution motor 7, - while the tangential component V trol θ of said execution instruction V trol is converted into trolley angular speed reference, by multiplication by 1 / r trol , where r trol represents the distance of the
carriage 5 to the vertical axis of rotation (ZZ '), then applied to the orientation motor (yaw gyration) 8.
On notera par ailleurs que les coordonnées cylindriques du chariot 5 (point d'accroche H) peuvent être aisément connues (en temps réel), par exemple au moyen d'une part d'un capteur de position angulaire qui renseigne sur la position angulaire en lacet de la flèche 4 par rapport au mât 3, c'est-à-dire sur la position angulaire en lacet θtrol du chariot 5, et d'autre part au moyen d'un capteur de position, par exemple associé au moteur d'entraînement en distribution 7, qui permet de connaître la position du chariot 5 (en translation) le long de la flèche 4, et par conséquent la distance radiale rtrol à laquelle ledit chariot 5 se trouve de l'axe vertical de rotation (ZZ').Note also that the cylindrical coordinates of the carriage 5 (point of attachment H ) can be easily known (in real time), for example by means of a part of an angular position sensor which provides information on the angular position in yaw of the
De même, la longueur L du câble de suspension 6 pourra être connue en temps réel au moyen d'un capteur mesurant la rotation absolue du treuil ou du moteur de levage qui génère l'enroulement dudit câble de suspension 6.Similarly, the length L of the
La position angulaire en lacet θload de la charge suspendue 1, ainsi que la distance (radiale) rload de ladite charge suspendue par rapport à l'axe vertical de giration (ZZ') pourront être estimées par intégration (sur le temps) des composantes de la consigne de pilotage filtrée Vf, puisque lesdites composantes correspondent ici respectivement à la vitesse radiale de charge filtrée Vload rf et à la vitesse angulaire de charge filtrée Vload θf.The angular position in yaw θ load of the suspended
Ainsi, plus particulièrement, on pourra évaluer une position radiale estimée rload_estim de la charge suspendue 1 comme :
On notera à ce titre que, lorsque l'engin de levage 2, et plus particulièrement la charge suspendue 1, se trouve au repos, de telle sorte que ladite charge suspendue 1 pend sensiblement à la verticale du chariot 5, la position angulaire en lacet et la distance à l'axe de giration de la charge suspendue 1 sont identiques respectivement à la position angulaire en lacet et à la distance à l'axe de giration du chariot 5, elles-mêmes mesurées comme indiqué ci-dessus.It will be noted in this respect that, when the hoist 2, and more particularly the suspended
On pourra donc poser, comme condition initiale (et donc comme paramètre d'étalonnage) du calcul intégral susmentionné : rload (0) = rtrol(0), où « 0 » correspond à un instant initial où le système se trouve au repos.We can therefore set, as an initial condition (and thus as a calibration parameter) of the aforementioned integral computation: r load (0) = r trol (0), where "0" corresponds to an initial moment when the system is at rest .
Le cas échéant, pour améliorer la précision de l'estimation de la position radiale de la charge suspendue 1, on pourra utiliser un observateur (matrice d'observation) faisant intervenir une mesure supplémentaire de la position radiale du chariot 5.If necessary, to improve the accuracy of the estimation of the radial position of the suspended
Par ailleurs, on notera que la régularisation C3, et plus particulièrement le filtrage du troisième ordre F3, pourra être appliqué(e) à un (seul) mouvement caractéristique de l'engin de levage 2 (typiquement le mouvement de giration en orientation ou bien le mouvement de translation en distribution dans l'exemple préféré illustré sur les
L'invention concerne par ailleurs bien entendu en tant que telle l'utilisation d'une régularisation C3, et plus particulièrement l'utilisation d'un filtre du troisième ordre F3, et le cas échéant, l'utilisation de l'une et/ou l'autre des lois de saturation SAT1, SAT2, SAT3, dans la détermination d'une consigne d'exécution Vtrol destinée à être appliquée à un moteur d'entraînement 7, 8 permettant de déplacer une charge suspendue 1 à un engin de levage 2, selon l'une ou l'autre des modalités décrites dans ce qui précède.The invention furthermore relates, of course, as such to the use of a C 3 regularization, and more particularly to the use of a third order filter F 3 , and where appropriate, the use of one and / or the other saturation laws SAT1, SAT2, SAT3, in the determination of a V trol execution setpoint intended to be applied to a
A ce titre, on notera que l'invention porte en tant que telle sur la mise en oeuvre d'une régularisation C3, et plus particulièrement sur la mise en oeuvre du filtre du troisième ordre F3, respectivement de tout ou partie des lois de saturation, quelle que soit par ailleurs le type de calcul employé pour déterminer ensuite les composantes de la consigne d'exécution Vtrol.As such, it should be noted that the invention as such relates to the implementation of a regularization C 3 , and more particularly to the implementation of the third order filter F 3 , respectively of all or some of the laws of saturation, regardless of the type of calculation used to determine the components of the V trol execution instruction .
L'invention concerne également un boîtier de commande pour engin de levage, comprenant l'un et/ou l'autre des modules (c'est-à-dire des calculateurs, électroniques et/ou informatiques) de régularisation C3/filtrage de troisième ordre 12, de conversion 13, d'ajustement de pulsation 14, ou de saturation 15, 16, 17 décrits plus haut, ainsi qu'un engin de levage 2 équipé d'un tel boîtier de commande.The invention also relates to a control box for a lifting vehicle, comprising one and / or the other of the modules (that is to say computers, electronic and / or computer) for regularization C 3 / filtering
Enfin, l'invention n'est bien entendu nullement limitée aux seules variantes de réalisation décrites, l'homme du métier étant notamment à même d'isoler ou de combiner librement entre elles l'une ou l'autre des caractéristiques mentionnées dans ce qui précède, ou encore de leur substituer des équivalents.Finally, the invention is of course in no way limited to the variants of embodiment described, the person skilled in the art being able to isolate or combine freely between them one or the other of the characteristics mentioned in what precedes, or substitute equivalents for them.
Claims (14)
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1659607A FR3056976B1 (en) | 2016-10-05 | 2016-10-05 | METHOD OF CONTROLLING ANTI-BALLING CRANE WITH FILTER OF THE THIRD ORDER |
Publications (2)
Publication Number | Publication Date |
---|---|
EP3305710A1 true EP3305710A1 (en) | 2018-04-11 |
EP3305710B1 EP3305710B1 (en) | 2019-05-29 |
Family
ID=58009907
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP17190875.9A Active EP3305710B1 (en) | 2016-10-05 | 2017-09-13 | Method for controlling an anti-oscillatory crane with a third-order filter |
Country Status (5)
Country | Link |
---|---|
US (1) | US20180093868A1 (en) |
EP (1) | EP3305710B1 (en) |
CN (1) | CN108163712A (en) |
ES (1) | ES2743527T3 (en) |
FR (1) | FR3056976B1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3653562A1 (en) * | 2018-11-19 | 2020-05-20 | B&R Industrial Automation GmbH | Method and oscillating regulator for regulating oscillations of an oscillatory technical system |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR3071240B1 (en) * | 2017-09-21 | 2019-09-06 | Manitowoc Crane Group France | DYNAMIC OPTIMIZATION OF A CRANE LOAD CURVE |
CN108303883A (en) * | 2018-01-22 | 2018-07-20 | 五邑大学 | The anti-pendular regime of bridge crane based on first-order dynamic sliding moding structure |
CN110342405B (en) * | 2019-07-25 | 2020-10-02 | 上海振华重工(集团)股份有限公司 | Control method for accurate positioning of container straddle carrier lifting mechanism |
EP4043967A4 (en) * | 2019-10-11 | 2023-11-01 | Tadano Ltd. | Control system, and crane |
CN112456361A (en) * | 2020-11-25 | 2021-03-09 | 西北工业大学 | Control method for reducing swing amplitude of underwater extension set of hydraulic winch for hoisting sonar |
TWI804983B (en) * | 2021-01-18 | 2023-06-11 | 台達電子工業股份有限公司 | Full-time anti-sway control method of bridge crane system based on inverter |
FR3120620B1 (en) * | 2021-03-09 | 2024-02-09 | Manitowoc Crane Group France | Method of assisting maintenance of a metal cable of a lifting or transport device |
JP7614027B2 (en) | 2021-06-14 | 2025-01-15 | 国立大学法人豊橋技術科学大学 | crane |
CN113682966B (en) * | 2021-07-19 | 2023-06-02 | 杭州大杰智能传动科技有限公司 | Operation data monitoring and identifying system and method for intelligent tower crane |
EP4406905A1 (en) * | 2023-01-25 | 2024-07-31 | WOLFFKRAN Holding AG | Method and device for operating a boom slewing crane and boom slewing crane |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1652810A1 (en) * | 2003-08-05 | 2006-05-03 | Sintokogio, Ltd. | Crane and controller for the same |
FR3016872A1 (en) * | 2014-01-30 | 2015-07-31 | Manitowoc Crane Group France | ANTI-BALLING CONTROL METHOD WITH ADJUSTABLE ASSISTANCE FOR TRANSPORTING A SUSPENDED LOAD |
US9120650B2 (en) * | 2012-03-09 | 2015-09-01 | Liebherr-Werk Nenzing Gmbh | Crane controller with cable force mode |
-
2016
- 2016-10-05 FR FR1659607A patent/FR3056976B1/en not_active Expired - Fee Related
-
2017
- 2017-09-13 ES ES17190875T patent/ES2743527T3/en active Active
- 2017-09-13 EP EP17190875.9A patent/EP3305710B1/en active Active
- 2017-09-21 US US15/711,660 patent/US20180093868A1/en not_active Abandoned
- 2017-10-09 CN CN201710930168.6A patent/CN108163712A/en active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1652810A1 (en) * | 2003-08-05 | 2006-05-03 | Sintokogio, Ltd. | Crane and controller for the same |
US9120650B2 (en) * | 2012-03-09 | 2015-09-01 | Liebherr-Werk Nenzing Gmbh | Crane controller with cable force mode |
FR3016872A1 (en) * | 2014-01-30 | 2015-07-31 | Manitowoc Crane Group France | ANTI-BALLING CONTROL METHOD WITH ADJUSTABLE ASSISTANCE FOR TRANSPORTING A SUSPENDED LOAD |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3653562A1 (en) * | 2018-11-19 | 2020-05-20 | B&R Industrial Automation GmbH | Method and oscillating regulator for regulating oscillations of an oscillatory technical system |
CN111196557A (en) * | 2018-11-19 | 2020-05-26 | B和R工业自动化有限公司 | Method and vibration controller for compensating vibrations of a vibratable technical system |
US11334027B2 (en) | 2018-11-19 | 2022-05-17 | B&R Industrial Automation GmbH | Method and oscillation controller for compensating for oscillations of an oscillatable technical system |
CN111196557B (en) * | 2018-11-19 | 2023-12-22 | B和R工业自动化有限公司 | Method and vibration regulator for compensating vibrations of a vibratable technical system |
Also Published As
Publication number | Publication date |
---|---|
FR3056976B1 (en) | 2018-11-16 |
US20180093868A1 (en) | 2018-04-05 |
CN108163712A (en) | 2018-06-15 |
ES2743527T3 (en) | 2020-02-19 |
FR3056976A1 (en) | 2018-04-06 |
EP3305710B1 (en) | 2019-05-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3305710B1 (en) | Method for controlling an anti-oscillatory crane with a third-order filter | |
EP3160823B1 (en) | Mixed power steering comprising a torque control loop controlled to a setpoint by a position controller intended for trajectory control | |
FR3016872A1 (en) | ANTI-BALLING CONTROL METHOD WITH ADJUSTABLE ASSISTANCE FOR TRANSPORTING A SUSPENDED LOAD | |
WO2010069890A1 (en) | Device for controlling the movement of a load suspended from a crane | |
EP3459899B1 (en) | Dynamic optimisation of a crane load curve | |
EP2219988B1 (en) | Device and method for regulating the displacement of a suspended load | |
FR2786283A1 (en) | METHOD AND DEVICE FOR CONTROLLING THE ATTITUDE OF A SATELLITE | |
FR3053133A1 (en) | METHOD FOR THE DYNAMIC CONVERSION OF ATTITUDE OF A ROTARY SAIL DRONE | |
EP3336649B1 (en) | Flight control method for rotorcraft, and rotorcraft | |
EP2870040A1 (en) | Device and method for controlling the trajectory of a vehicle | |
FR3099450A1 (en) | Autonomous control method of an actuator of an automotive device | |
CA2349770C (en) | Electric control system for aircraft rudder | |
EP3091413B1 (en) | An advanced control law for a deflectable stabilizer | |
WO2018036723A1 (en) | Method of stabilization by orientation of a convoy of vehicles | |
FR2881849A1 (en) | METHOD AND DEVICE FOR CONTROLLING A PLANE IN BLANK | |
FR2891051A1 (en) | METHOD AND DEVICE FOR REALIZING AT LEAST ONE FLIGHT TEST ON AN AIRCRAFT AND APPLICATIONS | |
EP0611211B1 (en) | System to control the speed of displacement of a swaying load and lifting device comprising such a system | |
FR2903380A1 (en) | Aircraft dynamic controlling device for e.g. micro convertible drone system, involves controlling aircraft by propeller engines, where engines arranged in diagonal manner rotate with respect to each other in same direction | |
EP1293854B1 (en) | System for controlling a helicopter's engine speed | |
WO2020182373A1 (en) | Method for autonomously controlling a mobility of an apparatus | |
FR3094324A1 (en) | Autonomous piloting method of a device trajectory control member | |
EP2668100B1 (en) | Method and system for piloting a flying craft with rear propulsion unit | |
EP1223104B1 (en) | Guiding process for a gyroscopic moment control system | |
FR2914074A1 (en) | METHOD FOR GENERATING VALUES OF INSTRUCTIONS FOR SERVING A PARAMETER OF VOL P OF AN AIRCRAFT EQUIPPED WITH AN AUTOMATIC PILOT. | |
FR2876468A1 (en) | AUTOMATIC HELICOPTER CONTROL SYSTEM |
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 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE APPLICATION HAS BEEN PUBLISHED |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
AX | Request for extension of the european patent |
Extension state: BA ME |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE |
|
17P | Request for examination filed |
Effective date: 20180712 |
|
RBV | Designated contracting states (corrected) |
Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
GRAP | Despatch of communication of intention to grant a patent |
Free format text: ORIGINAL CODE: EPIDOSNIGR1 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: GRANT OF PATENT IS INTENDED |
|
INTG | Intention to grant announced |
Effective date: 20190108 |
|
GRAS | Grant fee paid |
Free format text: ORIGINAL CODE: EPIDOSNIGR3 |
|
GRAA | (expected) grant |
Free format text: ORIGINAL CODE: 0009210 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE PATENT HAS BEEN GRANTED |
|
AK | Designated contracting states |
Kind code of ref document: B1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
REG | Reference to a national code |
Ref country code: GB Ref legal event code: FG4D Free format text: NOT ENGLISH |
|
REG | Reference to a national code |
Ref country code: CH Ref legal event code: EP |
|
REG | Reference to a national code |
Ref country code: AT Ref legal event code: REF Ref document number: 1138135 Country of ref document: AT Kind code of ref document: T Effective date: 20190615 |
|
REG | Reference to a national code |
Ref country code: DE Ref legal event code: R096 Ref document number: 602017004197 Country of ref document: DE |
|
REG | Reference to a national code |
Ref country code: IE Ref legal event code: FG4D Free format text: LANGUAGE OF EP DOCUMENT: FRENCH |
|
REG | Reference to a national code |
Ref country code: NL Ref legal event code: MP Effective date: 20190529 |
|
REG | Reference to a national code |
Ref country code: LT Ref legal event code: MG4D |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: HR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: PT Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190930 Ref country code: LT Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: AL Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: FI Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: SE Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: NO Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190829 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: RS Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: GR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190830 Ref country code: BG Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190829 Ref country code: LV Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 |
|
REG | Reference to a national code |
Ref country code: AT Ref legal event code: MK05 Ref document number: 1138135 Country of ref document: AT Kind code of ref document: T Effective date: 20190529 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: AT Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: EE Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: SK Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: DK Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: RO Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: NL Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: CZ Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 |
|
REG | Reference to a national code |
Ref country code: ES Ref legal event code: FG2A Ref document number: 2743527 Country of ref document: ES Kind code of ref document: T3 Effective date: 20200219 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: SM Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 |
|
REG | Reference to a national code |
Ref country code: DE Ref legal event code: R097 Ref document number: 602017004197 Country of ref document: DE |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: TR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 |
|
PLBE | No opposition filed within time limit |
Free format text: ORIGINAL CODE: 0009261 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: NO OPPOSITION FILED WITHIN TIME LIMIT |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: PL Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 |
|
26N | No opposition filed |
Effective date: 20200303 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: SI Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: MC Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: LU Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20190913 Ref country code: IE Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20190913 |
|
REG | Reference to a national code |
Ref country code: BE Ref legal event code: MM Effective date: 20190930 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: BE Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20190930 |
|
REG | Reference to a national code |
Ref country code: CH Ref legal event code: PL |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: CY Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: IS Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190929 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: MT Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 Ref country code: HU Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT; INVALID AB INITIO Effective date: 20170913 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: LI Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20200930 Ref country code: CH Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20200930 |
|
GBPC | Gb: european patent ceased through non-payment of renewal fee |
Effective date: 20210913 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: MK Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20190529 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: GB Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20210913 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: DE Payment date: 20240918 Year of fee payment: 8 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: FR Payment date: 20240925 Year of fee payment: 8 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: IT Payment date: 20240924 Year of fee payment: 8 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: ES Payment date: 20241028 Year of fee payment: 8 |