ANTI-SWAY CRANE CONTROL METHOD WITH A THIRD-ORDER FILTER
20180093868 · 2018-04-05
Inventors
Cpc classification
International classification
Abstract
A method for controlling displacement of a load suspended to a point of attachment of a lifting machine includes an acquisition step during which a piloting setpoint is acquired and which is representative of the displacement speed that the operator wishes to confer on the suspended load, a processing step during which a setpoint called execution setpoint, which is applied to a drive motor in order to displace the suspended load, is elaborated from the piloting setpoint, the processing step including a C.sup.3 smoothing substep by third-order filtering during which a third-order filter is applied to the piloting setpoint in order to generate a filtered piloting setpoint of smoothness class C.sup.3, and the execution setpoint is defined from the filtered piloting setpoint.
Claims
1-14. (canceled)
15. A method for controlling displacement of a load suspended to a point of attachment of a lifting machine, said method comprising a piloting setpoint acquisition step, during which a piloting setpoint (V.sub.u) is acquired and which is representative of a displacement speed (V.sub.load) that the operator of the lifting machine wishes to confer on the suspended load, and a processing step during which an execution setpoint (V.sub.trol), which is intended to be applied to at least one drive motor in order to displace the suspended load (1), is elaborated from said piloting setpoint (V.sub.u), the method being characterized in that the processing step includes a C.sup.3 smoothing substep during which the piloting setpoint (V.sub.u) is processed so as to confer to said piloting setpoint (V.sub.u) properties of third differentiability with respect to time and continuity with respect to time, in order to generate, from said piloting setpoint (V.sub.u), a filtered piloting setpoint (V.sub.f) which is of class C.sup.3, then the execution setpoint (V.sub.trol) is defined from said filtered piloting setpoint (V.sub.f).
16. The method according to claim 15, characterized in that the execution setpoint (V.sub.trol) expresses the speed setpoint that the point of attachment reaches, and is defined as follows:
17. The method according to claim 15, characterized in that, during the C.sup.3 smoothing substep, use is made, to generate the filtered piloting setpoint (V.sub.f), of a parameter (, .sub.0) which is representative of the maximum acceleration (a.sub.MAX) that the drive motor can confer to the point of attachment to which the load is suspended, so that the execution setpoint (V.sub.trol) which results from said filtered piloting setpoint (V.sub.f) depends on said maximum acceleration so as to be achievable by said drive motor.
18. The method according to claim 15, characterized in that, during the C.sup.3 smoothing substep, a third-order filter is applied to the piloting setpoint (V.sub.u) in order to generate the filtered piloting setpoint (V.sub.f) which is of class C.sup.3.
19. The method according to claim 18, characterized in that the processing step comprises a substep of setting a pulsation of the third-order filter, during which the pulsation (, .sub.0) of said third-order filter is calculated from a value (a.sub.MAX) which is representative of the maximum acceleration that the drive motor can confer to the point of attachment to which the load is suspended
20. The method according to claim 18, characterized in that the processing step comprises a substep of setting the pulsation (, .sub.0, .sub.F) of the third-order filter, during which the pulsation (, .sub.0, .sub.F) of the third-order filter is adapted according to the value of the piloting setpoint (V.sub.u) applied by the operator of the lifting machine at the considered time, and more preferably the value of the pulsation (, .sub.0, .sub.F) of the third-order filter is modified depending on whether the piloting setpoint (V.sub.u) is lower or on the contrary higher than a reference speed (V.sub.thresh) which is defined from the maximum speed value (V.sub.MAX) that the drive motor can confer to the point of attachment to which the load is suspended.
21. The method according to claim 18, characterized in that the processing step comprises a substep of setting a pulsation of the third-order filter, during which the pulsation () of the third-order filter is calculated from a calculated pulsation (.sub.0) determined as follows:
V.sub.thresh=k*V.sub.MAX, with 0<k<1; if V.sub.uV.sub.thresh, then define the calculated pulsation (.sub.0) to a high value of
22. The method according to claim 21, characterized in that, during the substep of setting the pulsation of the third-order filter, a second-order filter is applied to the calculated value (, .sub.0), so that the third-order filter uses a filtered calculated pulsation (.sub.F), said filtered calculated pulsation (.sub.F) thus being preferably defined as:
23. The method according to claim 18, characterized in that the processing step comprises a preliminary saturation substep, during which a first saturation law is applied to the piloting setpoint (V.sub.u) and which is calculated according to the pulsation (, .sub.F) of the third-order filter.
24. The method according to claim 23, characterized in that the first saturation law is expressed by:
25. The method according to claim 15, characterized in that the processing step comprises a secondary saturation substep, which is intended to maintain constant or to make the execution setpoint (V.sub.trol) decrease when said execution setpoint substantially reaches the maximum speed (V.sub.MAX) that the drive motor can confer to the point of attachment
26. The method according to claim 25, characterized in that, during the secondary saturation substep, a second saturation law is applied to the piloting setpoint (V.sub.u) and is expressed by:
SAT2(V.sub.u)=MIN(E(t), V.sub.u) if V.sub.trol>0, and
SAT2(V.sub.u)=MAX(E(t), V.sub.u) if V.sub.trol<0, with: V.sub.u the piloting setpoint V.sub.trol the execution setpoint, estimated by:
27. method according claim 15, characterized in that the processing step comprises a substep of saturation of the third derivative of the filtered piloting setpoint during which a third saturation law is applied to the third derivative () of the filtered piloting setpoint (V.sub.f) and whose saturation thresholds depend on the maximum acceleration (a.sub.MAX) that the drive motor (7, 8) can confer to the point of attachment (H) of the suspended load (1).
28. The method according to claim 13, characterized in that the third saturation law is expressed by:
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0037] Other objects, features and advantages of the subject matter described herein will appear in more details upon reading the following description, as well as with reference to the appended drawings, provided only for an illustrative and non-restrictive purpose, among which:
[0038]
[0039]
[0040]
[0041]
[0042]
[0043]
[0044]
DESCRIPTION
[0045] The subject matter described herein concerns a method for controlling the displacement of a load 1 suspended to a point of attachment H of a lifting machine 2.
[0046] The lifting machine 2 is designed so as to be able to displace the point of attachment H, and consequently the suspended load 1, according to a yaw rotation component around a first vertical axis (ZZ), called orientation axis, and/or according to a radial component R, corresponding to a movement called distribution movement, herein in translation along a second axis (DD) called distribution axis secant to said orientation axis (ZZ), as illustrated in
[0047] In particular, the lifting machine 2 may form a tower crane, whose mast 3 embodies the orientation axis (ZZ), and whose jib 4 embodies the distribution axis (DD), as illustrated in
[0048] For the convenience of the description, such a configuration of a tower crane will be considered in the following, and more particularly a configuration of a tower crane with a horizontal jib 4, while understanding that it is perfectly possible to consider applying the principles described herein to other lifting machines, and in particular to mobile cranes or to a luffing boom crane.
[0049] The intersection of the distribution axis (DD) and the orientation axis (ZZ) will be noted O.
[0050] Preferably, the point of attachment H is formed by a trolley 5, which might advantageously be guided in translation along the distribution axis (DD), along the jib 4.
[0051] For convenience, the trolley 5 may be assimilated to the point of attachment H in the following.
[0052] The orientation movement , and, respectively, the distribution movement R, and more particularly the drive movement of the trolley 5 in translation R along the jib 4, may be ensured by any appropriate drive motor 7, 8, preferably electric, and more particularly by at least one (electric) orientation motor 8 and, respectively, one (electric) distribution motor 7.
[0053] The load 1 is suspended to the point of attachment H by a suspension device 6, such as a suspension cable. Hence, for convenience, said suspension device will be assimilated to such a suspension cable 6 in the following.
[0054] Preferably, the suspended load 1 may also be displaced according to a vertical component, called lifting component, so as to be able to vary the height of the suspended load 1 relative to the ground.
[0055] Preferably, it will be possible for this purpose to make the length L of the suspension cable 6 vary, typically by means of a winch driven by a lifting motor (preferably electric), so as to be able to modify the distance of the suspended load 1 to the point of attachment H, and therefore either make the load 1 rise by shortening the length L (by winding the suspension cable 6), or on the contrary make said load 1 descend by extending said length L (by unwinding the suspension cable 6).
[0056] For convenience, it will be possible to refer by a piloting system to the assembly allowing ensuring the moving and the control of the displacement of the suspended load 1, said assembly typically comprising the module(s) (calculators) 10, 12, 13, 14, 15, 16, 17 allowing the implementation of the method according to the embodiments described herein, as well as the drive motor(s) 7, 8 (actuators), and where appropriate the movable members (effectors) of the machine driven by said drive motors 7, 8; said movable members will correspond herein on the one hand to the mast 3 and to the jib 4, yaw-orientable according to the orientation movement 0, and on the other hand to the trolley 5 ensuring the distribution movement R along the jib 4.
[0057] According to an embodiment, the method comprises a piloting setpoint acquisition step (a) during which a setpoint called the piloting setpoint V.sub.u is acquired and which is representative of a displacement speed V.sub.load that the operator of the lifting machine 2 wishes to confer on the suspended load 1.
[0058] Afterwards, the method according to an embodiment comprises a processing step (b) during which a setpoint called the execution setpoint V.sub.trol, which is intended to be applied to at least one drive motor 7, 8 in order to displace the suspended load 1, and, more particularly, in order to displace the trolley 5 to which said load 1 is suspended is elaborated, from said piloting setpoint V.sub.u, herein by means of a processing module 10.
[0059] It will be noted that, advantageously, the method allows performing a servo-control of speed, rather than trajectory, and more particularly a servo-control of the speed of the trolley 5, from a speed setpoint V.sub.u which corresponds to the speed desired for the suspended load 1.
[0060] Hence, in this respect, the execution setpoint V.sub.trol will preferably express the speed setpoint that the point of attachment H must reach (that is to say the speed setpoint that the trolley 5 should reach).
[0061] In other words, the method preferably comprises a step (a) during which the operator (freely) defines and (intentionally) expresses a piloting setpoint in the form of a speed setpoint that he wishes the suspended load 1 to follow, then a processing step (b) during which said piloting setpoint (speed setpoint of the suspended load) is processed, herein more particularly filtered by a third-order filter, so as to be converted into a corresponding speed setpoint of the trolley 5, forming the (speed) execution setpoint V.sub.trol which is applied to the adequate drive motor 7, 8.
[0062] Incidentally, it should be noted that the method provides the operator of the machine with a large freedom of action, since said operator can freely set, at any time, and according to the magnitude he chooses, the piloting setpoint (speed setpoint) V.sub.u that he wishes the load 1 to execute, and this without being for example forced to comply with a predetermined fixed trajectory.
[0063] Moreover, it will be noted that the method according to an embodiment is valid both for the piloting of the orientation movement as well as for the piloting of the distribution movement R, or for the piloting of any simultaneous combination of these two movements.
[0064] From a formal point of view, it will be noticed that it is advantageously possible to locate the position of the movable members, namely the point of attachment H/trolley 5 on the one hand, the suspended load 1 on the other hand, and express the movements of said movable members, either in a Cartesian reference system (O, X, Y, Z) associated to the base (considered to be fixed) of the lifting machine 2, or in a polar-type reference system (O, r, ) using cylindrical, or even spherical, coordinates.
[0065] Conventionally, it is thus possible to note, in said Cartesian reference system:
[0066] P.sub.trol.sup.X and P.sub.trol.sup.Y the positions along X (first horizontal axis), respectively along Y (second horizontal axis, perpendicular to the first horizontal axis X), of the trolley 5 (the index trol referring to the trolley);
[0067] V.sub.trol.sup.X and V.sub.trol.sup.Y the speed components along X, respectively along Y, of said trolley 5;
[0068] P.sub.load.sup.X and P.sub.load.sup.Y the positions along X, respectively along Y, of the suspended load 1 (the index load referring to the suspended load 1);
[0069] V.sub.load.sup.X and V.sub.load.sup.Y the speed components along X, respectively along Y, of said suspended load 1, which correspond to the components of the (desired) speed of the suspended load 1, and therefore, in practice, to the components of the piloting setpoint V.sub.u.
[0070] When using the cylindrical coordinates (r, ), it will be more particularly possible to attach to each considered movable member a Frenet reference frame allowing expressing the radial component V.sup.r (according to the distribution movement R) and the orthoradial component V.sup. (according to the tangent to the orientation movement ) of the speed of the considered movable member, as particular in illustrated in
[0071] Thus, in said
[0072] As illustrated in
[0073] Said control member 11 may be, in particular, in the form of a joystick, or of a set of controllers, which will enable the operator to express the orientation speed setpoint (yaw speed, orthoradial) V.sub.load.sup. and the distribution speed setpoint (radial speed) V.sub.load.sup.r that he wishes to impart to the suspended load 1.
[0074] For convenience of notation, the raw piloting setpoint V.sub.u, as expressed by the operator of the machine at the control member 11, that is to say the signal provided by the joystick at the input of the piloting system, will preferably be referenced as V.sub.JOY in the aforementioned figures.
[0075] In order to better explain the embodiments herein, some elements of theoretical mechanics allowing modeling a pendular system will be now exposed, with reference to
[0076] It should be noted that the explanation given herein in a plane, with reference to one single displacement dimension, according to the X axis, which is considered to be parallel to the jib 4 and to the distribution axis (DD), remains valid in three dimensions.
[0077] According to the fundamental principle of dynamics (Newton's law), and while neglecting the possible external forces such as the wind:
M{right arrow over (a)}.sub.load={right arrow over (T)}+M{right arrow over (g)}
[0078] where
[0079] M represents the mass of the suspended load 1;
[0080] {right arrow over (a)}.sub.load represents the acceleration of the suspended load 1 (which is herein considered to be carried by the horizontal direction X);
[0081] {right arrow over (T)} represents the tension of the suspension cable 6;
[0082] {right arrow over (g)} represents the gravity (the acceleration of gravity).
[0083] The equation hereinabove implies that the vector M{right arrow over (a)}.sub.loadM{right arrow over (g)} is collinear with (parallel to) the vector {right arrow over (T)}. Therefore:
with the angle (angle of the sway) that the suspension cable 6 forms with the vertical Z.
[0084] By making the assumption of small angles, it is also possible to write:
[0085] with
[0086] P.sub.trol the position (herein the X coordinate) of the trolley 5,
[0087] P.sub.load the position (herein the X coordinate) of the load 1, and
[0088] L the length of the suspension cable 6.
[0089] The following relationship is deduced between the position P.sub.trol of the trolley on the one hand, and the position P.sub.load of the suspended load and the speed V.sub.load of the load on the other hand:
[0090] and, by differentiating the expression hereinabove with respect to time, a second-order differential equation is obtained, called the conversion formula, which expresses the speed V.sub.trol of the trolley 5 as a function of the speed V.sub.load of the suspended load 1:
[0091] which may also be expressed by the Laplace transform:
[0092] In practice, using the conversion formula hereinabove, it is therefore possible to calculate the speed setpoint of the trolley V.sub.trol, that is to say concretely the execution setpoint V.sub.trol, from the value of the speed V.sub.load that is desired to be conferred to the suspended load, that is to say from the piloting setpoint V.sub.u.
[0093] Nonetheless, it is also necessary to take into consideration the fact that, in the real piloting system, the trolley 5 has necessarily a finite (bounded) acceleration. This physical condition imposes that, from a mathematical point of view, the acceleration of the trolley, that is to say the time derivative of the speed of the trolley,
must on me one hand exist, and on the other hand be bounded (that is to say supplemented by a finite fixed value).
[0094] However, the calculation of the speed of the trolley (execution setpoint) V.sub.trol according to the conversion formula hereinabove involves the second-time derivative
of the speed of the suspended load (piloting speed) V.sub.load.
[0095] With regards to this conversion formula, the acceleration of the trolley
may therefore be expressed in the form of a function of the third-time derivative
of the speed of the load V.sub.load.
[0096] It follows that the condition of existence and bounding of the acceleration of the trolley {dot over (V)}.sub.trol imposes that the third-time derivative .sub.load of the speed of the load V.sub.load exists and is bounded, that is to say that the speed of the suspended load V.sub.load (and consequently the piloting setpoint V.sub.u which will serve to set said speed of the suspended load) is three times differentiable, and that its third derivative is continuous (and bounded).
[0097] In other words, it should be ensured that the piloting setpoint V.sub.u actually used to calculate (according to the conversion formula hereinabove) the execution setpoint V.sub.trol is of class C.sup.3 (at every time, and at every circumstance), and this even though said piloting setpoint V.sub.u is initially expressed by the operator of the machine, and acquired substantially in real-time, in a raw form V.sub.JOY which is likely to vary in an unpredictable manner over time, if the operator chooses to do so, and which therefore does not necessarily have these C.sup.3 smoothness properties.
[0098] This is particularly why, according to the embodiments described herein, the processing step (b) advantageously includes a C.sup.3 smoothing substep (b4) during which the piloting setpoint V.sub.u is processed so as to confer to said piloting setpoint V.sub.u properties of third differentiability with respect to time and continuity with respect to time, in order to generate, from said piloting setpoint V.sub.u, a filtered piloting setpoint V.sub.f which is of class C.sup.3, then the execution setpoint V.sub.trol is defined from said filtered piloting setpoint V.sub.f.
[0099] According to a possible variant, the C.sup.3 smoothing may be performed using interpolation polynomials.
[0100] According to this variant, the piloting setpoint V.sub.u, and more particularly several ones and even all of the considered values among the succession of the different values taken by the piloting setpoint V.sub.u during a given time interval, are interpolated by means of a polynomial.
[0101] Said polynomial intrinsically has (at least) a C.sup.3 smoothness class, and therefore provides an approximation of the piloting setpoint which is both accurate and of class C.sup.3, in the form of a polynomial-type filtered piloting setpoint V.sub.f.
[0102] Hence, such a polynomial provides a C.sup.3 flattening of the piloting setpoint.
[0103] Nonetheless, according to another particularly preferred variant simpler to implement than the variant by polynomial interpolation, during the C.sup.3 smoothing substep (b4), a third-order filter F3 is applied to the piloting setpoint V.sub.u, so as to C.sup.3 smooth said piloting setpoint, in order to generate the filtered piloting setpoint V.sub.f which is of class C.sup.3.
[0104] In other words, the substep (b4) preferably constitutes a third-order filtering substep during which a third-order filter F3 is applied to the piloting setpoint V.sub.u in order to generate a filtered piloting setpoint V.sub.f which is three times differentiable (and more exactly of smoothness class C.sup.3).
[0105] Preferably, the C.sup.3 smoothing, and more particularly the third-order filtering, is performed by means of a third-order filtering module 12, formed by an electronic or computer calculator.
[0106] The third-order filtering F3 may he expressed in the form of a transfer function:
[0107] with:
[0108] the pulsation of the third-order filter F3;
[0109] c.sub.1, c.sub.2 respectively the first-order and second-order coefficients, used by said third-order filter F3.
[0110] In the time domain, the third-order filter F3 translates into the following differential equation:
[0111] In order to optimize the third-order filter F3, values may be chosen where: c.sub.1=2.15 and c.sub.2=1.75, as shown in
[0112] Indeed, these values allow optimizing the reactivity of the filter F3, by minimizing the response time at 5% (that is to say the time necessary to make the response converge towards a step-type setpoint with an error lower than 5% of the value of said step), while limiting the overshoot.
[0113] It should be noted that, according to an embodiment, it is possible to directly use the filtered piloting setpoint V.sub.f as an execution setpoint V.sub.trol applied to the drive motors 7, 8, that is to say that it is possible to set: V.sub.trol=V.sub.f.
[0114] Indeed, due to the C.sup.3 smoothing, obtained herein by the third-order filtering, the filtered piloting setpoint V.sub.f is intrinsically defined, and more generally flattened, so as to progressively converge towards the piloting setpoint V.sub.u, without ever being too stiff.
[0115] In this manner, said filtered piloting setpoint V.sub.f, C.sup.3 smoothed, is actually achievable, the drive motors 7, 8 being capable of following said filtered piloting setpoint V.sub.f.
[0116] Thus, in the example illustrated in
[0117] Nonetheless, according to another particularly preferred variant, without having determined the filtered piloting setpoint V.sub.f, the execution setpoint may be subsequently defined (and calculated) as follows, by applying the conversion formula mentioned hereinabove:
[0118] with:
[0119] V.sub.f the filtered piloting setpoint (C.sup.3 smoothed), herein coming more preferably from the third-order filter F3,
[0120] L the length of the suspension cable 6 which links the suspended load to the point of attachment, and
[0121] g gravity.
[0122] This conversion formula, simple and rapid to execute, has the advantage of being intrinsically an anti-sway function.
[0123] Thus, using he conversion formula hereinabove is advantageously equivalent to applying to the filtered piloting setpoint V.sub.f an additional (anti-sway) function, which allows producing an execution setpoint V.sub.trol which generates no sways
[0124] Indeed, the conversion formula hereinabove comes from a simplified pendulum model, in which the angle of the sway is considered to be almost zero, that is to say that the suspended load 1 does not (or almost does not) sway relative to the trolley 5.
[0125] Advantageously, this means, in a reciprocal manner, that an execution setpoint V.sub.trol elaborated from this model is such that, if said execution setpoint is actually executed faithfully by the drive motors 7, 8, and therefore by the trolley 5, said execution setpoint V.sub.trol cannot cause a sway by itself.
[0126]
[0127] The conversion of the filtered setpoint V.sub.f into an execution setpoint V.sub.trol may be operated by any appropriate conversion module (calculator) 13, such as an electronic circuit or a computer-programmed module.
[0128] Moreover, it will be noted that the determination of the execution setpoint V.sub.trol according to an embodiment may advantageously be carried out without being necessary to know, and a fortiori without being necessary to measure, the mass M of the suspended load 1, to the extent that this parameter (the mass M of the load 1) does not intervene in the formulas used during the processing step (b), and in particular does not intervene in the definition of the third-order filter F3 or in the aforementioned conversion formula.
[0129] Hence, it is possible to obviate the need for a measurement of the mass M of the suspended load 1 or for a processing of this mass parameter M, which, herein again, allows simplifying the structure of the lifting machine 2, and simplifying and accelerating the execution of the method.
[0130] Advantageously, the anti-sway effects intrinsically provided on the one hand by the C.sup.3 smoothing itself, and on the other hand by the use of a conversion formula which generates no sways, are combined together to offer an optimized servo-control of the movement of the suspended load 1, completely devoid of sway.
[0131] Considering the abilities of the method to generate an execution setpoint which does not cause any sway, it is possible, in a particularly preferred manner, to implement the open-loop servo-control according to the embodiments herein.
[0132] Thus, it is possible in particular to pilot the lifting machine 2, and more particularly the displacements of the trolley 5 (herein typically in orientation and in distribution R), by blindly or autonomously applying the execution setpoint (herein preferably a speed setpoint) V.sub.trol to the drive motor(s) 7, 8, without providing for a servo-control which would aim to subsequently reduce the real sway which would possibly result from the application of this execution setpoint or which would result from external disturbances.
[0133] In particular, it will be thus possible to pilot the lifting machine 2 without having to use a measured or calculated feedback of the angle of the actual (real) sway of the suspended load 1, or a measured or calculated feedback of the angular speed of the actual sway of said suspended load 1 and preferably, without having to use a measured feedback of the actual (real) speed of the displacement of the point of attachment H.
[0134] By using the method according to an embodiment in open-loop, it is therefore possible to advantageously obtain an excellent control of the displacement of the suspended load 1, and more particularly to offer to the operator of the machine excellent possibilities of manual control of the displacement load, by means of a method which combines simplicity and rapidity of execution, while simplifying the structure of the lifting machine 2, and in particular while obviating the need for sensors intended to measure the sway.
[0135] That being so, the method described herein remains nonetheless compatible, in a variant, with a closed-loop servo-control, according to which the execution setpoint V.sub.trol is firstly determined, in particular by making use of the third-order filtering, then said execution setpoint V.sub.trol is subsequently applied to the drive motors 7, 8 while providing for a closed-loop servo-control (as described hereinabove) intended to actively reduce a possible sway, in case where such a sway would nevertheless appear, as being caused by disturbances external to the piloting system, such as wind gusts, for example.
[0136] Advantageously, according to such a variant, the determination of the execution setpoint V.sub.trol according to an embodiment, with a C.sup.3 smoothing on the one hand, and with the use of the anti-sway conversion formula mentioned hereinabove on the other hand, will nonetheless allow generating an execution setpoint (speed setpoint of the trolley) V.sub.trol which is already optimized, and which generates no sways (intrinsically), such that the sway compensation task assigned to the closed-loop of the servo-control will be greatly simplified (since it will consists only in reducing the possible sways caused by the sole disturbances external to the piloting system).
[0137] Moreover, it will be recalled that, by nature, the drive motors 7, 8 have limited (finite) capabilities in terms of speed, acceleration and torque.
[0138] Consequently, the execution setpoint V.sub.trol is compatible with these capabilities, so as to enable the motors 7, 8 to actually execute said execution setpoint V.sub.trol, and thus generate, as a result of the application of said execution setpoint V.sub.trol to said motors 7, 8, sway-free movements of the trolley 5 and of the suspended load 1, which are in accordance with the movements that are expected with regards to said execution setpoint.
[0139] In other words, in one embodiment, it is may be beneficial to generate an execution setpoint V.sub.trol which is achievable, that is to say coherent and compatible with the actual physical capabilities of the drive motors 7, 8, so as not to seek to solicit the piloting system beyond its capabilities, and thus so as to avoid a situation in which an insufficiency of a motor 7, 8 would lead the real movement to differ from the expected ideal movement, and would cause for example the occurrence or the accentuation of a sway.
[0140] In fine, with regards to the criteria of stability, of rapidity of convergence, and of compliance with the physical capabilities of the drive motors 7, 8, it is possible to consider that, generally, the filtered piloting setpoint (filtered speed setpoint) V.sub.f should (simultaneously) address four cumulated constraints: [0141] Constraint no. 1: the filtered speed setpoint V.sub.f(t) must be three times differentiable, and more particularly of class C.sup.3; [0142] Constraint no. 2: the filtered speed setpoint V.sub.f should converge as rapid as possible towards the piloting setpoint V.sub.u (typically in response to a piloting setpoint V.sub.u forming a constant step); [0143] Constraint no. 3: the acceleration of the trolley 5 should never exceed the intrinsic maximum acceleration capability of the corresponding drive motor 7. 8, that is to say that there is in permanence: |{dot over (V)}.sub.trol|a.sub.MAX, namely
where a.sub.MAX is a value representative of the maximum acceleration that the drive motor 7, 8 can confer to the point of attachment H to which the load 1 is suspended (that is to say herein to the trolley 5); [0144] Constraint no. 4: the speed setpoint of the trolley (execution setpoint) V.sub.trol should never exceed the maximum speed that the drive motor 7, 8 can confer to the trolley 5, that is to say that there is in permanence: |V.sub.trol|V.sub.MAX namely:
where V.sub.MAX is a value representative of the maximum speed that the drive motor 7, 8 can confer to the point of attachment H to which the load 1 is suspended (that is to say herein to the trolley 5).
[0145] The C.sup.3 smoothing, and more particularly, the application of the third-order filter F3, allows addressing the constraint no. 1 (a setpoint three times differentiable, and more particularly of class C.sup.3).
[0146] It is possible to address the constraint no. 2 (rapid convergence) by properly choosing the coefficients c1, c2 of said third-order filter F3, as indicated hereinabove, and on the other hand, by adapting the pulsation of said third-order filter F3 depending on the circumstances, as will be detailed hereinafter.
[0147] Finally, it is possible to address the constraints no. 3 (acceleration limit) and no. 4 (speed limit), that is to say to ensure that the execution setpoint (speed setpoint of the trolley) V.sub.trol is achievable, by applying appropriate saturation functions SAT1, SAT2, SAT3, which will be detailed in the following.
[0148] Thus, according to a preferred embodiment, during the C.sup.3 smoothing substep (b4), use may be made, to generate the filtered piloting setpoint V.sub.f, of a parameter which is representative of the maximum acceleration a.sub.MAX that the drive motor 7, 8 can confer to the point of attachment H to which the load 1 is suspended, so that the execution setpoint V.sub.trol which results from said filtered piloting setpoint V.sub.f depends on said maximum acceleration so as to be achievable by said drive motor 7, 8.
[0149] More particularly, said parameter chosen to be representative of the maximum acceleration a.sub.MAX admissible by the drive motor 7, 8 may be the pulsation of the third-order filter F3, in the form of a pulsation called <<calculated pulsation>> .sub.0 which will be determined in particular depending on said value of the maximum admissible acceleration a.sub.MAX.
[0150] A relationship exists between the pulsation and the maximum admissible acceleration.
[0151] The acceleration of the trolley is
[0152] Assuming that a step-type setpoint V.sub.u is applied at a time t=0 (initial time), to a suspended load 1 at rest, that is to say to a system initially at equilibrium.
[0153] The system being initially at equilibrium, it is then possible to consider that the acceleration of the suspended load 1 is initially zero, that is to say that, at the time t=0: {dot over (V)}.sub.f(0)0, because of the inertia whereas the acceleration {dot over (V)}.sub.trol of the trolley 5 is maximum at this same time t=0, and is then
[0154] Hence, the constraint no. 3 (the acceleration limit) imposes:
that is to say:
[0155] Consequently, the processing step (b) may preferably comprise a substep (b1) of setting the pulsation of the third-order filter F3, during which the pulsation , .sub.0 of said third-order filter F3 is calculated from a value a.sub.MAX which is representative of the maximum acceleration that the drive motor 7, 8 can confer to the point of attachment H to which the load 1 is suspended.
[0156] Moreover, and to the extent that the equation hereinabove also involves, as a consequence of the constraint no. 3 (acceleration limit), a relationship between the pulsation and the speed setpoint V.sub.u, the processing step (b) will preferably comprise a substep (b1) of setting the pulsation of the third-order filter F3, during which the pulsation of the third-order filter, and more particularly the calculated pulsation .sub.0, is adapted depending on the value of the piloting setpoint V.sub.u, V.sub.JOY applied by the operator of the lifting machine at the considered time t.
[0157] More preferably, the value of the pulsation of the third-order filter F3 is modified depending on whether the piloting setpoint V.sub.u, V.sub.JOY is lower than or on the contrary higher than a reference speed V.sub.thresh which is defined from the maximum speed value V.sub.MAX that the drive motor 7, 8 can confer to the point of attachment H to which the load 1 is suspended.
[0158] In practice, the pulsation may be varied so as to increase said pulsation and thus use a pulsation considered to be high, called high value .sub.high, and therefore a more reactive filter F3, when the absolute value of the piloting setpoint (that is to say the magnitude of the speed setpoint) V.sub.u, V.sub.JOY is low with regards to the maximum admissible speed V.sub.MAX, and on the contrary by decreasing said pulsation to a lower pulsation, called low value .sub.low, when the absolute value of the piloting setpoint V.sub.u, V.sub.JOY will increase to get close to the maximum admissible speed V.sub.MAX.
[0159] In particular, when the speed setpoint corresponds to the maximum admissible speed: V.sub.U=V.sub.MAX, the constraint no. 3 (the acceleration limit) will actually impose:
[0160] In practice, considering the foregoing, and as illustrated in
[0161] set V.sub.thresh=k*V.sub.MAX, with 0<k<1, for example k=0.5;
[0162] if V.sub.uV.sub.thresh, then define the calculated pulsation .sub.0 as
herein forming a high value;
[0163] if V.sub.u>V.sub.thresh, then define the calculated pulsation .sub.0 as
herein forming a low value, because V.sub.MAX>V.sub.thresh such that .sub.low<.sub.high;
[0164] with:
[0165] V.sub.u the piloting setpoint (herein equal to the raw piloting setpoint V.sub.JOY),
[0166] k a chosen setting factor, comprised between 0 and 1,
[0167] L the length of the suspension cable 6 which links the suspended load 1 to the point of attachment H,
[0168] g gravity (the acceleration of gravity),
[0169] V.sub.MAX an arbitrary (setting) value which is considered to be representative of the maximum speed that the drive motor 7, 8 can confer to the point of attachment H to which the load 1 is suspended; in practice, V.sub.MAX will be arbitrarily chosen according to the characteristics of the lifting machine 2, of the expected load 1, and of the concerned drive motor 7, 8, and may for example be equal to the actual value of the maximum speed that the drive motor 7, 8 is actually capable, according to tests, of conferring to the trolley 5, or, preferably, be equal to a fraction (strictly lower than 100%, but non-zero) of this actual value of the maximum speed;
[0170] a.sub.MAX an arbitrary (setting) value which is considered to be representative of the maximum acceleration that the drive motor 7, 8 can confer to the point of attachment H to which the load 1 is suspended; a.sub.MAX may for example be equal to the actual value of the maximum acceleration of the motor, determined by tests, or, preferably, be equal to a fraction (strictly lower than 100%, but non-zero) of this actual value of the maximum acceleration.
[0171] The dual objective of this adaptation (in real-time) of the pulsation is to optimize the reactivity of the third-order filter F3 (constraint no. 2) by increasing said pulsation whenever possible, because the response time of the filter F3 is inversely proportional to said pulsation (with the coefficients c.sub.1, c.sub.2 chosen as indicated hereinabove, the response time at 5% is in the range of 4/) while complying with the constraint no. 3 relating to the non-exceedance of the maximum acceleration capability of the drive motor 7, 8, which sets an admissible upper limit for said pulsation .
[0172] Incidentally, it should be noted that regardless of the law taken on for determining the pulsation , the use of an adjustable pulsation allows dynamically setting the third-order filter F3, and integrating directly and intrinsically within said filter F3, in a particularly simple manner, a portion of the constraints relating in particular to the physical capabilities in terms of speed and acceleration of the drive motors 7, 8.
[0173] The adjustment of the pulsation of the third-order filter F3 may be achieved by any appropriate pulsation adjustment module 14, forming a calculator comprising for example an electronic circuit or a suitable computer program.
[0174] Moreover, in order to avoid destabilizing the third-order filter F3, in particular during the transitions between the high value .sub.high and the low value .sub.low, the (calculated) pulsation , .sub.0 should be two times differentiable (with respect to time).
[0175] In this respect, it is desirable to smoothen the (calculated) pulsation , .sub.0, in particular in order to guarantee that its evolutions over time, and in particular the aforementioned transitions high value .sub.high/low value .sub.low, are continuous and two times differentiable.
[0176] This is why, according to a preferred embodiment, during the substep (b1) of setting the pulsation of the third-order filter F3, during the determination of the pulsation , and more particularly to the calculated pulsation .sub.0, a second-order filter F2 is applied, so that the third-order filter F3 uses as a pulsation a filtered calculated pulsation .sub.F.
[0177] Said filtered calculated pulsation .sub.F is accordingly preferably defined as:
[0178] with:
[0179] .sub.0 the calculated pulsation (also called target pulsation), obtained as indicated hereinabove, before the second-order filtering F2,
[0180] .sub.X the natural pulsation of the second-order filter F2, for example equal to 4 rad/s,
[0181] m the damping coefficient of the second-order filter F2, preferably equal to 0.7, but not limited thereto (this choice of value allowing obtaining a good compromise between a short response time and a limited overshoot of the second-order filter).
[0182] Moreover, it will be noticed that if the pulsation of the third-order filter F3, and more particularly the filtered pulsation =.sub.F of said third-order filter F3, calculated as described hereinabove, varies continuously (that is to say regularly, without any discontinuity in the mathematical sense of the term) to converge towards the calculated target-pulsation .sub.0, and more particularly varies so as to continuously switches from the high value .sub.high to the low value .sub.low or vice versa, therefore, in absolute terms, some situations may arise in which the inequality
that is to say
which results from the constraint no. 3 (limited acceleration capability) could be temporarily contravened.
[0183] Indeed, assuming for example an initial situation in which the operator of the machine barely solicits or not at all the displacement of the suspended load 1, so that the piloting (speed) setpoint V.sub.u is low, or even zero, such that it is lower than the reference speed: V.sub.u<V.sub.thresh, for example with V.sub.u=0 m/s.
[0184] The pulsation , .sub.F, of the third-order filter F3 is then close to, or even equal to, its high value .sub.high.
[0185] Assuming now that the operator of the machine suddenly applies a speed setpoint V.sub.u with a high magnitude, higher than the reference speed V.sub.thresh, and for example close to the maximum admissible speed: V.sub.u=V.sub.MAX In practice, this amounts to applying to the piloting system a step according to which the operator makes the piloting setpoint V.sub.u switch almost instantaneously from its low, or even zero (typically 0 m/s), initial value to a high value, typically V.sub.MAX.
[0186] Since the setpoint V.sub.u=V.sub.MAX henceforth exceeds the reference speed V.sub.thresh, the automatic setting of the pulsation of the third-order filter, according to substep (b1), redefines the target pulsation value .sub.0, and in this instance, it lowers it so as to set it to the low value: =.sub.low.
[0187] However, because of the second-order filtering F2 which is applied to obtain the filtered pulsation .sub.F, as actually used by the third-order filter F3, the transition of said filtered pulsation .sub.F from its initial high value .sub.high towards its (new) low target-value .sub.0=.sub.low is not instantaneous, but on the contrary relatively progressive, as said transition (in this instance, the decrease) of the pulsation, that is to say the convergence of the filtered pulsation .sub.F towards the low value .sub.low, may be operated slower than the change (herein the increase) of the piloting setpoint V.sub.u, that is to say slower than the convergence of the piloting setpoint V.sub.u towards its high value V.sub.MAX.
[0188] Hence, it will be understood that, during the brief duration which is necessary to adapt the pulsation , .sub.F of the third-order filter F3 to the new piloting setpoint V.sub.u, it is therefore possible to be temporarily in a situation in which a piloting setpoint close to its high value (V.sub.u being substantially equal to V.sub.MAX) and a pulsation , .sub.F also close to its high value .sub.high exist together, as said pulsation is slow to decrease to reach its low value .sub.low.
[0189] In such a case, the acceleration required for the trolley 5 would be provisionally substantially equal to
and might thus temporarily exceed the maximum acceleration capability
of the motor 7, 8, since .sub.high>.sub.low.
[0190] This is particularly why, in order to avoid such a situation, and more particularly in order to guarantee that the inequality (set by the constraint no. 3) is permanently met
the processing step (b) preferably comprises, according to an embodiment, a preliminary saturation substep (b2), during which a first saturation law SAT1 which is calculated according to the pulsation , .sub.F of the third-order filter F3 (that is to say according to the instantaneous value of the pulsation , .sub.F of the third-order filter at the considered time) is applied to the piloting setpoint V.sub.u, V.sub.JOY.
[0191] As illustrated in particular in
[0192] Preferably, the first saturation law SAT1 will be expressed by:
[0193] with
[0194] V.sub.u the piloting setpoint (herein equal to the raw piloting setpoint V.sub.JOY),
[0195] .sub.F the pulsation (and more particularly the filtered pulsation) of the third-order filter F3,
[0196] L the length of the suspension cable 6,
[0197] g gravity, and
[0198] a.sub.MAX a value representative of the maximum acceleration that the drive motor 7, 8 can confer to the point of attachment H to which the load 1 is suspended (said maximum acceleration value being preferably defined as indicated hereinabove).
[0199] Preferably, as illustrated in
[0200] Moreover, in some situations, when the length L of the suspension cable 6 is significant, the execution setpoint V.sub.trol, and therefore the speed of the trolley 5, which is given by the conversion formula
may exceed the maximum admissible speed V.sub.MAX, that is to say contravene the constraint no. 4 (which sets: |V.sub.trol|V.sub.MAX), in particular if the piloting setpoint V.sub.u, and consequently the resulting filtered piloting setpoint V.sub.f, undergoes rapid variations, proximate in time, and having a high magnitude.
[0201] The solution proposed herein limits the execution setpoint V.sub.trol when said execution setpoint reaches a predefined admissible limit (typically +/ V.sub.MAX), by saturating the piloting setpoint V.sub.u in an adequate manner.
[0202] The principle of recalculating the piloting setpoint V.sub.u when the execution setpoint (and therefore the speed of the trolley 5) V.sub.trol reaches the maximum admissible value V.sub.MAX, so that the absolute value of said execution setpoint |V.sub.trol| remains (at the most) constant, or even decreases; in other words, the piloting setpoint V.sub.u is modified in order to cap the execution setpoint V.sub.trol at its maximum admissible value V.sub.MAX.
[0203] This is why the processing step (b) preferably comprises a secondary saturation substep (b3), which is intended to maintain constant or to make the execution setpoint (that is to say the speed setpoint of the point of attachment H) V.sub.trol decrease when said execution setpoint V.sub.trol substantially reaches the maximum speed V.sub.MAX that the drive motor 7, 8 can confer to the point of attachment H (that is to say in practice to the trolley 5).
[0204] Mathematically, if it is desired to maintain the execution setpoint V.sub.trol constant, this amounts to setting {dot over (V)}.sub.trol=0, therefore
and consequently
[0205] Since, by the application of the third-order filter F3, there is:
[0206] the second member of the last equation being noted, for convenience, E(t):
[0207] As indicated hereinabove, it is sought to maintain the execution setpoint V.sub.trol constant or to make it decrease, when it reaches the maximum admissible speed V.sub.max. Furthermore, in practice, if the piloting setpoint V.sub.u is low, this indicates in principle that a low trolley speed is sought, and therefore a low execution setpoint V.sub.trol, that is to say that there is therefore no reason to keep said execution setpoint V.sub.trol constant at its maximum value V.sub.MAX, but rather make it decrease.
[0208] This is why, during the secondary saturation substep (b3), is therefore preferably applied to the piloting setpoint V.sub.u, according to an embodiment, a second saturation law SAT2 which is expressed by:
SAT2(V.sub.u)=MIN(E(t), V.sub.u) if V.sub.trol>0, and
SAT2(V.sub.u)=MAX(E (t), V.sub.u) if V.sub.trol<0,
[0209] with:
[0210] V.sub.u the piloting setpoint (which preferably comes from the first saturation module 15, after having undergone the first saturation law SAT1, as indicated in
[0211] V.sub.trol, the execution setpoint (speed of the trolley), herein estimated by the conversion formula:
[0212] V.sub.f the filtered piloting setpoint coming from the third-order filter F3,
[0213] and
with
[0214] c.sub.1, c.sub.2 respectively the first-order and second-order coefficients, used by the third-order filter F3 (typically, c.sub.1=2.15 and c.sub.2=1.75),
[0215] .sub.F the pulsation (herein more particularly the filtered pulsation) of the third-order filter F3,
[0216] L the length of the suspension cable 6 which links the suspended load 1 to the point of attachment H,
[0217] g gravity.
[0218] As illustrated in particular in
[0219] It will be noted that, for the sake of stability, the activation and the deactivation of this second saturation law SAT2, in the vicinity of the maximum admissible speed V.sub.MAX, may preferably be operated by a hysteresis switching.
[0220] More particularly, the second saturation law SAT2 being initially inactive, it will be activated when the execution setpoint V.sub.trol will reach and exceed a triggering threshold, slightly higher than V.sub.MAX, and for example set to 1.04*V.sub.MAX (which reinforces the interest of choosing V.sub.MAX slightly below the actual physical speed limit of the concerned drive motor 7, 8, typically between 95% and 98% of said physical limit), and be deactivated again when the execution setpoint V.sub.trol will descend below an extinction threshold strictly lower than the triggering threshold, and being for example 1.01*V.sub.MAX.
[0221] Moreover, even though the implementation of the first saturation law SAT1 described hereinabove can generally address the constraint no. 3 (acceleration of the trolley having to remain lower than the maximum admissible acceleration a.sub.MAX), some very particular combinations of piloting setpoints may nevertheless contravene this constraint no. 3.
[0222] However, as indicated hereinabove, the application of an execution setpoint V.sub.trol which would not comply with the physical limits, in particular the acceleration capability, of the drive motors 7, 8, might lead to the execution of a movement which is not compliant with the expected movement, and consequently the occurrence of a sway.
[0223] This is particularly why, in order to secure the movement of the suspended load 1 and to control and the accuracy of said movement, the processing step (b) preferably comprises, according to an embodiment, which may implemented as a complement of the first saturation law SAT1, a substep (b5) of saturation of the third derivative of the filtered piloting setpoint during which is applied to the third (time) derivative of the filtered piloting setpoint V.sub.f a third saturation law SAT3 whose saturation thresholds depend on the maximum acceleration a.sub.MAX (typically as defined hereinabove) that the drive motor 7, 8 can confer to the point of attachment H to which the load 1 is suspended.
[0224] Advantageously, the implementation of this third saturation law SAT3 may add an additional precaution to that provided by the first saturation law SAT1, in order to optimize the safety of the open-loop control according to an embodiment.
[0225] More preferably, the third saturation law SAT3 may be expressed by:
[0226] with:
[0227] V.sub.f the filtered piloting setpoint coming from the third-order filter F3,
[0228] .sub.F the pulsation (herein more particularly the filtered pulsation) of the third-order filter F3,
[0229] c.sub.1, c.sub.2 respectively the first-order and second-order coefficients, used by the third-order filter F3,
[0230] L the length of the suspension cable 6 which links the suspended load 1 to the point of attachment H,
[0231] g gravity, and
[0232] a.sub.MAX a value representative of the maximum acceleration that the drive motor 7, 8 can confer to the point of attachment H to which the load 1 is suspended, said maximum acceleration value being typically defined as described hereinabove.
[0233] As illustrated in particular in
[0234] It will be noted that, advantageously, the reasoning and the equations proposed hereinabove can apply when considering a real situation, in three dimensions.
[0235] Indeed, if the crane is considered in a three-dimensional Cartesian reference system (X, Y, Z), where Z represents the vertical axis, herein coincident with the mast 3, it is still possible to state the Newton's law: M{right arrow over (a)}.sub.load={right arrow over (T)}+M{right arrow over (g)}
[0236] By making the assumption of small angles of sway, there is, in projection respectively on the X axis and on the Y axis:
with a.sub.X, a.sub.Y and a.sub.Z the respective X, Y and Z components of the acceleration of the suspended load 1.
[0237] According to a first possibility of implementation of the method according to an embodiment, it may be possible, in absolute terms, to keep, for the calculation of the execution setpoint V.sub.trol, and more particularly for the calculation of the Cartesian components V.sub.trol.sup.X and V.sub.trol.sup.Y of said execution setpoint, expressions which involve the vertical acceleration a.sub.Z of the suspended load 1, so as to be able to also compensate the potential effects of said vertical acceleration of the suspended load 1 on the sway generation.
[0238] Nonetheless, according to a second preferred possible implementation of the method according to an embodiment, it is possible in practice to consider, as a simplifying assumption, that the acceleration of the suspended load a.sub.Z is negligible with regards to gravity g.
[0239] By simplifying the expressions hereinabove accordingly, it is found that:
[0240] By subsequently differentiating these expressions with respect to time, and while considering, as a realistic simplification, that the speed of variation dL/dt of the length L of the suspension cable 6 is negligible, it may be obtained that:
[0241] Moreover, it should be noted that the method according to the embodiments described herein is particularly versatile because it can apply to any type of lifting machine 2, regardless of the configuration of said lifting machine 2, to the extent that in any case said method advantageously allows calculating the execution setpoint V.sub.trol in a simple manner in a Cartesian reference system, regardless of the coordinate system (Cartesian, cylindrical or spherical), specific to the lifting machine 2, in which the piloting setpoint V.sub.u, V.sub.JOY is firstly expressed when it is set by the operator of the machine, and in which the execution setpoint V.sub.trol must then be expressed so that said execution setpoint could be appropriately applied to the concerned drive motors 7, 8.
[0242] Indeed, all it needs is to firstly convert into Cartesian coordinates, by means of a geometric transformation matrix (such as a rotation matrix), characteristic of the used lifting machine 2, and which will be noted R.sub.a, the components of the piloting setpoint V.sub.u, V.sub.JOY initially expressed in the coordinate system specific to the lifting machine 2, then calculate the execution setpoint V.sub.trol in said Cartesian reference system, and finally convert again, by means of a reverse transformation matrix, that will be noted R.sub., the Cartesian components of said execution setpoint V.sub.trol into components expressed in the coordinate system specific to the lifting machine 2, applicable to the drive motors 7, 8 which respectively generate the displacement of said machine 2 (and more particularly of the trolley 5) according to each of said components. Thus, in the case of a lifting machine 2 formed a crane with a horizontal jib (tower crane with a horizontal jib), the most appropriate coordinate system to said machine 2 will be a cylindrical coordinate system in which the position of the considered object is located by a radius r (along the jib) and an azimuth angle (yaw angle about the orientation axis), as illustrated in
[0243] The piloting of the crane being performed in a very intuitive manner for the operatorin distribution (modification of the radius r) and in orientation (modification of the azimuth ), each of the piloting setpoint V.sub.u, V.sub.JOY, and of the execution setpoint V.sub.trol, will therefore comprise a distribution component, intended to the distribution motor 7 (which allows acting on the radius) and an orientation component, intended to the orientation motor 8 (which allows acting on the azimuth).
[0244] The first conversion (of the piloting setpoint V.sub.u, V.sub.JOY) from the cylindrical system towards the Cartesian system may be operated by means of a rotation matrix R.sub., whereas the second conversion (of the execution setpoint V.sub.trol) from the Cartesian system toward the cylindrical system may be operated by means of a reverse rotation matrix R.sub..
[0245] Similarly, in the case of a lifting machine 2 formed by a luffing boom crane, the most appropriate coordinate system will be the spherical coordinate system, in which the position of the trolley 5 is located (and piloted) by its azimuth (orientation of the luffing boom in yaw), its inclination (orientation of the luffing boom in pitch) and by its radius (distance of the trolley with respect to the hinged base of the luffing boom).
[0246] Herein again, the conversions towards and from the Cartesian system will be operated by appropriate geometric transformation matrices, so as to be able to manage the motor for driving the boom in azimuth (yaw), the motor for driving the boom in inclination (pitch), and the motor for driving in radius (translation along the boom).
[0247] In the case of a lifting machine 2 such as an overhead crane, designed to perform linear movements in translation along an axis (X), or along two axes perpendicular to each other (X and Y), the piloting setpoint may be expressed directly in a Cartesian reference system (X, Y), and will not therefore require any coordinates conversion.
[0248] In practice, and as illustrated in
[0259] Moreover, it will be noted that the cylindrical coordinates of the trolley 5 (point of attachment H) may be known easily (in real-time), for example on the one hand by means of an angular position sensor which informs on the angular yaw angular position of the jib 4 with respect to the mast 3, that is to say the yaw angular position .sub.trol of the trolley 5, and on the other hand by means of a position sensor, for example associated to the distribution drive motor 7, which allows knowing the position of the trolley 5 (in translation) along the jib 4, and consequently the radial distance r.sub.trol at which said trolley 5 is located from the vertical axis of rotation (ZZ).
[0260] Similarly, the length L of the suspension cable 6 may be known in real-time by means of a sensor measuring the absolute rotation of the winch or of the lifting motor which generates the winding of said suspension cable 6.
[0261] Both the yaw angular position .sub.load of the suspended load 1 and the (radial) distance r.sub.load of said suspended load with respect to the vertical gyration axis (ZZ) may be estimated by integration (over time) of the components of the filtered piloting setpoint V.sub.f, since said components herein correspond respectively to the filtered radial speed of the load V.sub.load.sup.rf and to the filtered angular speed of the load V.sub.load.sup.f.
[0262] Thus, more particularly, it is possible to assess an estimated radial position r.sub.load.sub._.sub.estim of the suspended load 1 as: r.sub.load estim(t)=.sub.0.sup.t V.sub.load.sup.rfdt+r.sub.load(0)
[0263] In this respect, it will be noted that, when the lifting machine 2, and more particularly the suspended load 1, is at rest, so that said suspended load 1 lies substantially vertically above the trolley 5, the yaw angular position and the distance to the gyration axis of the suspended load 1 are respectively identical to the yaw angular position and to the distance to the gyration axis of the trolley 5, which are in turn measured as indicated hereinabove.
[0264] Therefore, it is possible to set as an initial condition (and therefore as a calibration parameter) of the aforementioned integral calculation: r.sub.load(0)=r.sub.trol(0), where <<0>> corresponds to an initial time when the system is at rest.
[0265] Where appropriate, in order to improve the accuracy of the estimation of the radial position of the suspended load 1, it is possible to use an observer (observation matrix) involving an additional measurement of the radial position of the trolley 5.
[0266] Moreover, it will be noted that the C.sup.3 smoothing, and more particularly the third-order filtering F3, might be applied to one (single) characteristic movement of the lifting machine 2 (typically the gyration orientation movement or the translational distribution movement in the preferred example illustrated in
[0267] Moreover, the embodiments described herein concern as such the use of a C.sup.3 smoothing, and more particularly the use of a third-order filter F3, and where appropriate, the use of either of the saturation laws SAT1, SAT2, SAT3, in the determination of an execution setpoint V.sub.trol intended to be applied to a drive motor 7, 8 allowing displacing a suspended load 1 to a lifting machine 2, according to either one of the arrangements described in the foregoing.
[0268] In this respect, it will be noted that the embodiments described herein cover as such the implementation of a C.sup.3 smoothing, and more particularly the implementation of the third-order filter F3, respectively of all or part of the saturation laws, regardless of the type of calculation used to subsequently determine the components of the execution setpoint V.sub.trol.
[0269] The embodiments described herein also concern a control box for a lifting machine, comprising either of the modules (that is to say electronic and/or computer calculators) for C.sup.3 smoothing/third-order filtering 12, conversion 13, pulsation adjustment 14, or saturation 15, 16, 17 described hereinabove, as well as a lifting machine 2 equipped with such a control box. The control box may include, for example, a computer processor, a computer readable storage medium and a communication module configured to receive information and transmit information. The computer readable storage medium is configured to store program instructions to be executed by the computer processor, and when executed, cause the processor to carry out the methods described herein. The control box may be operatively connected to the piloting system. For example, the communication module may be configured to receive information, such as information input by user operation of a crane control device, such as a joystick, and may be configured to transmit information, for example, to various crane components. Accordingly, the control box may control operation of crane components in accordance with the methods described herein.
[0270] Finally, the embodiments described herein are of course in no way limited to the sole variants described, those skilled in the art being in particular capable of freely isolating or combining together either of the features described in the foregoing, or substituting them with equivalents.