EP1772588A2 - Articulated ladder or raisable platform with position path control and active vibration damping - Google Patents

Articulated ladder or raisable platform with position path control and active vibration damping Download PDF

Info

Publication number
EP1772588A2
EP1772588A2 EP06119983A EP06119983A EP1772588A2 EP 1772588 A2 EP1772588 A2 EP 1772588A2 EP 06119983 A EP06119983 A EP 06119983A EP 06119983 A EP06119983 A EP 06119983A EP 1772588 A2 EP1772588 A2 EP 1772588A2
Authority
EP
European Patent Office
Prior art keywords
ladder
cage
control
turntable
position path
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
Application number
EP06119983A
Other languages
German (de)
French (fr)
Other versions
EP1772588A3 (en
EP1772588B1 (en
Inventor
Oliver Sawodny
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Iveco Magirus AG
Original Assignee
Iveco Magirus AG
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Iveco Magirus AG filed Critical Iveco Magirus AG
Publication of EP1772588A2 publication Critical patent/EP1772588A2/en
Publication of EP1772588A3 publication Critical patent/EP1772588A3/en
Application granted granted Critical
Publication of EP1772588B1 publication Critical patent/EP1772588B1/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E06DOORS, WINDOWS, SHUTTERS, OR ROLLER BLINDS IN GENERAL; LADDERS
    • E06CLADDERS
    • E06C5/00Ladders characterised by being mounted on undercarriages or vehicles Securing ladders on vehicles
    • E06C5/02Ladders characterised by being mounted on undercarriages or vehicles Securing ladders on vehicles with rigid longitudinal members
    • E06C5/04Ladders characterised by being mounted on undercarriages or vehicles Securing ladders on vehicles with rigid longitudinal members capable of being elevated or extended ; Fastening means during transport, e.g. mechanical, hydraulic
    • E06C5/06Ladders characterised by being mounted on undercarriages or vehicles Securing ladders on vehicles with rigid longitudinal members capable of being elevated or extended ; Fastening means during transport, e.g. mechanical, hydraulic by piston and cylinder, or equivalent means, operated by a pressure medium
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F11/00Lifting devices specially adapted for particular uses not otherwise provided for
    • B66F11/04Lifting devices specially adapted for particular uses not otherwise provided for for movable platforms or cabins, e.g. on vehicles, permitting workmen to place themselves in any desired position for carrying out required operations
    • B66F11/044Working platforms suspended from booms
    • EFIXED CONSTRUCTIONS
    • E06DOORS, WINDOWS, SHUTTERS, OR ROLLER BLINDS IN GENERAL; LADDERS
    • E06CLADDERS
    • E06C5/00Ladders characterised by being mounted on undercarriages or vehicles Securing ladders on vehicles
    • E06C5/32Accessories, e.g. brakes on ladders
    • E06C5/36Safety devices against slipping or falling of ladders; Safety devices against overloading ladders
    • EFIXED CONSTRUCTIONS
    • E06DOORS, WINDOWS, SHUTTERS, OR ROLLER BLINDS IN GENERAL; LADDERS
    • E06CLADDERS
    • E06C5/00Ladders characterised by being mounted on undercarriages or vehicles Securing ladders on vehicles
    • E06C5/32Accessories, e.g. brakes on ladders
    • E06C5/44Other accessories on ladders, e.g. acoustical signalling devices, dismountable switchboards

Definitions

  • German patent specifications DE 100 16 136 C2 and DE 100 16 137 C2 each disclose turntable ladders which are provided with command or control for moving the ladder sections.
  • vibrations of the ladder sections are prevented by feeding back at least one of the measured variables: bending of the ladder in the horizontal and vertical direction, angle of elevation of the ladder, angle of rotation, run-out length and cage mass, via a controller to the control variables for the drives.
  • a pilot control reproduces the idealised motion behaviour of the ladder in a dynamic model, based on differential equations, and calculates idealised control variables for the drives of the ladder sections, in order to enable an essentially vibration-free movement of the ladder.
  • Such turntable ladders are controlled hydraulically or electro-hydraulically by hand levers.
  • the hand lever deflection is directly converted by the hydraulic control circuit into a proportional control signal for the control block designed as a proportional valve.
  • Damping elements in the hydraulic control circuit can be used to make the movements less jerky and smoother in transition.
  • these cannot be satisfactorily adapted to the entire operating range of run-out lengths and angles of elevation.
  • this often leads to highly damped positions with sluggish response behaviour.
  • the electro-hydraulic controls firstly convert the hand lever deflection into an electrical signal which is further processed in a control device with a microprocessor.
  • the signal is damped by ramp functions so that movements of the turntable ladder or working platform are less jerky and smoother.
  • the processed electrical signal is then passed to the hydraulic proportional valve.
  • the slope of the ramp function limits the damping effect and is a measure of the response behaviour.
  • the objective of the invention is to equip a turntable ladder, having an articulated arm, with a position path control which actively damps vibrations which occur (either during movement or in the static position, e.g. through wind effects or loading changes) or guides the cage or working platform on a specified position path.
  • the position path control with active vibration damping is based on the principle of describing the dynamic behaviour of the mechanical and hydraulic systems of the turntable ladder firstly as a dynamic model based on differential equations.
  • a pilot control can be designed which, under the idealised conditions of the dynamic model, generates no vibrations of the ladder unit when moving the axes of the articulated ladder and guides the cage exactly on the specified position path.
  • additional torsional vibrations occur in the case of articulated ladders, which also have to be damped by the rotary actuation.
  • the telescopic axis of the articulated arm has to be taken into account. These additional axes must be considered in the position path planner.
  • the prerequisite for the pilot control is firstly the generation of the position path in the working area which has to be undertaken by the position path planning module.
  • the position path planning module generates the position path which is given to the pilot control in the form of time functions for the cage position, velocity and acceleration, the jerking and, if necessary, the time derivative of the jerking, from the input requirement of the reference velocity proportional to the deflection of the hand lever in the case of semi-automatic operation or target points in the case of fully automatic operation.
  • the system of pilot control and position path planning module is supported by a state controller during strong deviations from the idealised dynamic model (e.g. through disturbance). This feeds back at least one of the measured variables: angle of elevation, run-out length, angle of rotation, articulation angle, bending of the ladder in the horizontal and vertical direction or torsion respectively.
  • Fig. 1 shows the basic mechanical structure of a turntable ladder with articulated arm or the like.
  • the turntable ladder is generally mounted on a vehicle 1.
  • the ladder unit 5 can be tilted with the elevation/inclination axis 7 by the angle ⁇ A and folded with the articulation axis 8 by the angle ⁇ K .
  • the articulated arm can be extended and retracted with the telescopic articulated arm axis 10.
  • the ladder length l can be varied with the run-out/run-in axis 9.
  • the rotation axis 11 allows orientation by the angle ⁇ D about the vertical axis. In the case of a vehicle which is not standing horizontally, an undesirable additional inclination can be compensated with the level axis 13 upon rotation of the ladder unit by tilting the ladder mechanism 15 by the angle ⁇ N .
  • the turntable ladder has a hydraulic drive system 21. It consists of the hydraulic pump 33 driven by the drive motor, the proportional valve 39 and the hydraulic motors 311 and hydraulic cylinders 313.
  • the hydraulic control is generally equipped with systems with auxiliary flow rate control for the hydraulic circuits with load-sensing properties. It is essential in this case that the control voltages u StD , u StA , u StN , u StE u StK , u StT at the proportional valves are converted by the auxiliary flow rate control into proportional flow rates Q FD , Q FA , Q FN , Q FE , Q FK , Q FT in the corresponding hydraulic circuit (Fig. 3).
  • the corresponding vectors for the cage position with reference to the angle of rotation co-ordinate, to the angle of elevation co-ordinate, to the angle of articulation co-ordinate and to the run-out length and their derivatives are calculated from these pre-set variables in the position path planning module 39 or 41 (Fig. 4), as explained in detail below.
  • the function of the position path planning module 39 or 41 is the calculation of the time functions of the reference cage position, of the rotation, elevation, run-out, telescopic and articulation axes and their derivatives which are combined in the vectors ⁇ Dref , ⁇ Aref , l ref,, l Kref,, ⁇ Kref.
  • Each of these vectors comprises at most 4 components up to the 3 rd derivative (position, velocity, acceleration, jerking).
  • the reference position vectors are fed to the axis controllers 43, 45, 47, 49, 411 and 413 which hence calculate the control functions u StD , u StA , u StE , u StT, u StN , u StK for the proportional valves 39 of the hydraulic drive system 21 by evaluating at least one of the sensor values v y , v x , ⁇ x , l, l K , ⁇ A , ⁇ D , ⁇ N ⁇ K .
  • the operator pre-selects the target speeds or the destinations either via the hand lever 35 at the operating panels (semi-automatic operation) or via a target point matrix 37 which has been stored in the computer during a previous turntable ladder run (fully automatic operation).
  • the semi-automatic position path planning module (41) calculates the corresponding time functions of the reference cage position from the hand lever signals for the various directions of movement (rotation, elevation/inclination, run-in/run-out and articulation of the articulated arm) which can be taken as the target velocity for the respective axis.
  • kinematic restrictions especially the maximum velocity for each axis
  • position path planning methods which calculate in advance the entire position path to be followed are not suitable for the present application.
  • the aim of fully automatic operation is to move along a previously travelled position path as quickly as possible (possibly slowly for the purpose of avoiding collisions with obstacles) while maintaining a previously defined maximum allowed deviation.
  • a calculation of the time function by the steepness limiter 53 is adequate for semi-automatic operation.
  • the steepness limiter 53 is supplemented by a positioning loop with a proportional controller (p-controller) with variable limitation 57 (Fig. 5).
  • the difference between the target position and actual corrected reference position is amplified by the p-controller and limited to the maximum allowed velocity ⁇ D max .
  • the output of the additional feedback is then the corresponding target velocity ⁇ Dziel , which in turn forms the input of the steepness limiter 53 of the semi-automatic position path planning module (41).
  • the maximum velocity for each axis can be changed proportionally by a factor, as the limitation is variable as a function of the maximum velocity. This factor can also be use for the synchronisation of the axes and is calculated in the module 'calculation of synchronisation factors' 51.
  • the transfer to the next target point of the respective axis in the target point matrix is dependent upon the remaining distance from the actual position of the ladder to the actual target point and the maximum deviation which can occur if the next target point in the target point matrix is used as actual target position.
  • the actual ladder position is first of all converted into Cartesian co-ordinates in the co-ordinate transformation module 55.
  • the Euclidean distance to the next target point and the distance in the normal direction of a straight line from the actual position of the ladder to the next but one target position are then calculated 59. Switching occurs if both distances lie within a specified limit. The ladder thus remains within a defined corridor while travelling.
  • the time functions for the reference position of the cage in all relevant directions of motion with the mentioned derivatives are thereby available at the output of the semi-automatic position path planner as well as the fully automatic position path planner, taking into account the kinematic restrictions.
  • the output functions of the position path planning module are fed to the corresponding pilot control blocks in the form of reference cage position in the individual directions as well as their derivatives (velocity, acceleration, jerking and derivative of jerking).
  • the functions are amplified in these blocks in such a way that, as a result, position path-true travel of the ladder without vibrations ensues under the idealised assumptions/conditions of the dynamic model.
  • the basis for the determination of the pilot control gains is the dynamic model which will be derived for the individual axes in the following sections. Under these idealised conditions, the vibration of the turntable ladder is thereby eliminated and the cage follows the generated position path.
  • the pilot controls can be supplemented by corresponding state controller blocks.
  • the measured variables for the respective positions as well as for the bending and torsion of the ladder unit (and optionally their derivatives) are amplified in these blocks and fed back again to the servo input
  • the derivatives of the measured variables are generated numerically in the microprocessor control.
  • the turntable ladder or the like is not regarded as a system of large elements.
  • the entire system can be regarded as a system consisting of three point masses.
  • the system elements are thereby approximated by three equivalent masses and the elastic degrees of freedom considered as spring damper elements (see Fig. 6).
  • the method of 2 nd order Lagrange equations one obtains ten mutually independent differential equations with a total of ten degrees of freedom of the system.
  • T is a time delay constant which is determined from measurements on real systems.
  • the components of w D are weighted with the pilot control gains K VD0 to K VD2 and the total fed to the servo input.
  • the pilot control block 71 is supported by a state controller 73, as the dynamic model, as already mentioned, only abstractly reproduces the real relationships and can also react to non-deterministic disturbance (e.g. wind effects, load fluctuations in the cage, etc.) with the aid of the controller.
  • At least one of the quantities to be measured of the state vector (Equ. 28) is weighted with a control gain and fed back to the servo input. There the difference between the output value of the pilot control block 71 and the output value of the state controller block 73 is generated. The following goes into the computation of the pilot control gains in more detail.
  • Equation 35 The individual pilot control coefficients are calculated as follows.
  • the control feedback 73 is configured as state controller.
  • a state controller is characterised in that every state parameter, that is every component of the state vector x D is weighted with a control gain k iD and is fed back to the servo input of the control system.
  • the control gains k iD are combined as the feedback vector K D .
  • the dynamic behaviour of the system is determined by the position of the eigen- values of the system matrix A D , which, at the same time, are poles of the transfer function in the frequency range.
  • the eigen-values of the matrix can be determined as follows by calculating the zeros from the determinants with respect to the variables s of the characteristic polynomials. det ⁇ s ⁇ I ⁇ - A ⁇ D ⁇ 0
  • Equ. 44 and 45 respectively adopt particular zeros through the control gains k iD in order to selectively influence the system dynamics which is reflected in the zeros of this polynomial.
  • the way the poles are located is known from the calculation of the open-loop poles for the subsystem rotation (Equ. 42).
  • Equ. 42 There exists a negative real pole (conditional on the time delay constant of the hydraulics from Equ. 24) and one each of conjugated complex pole pairs conditional upon the bending and torsion.
  • the conjugated complex poles are not addressed individually but through direct access to the real and imaginary parts. In this way one can selectively influence the vibration and damping for torsion and bending of the arm by the adjustment of the controller.
  • the control coefficients are therefore a function of the real and imaginary parts of the pole.
  • the pole positions are to be chosen from Equ. 46 in such a way that the system is stable, the controller works adequately fast with good damping and the limit of the variables is not reached under the typically arising control deviations.
  • the exact values can be established before initial operation via simulation according to these criteria.
  • control gains can now be determined by comparing coefficients of the polynomials Equ. 46 and 44. det ⁇ s ⁇ I ⁇ - A ⁇ D + B ⁇ D ⁇ K ⁇ D ⁇ p D s
  • Equ. 47 there results a set of linear equations to be solved dependent on the control gains k iD .
  • the analysis of this set of equations leads to analytic expressions for the respective control gains dependent upon the desired poles from Equ. 46 and the individual system parameters. If these parameters change, as for example the angle of articulation or the run-out length, then these changes are immediately taken into account by a variation of the individual control parameters. A separate description of the individual control coefficients will be dispensed with here on account of the complexity of the individual expressions.
  • the states ⁇ D , ⁇ x , ⁇ x , v y ,v ⁇ y of the subsystem rotation being considered are either directly or indirectly measured by suitable sensors.
  • the angular velocity is generally measured with corresponding encoders on the swivel joint.
  • strain gauges SG
  • two SGs can be installed right- and left-sided respectively on the lower and upper rails of the ladder in a vertical preferred direction (vertical SG) and horizontal preferred direction (horizontal SG), so that a differential sensitivity results with torsional deflections.
  • the articulated ladder is considered as a discrete multiple body system with three point masses and corresponding spring and damper elements.
  • dynamic effects occur which are not thereby taken into account.
  • higher harmonics occur, for example, which are correspondingly recorded by the sensor elements and thereby coupled in the signal flow of the control feedback.
  • the control behaviour is thus negatively influenced.
  • the measurement signal of the elastic degrees of freedom has an offset. This can lead to a non-damped rotary motion.
  • the processing of measured data can be supplemented by a disturbance observer with the following functions:
  • the angular amplitude of the vibration ⁇ ⁇ x,vy is approximated by a 2 nd order damped differential equation with the parameters resonance frequency ⁇ ⁇ x,vy and damping d ⁇ ⁇ x,vy . It is essential here that the parameters are variable with respect to the system states, such as ladder length, angles of elevation and articulation or load masses. They can, for example, be obtained experimentally or from suitable physical models.
  • ⁇ offset, ⁇ x,vy 0
  • the resonance frequency ⁇ COMP, ⁇ x,vy and the damping d ⁇ embod, ⁇ x,vy are determined experimentally, these being also here generally dependent on the variable system parameters such as ladder length, angles of elevation and articulation and load masses.
  • the resonance frequency and the damping can be determined from a suitable physical model description.
  • the disturbance observer matrix H ⁇ x,vy [ h ⁇ x,vy, 1 , h ⁇ x,vy, 2 , h ⁇ x,vy, 3 , h ⁇ x,vy, 4 , h ⁇ x,vy, 5 ] T is calculated, for example, according to the Riccati design procedure. It is essential here that the variable parameters such as ladder length, angle of elevation and load masses are likewise taken into account in the observer by adapting the observer differential equation and the observer gains. The estimated values for and ⁇ ⁇ x,vy from the disturbance observer can be fed directly to the state controller. In this way the function of vibration damping can be improved significantly.
  • the feedback gain of the state controller 73 during the rotational motion can also be attenuated by means of the proportional attenuator 72. In this way, the control function for the ladder at standstill can be improved if no observer-based elimination has been performed.
  • axis controller for the axis of elevation/ inclination 7 will be explained by using the results from the derivation of the control module for the axis of rotation.
  • Fig. 8 shows the basic structure of the axis controller for the axis of elevation/inclination.
  • the pilot control can optionally be supplemented by a state controller block 93 to compensate for disturbances (e.g. wind effects) and modelling errors (cf. axis of rotation 73).
  • a state controller block 93 to compensate for disturbances (e.g. wind effects) and modelling errors (cf. axis of rotation 73).
  • this block at least one of the quantities to be measured, angle of elevation ⁇ A , angle of articulation ⁇ K , run-out length 1, bending of the ladder in the vertical direction v z or the derivative of the vertical bending v ⁇ z , is amplified and fed back to the servo input.
  • the derivative of the measurements ⁇ A and v ⁇ z is formed numerically in the microprocessor control.
  • the kinematics of the elevation/inclination axis is shown in Fig. 9.
  • the actuation occurs by means of two hydraulic cylinders, whereby the position and speed of the ram are to be taken into account in the model.
  • the bending and torsion signals can also be estimated for the elevation axis from the pressure signals of Equ. 50 via an observer, as for the axis of rotation.
  • Equating Equ. 52 (in the time domain) and 54 and subsequently rearranging the resulting expression for ⁇ A leads, after corresponding collecting of the coefficients, to the following expression.
  • ⁇ ⁇ A K PA A ZylA ⁇ T ⁇ ⁇ ⁇ u StA + - 1 T - ⁇ ⁇ ⁇ ⁇ ⁇ ⁇ A
  • Input variables of the pilot control block 91 are the reference angular velocity ⁇ Aref the reference angular acceleration ⁇ Aref and the reference jerking (and, if necessary, the derivative of the reference jerking).
  • the components of w A are weighted with the pilot control gains K VA 0 to K VA 2 in the pilot control block 91 and their summation fed to the servo input.
  • the pilot control block 91 is supported by a state controller 93, because as already mentioned, the dynamic model only reproduces the real relationships in an abstract way and, with the aid of the controller, non-deterministic disturbances (e.g. wind effects, load fluctuations in the cage, etc.) can also be reacted to.
  • At least one of the measured quantities of the state vector from Equ. 57 is weighted with a control gain and fed back to the servo input.
  • the control feedback 93 is implemented as a state controller.
  • the individual feedback gains are calculated analogue to the rotation axis controller (Equ. 42 - 48).
  • the components of the state vector x A are weighted with the control gains k iA of the control matrix K A and fed back to the servo input control system.
  • the eigen-values of the system can be selectively displaced by feeding back the state variables via the control matrix K A to the control input, as the position of the eigen-values is in turn determined by the analysis of the following determinants: det ⁇ s ⁇ I ⁇ - A ⁇ A + B ⁇ A ⁇ K ⁇ A ⁇ 0
  • the characteristic equation of the controlled system then becomes: s 3 + a 2 k 3 ⁇ A ⁇ k 1 ⁇ A ⁇ s 2 + a 1 ( k 2 ⁇ A , k 1 ⁇ A ) s + a 0 ⁇ 0
  • Equ. 45 (and thus the dynamics of the closed-loop system) can again be influenced by the control gains k iA .
  • the position of the poles is known from the calculation of the open-loop poles. There exists a negative real pole (conditional on the time delay constant of the hydraulics from Equ. 52) and one conjugated complex pole pair conditional upon the vertical bending.
  • the control coefficients are functions of the real and imaginary parts of the conjugated complex pole pair.
  • the pole positions, according to Equ. 70, are to be chosen so that the system is stable, the controller works adequately fast with good damping and the limit of the variables is not reached under the typically arising control deviations.
  • the exact values can be established before initial operation via simulation according to these criteria.
  • control gains can be determined by comparing coefficients of the polynomials analogue to Equ. 47 det ⁇ s ⁇ I ⁇ - A ⁇ A + B ⁇ A ⁇ K ⁇ A ⁇ p A s
  • Equ. 71 Based on Equ. 71, there results a set of linear differential equations to be solved dependent on the control gains k iA , as with the axis of rotation.
  • the analysis of this set of equations produces analytic expressions for the respective control gains dependent upon the desired poles from Equ. 70 and the individual system parameters. If these parameters change, as for example the angle of articulation or the run-out length, then these changes are immediately taken into account by a variation of the individual control parameters.
  • the states ⁇ A ,v z ,v ⁇ z of the subsystem elevation under consideration are measured either directly or indirectly by suitable sensors.
  • the elevation velocity is usually measured on the ladder hinge with corresponding encoders.
  • strain gauges SG
  • the sensor data is further processed in block 95, measurement data processing.
  • v z ′ b ⁇ ⁇ v ⁇ - ( ⁇ vr - ⁇ vl ) / 2 - ⁇ offs ⁇ l A 3 l A - l 0 ⁇ v - - m ers ⁇ g cos ⁇ A c v l A with
  • the parameter ⁇ offs can be determined from a series of measurements with slowly varying ladder run-out length.
  • the resonance frequency ⁇ COMP,vz and the damping d ⁇ EN,vz are determined experimentally , these being also here generally dependent on the variable system parameters such as ladder length, angles of elevation and articulation and load masses.
  • the resonance frequency and the damping can be determined from a suitable physical model.
  • the disturbance signal portions are eliminated from the measurement signal with an estimation procedure supported by an observer.
  • the feedback gain of the state controller 93 during the raising motion can also be attenuated by means of the proportional attenuator 92. In this way, the control function for the ladder at standstill can be improved if no observer-based elimination has been performed.
  • the axis controllers for extending and retracting the ladder 47, to telescope the articulated arm 413, for the level axis 49 and for the articulated arm 411 are provided with conventional cascade control with an external servo loop for the position and an internal one for the speed, as these axes exhibit only a slight tendency to vibration.

Abstract

Turntable ladder or the like, with a telescopic ladder unit and, attached at the end of the ladder unit, an articulated arm which carries a cage, which turntable ladder contains a control for moving the ladder sections, formed in such a way that, during cage travel, vibrations of the ladder sections are suppressed, while at least one of the measured variables, bending of the ladder unit in the horizontal and vertical direction, angle of elevation, angle of rotation, run-out length and torsion of the ladder unit is fed back via a controller to the control variables for the drives and for which a pilot control is provided which represents the idealised movement behaviour of the ladder during cage travel in a dynamic model, based on differential equations and calculates the idealised control variables for the ladder section drives from the dynamic model for an essentially vibration-free movement of the ladder.

Description

    Field of the Invention
  • The invention concerns a turntable ladder or the like, with a telescopic ladder unit and, attached at the end of the ladder unit, an articulated arm which carries a cage.
  • Prior Art
  • Turntable ladders, for example fire brigade ladders or similar devices, such as articulated or telescopic mast platforms and hoist rescue devices, are generally mounted on a vehicle so that they can be rotated or elevated. In the special case of an articulated ladder, an inclinable articulated arm is additionally provided which can, furthermore, with another axis, be telescopic. The control is a position path control which maintains the cage or platform on a specified position path in the working area of the turntable ladder or raisable platform. Vibrations and oscillatory movements of the cage or hoist platform are thereby actively damped.
  • The German patent specifications DE 100 16 136 C2 and DE 100 16 137 C2 each disclose turntable ladders which are provided with command or control for moving the ladder sections. According to DE 100 16 136 C2 , vibrations of the ladder sections are prevented by feeding back at least one of the measured variables: bending of the ladder in the horizontal and vertical direction, angle of elevation of the ladder, angle of rotation, run-out length and cage mass, via a controller to the control variables for the drives. A pilot control reproduces the idealised motion behaviour of the ladder in a dynamic model, based on differential equations, and calculates idealised control variables for the drives of the ladder sections, in order to enable an essentially vibration-free movement of the ladder.
  • Such turntable ladders are controlled hydraulically or electro-hydraulically by hand levers. In the case of a purely hydraulic control, the hand lever deflection is directly converted by the hydraulic control circuit into a proportional control signal for the control block designed as a proportional valve. Damping elements in the hydraulic control circuit can be used to make the movements less jerky and smoother in transition. However, these cannot be satisfactorily adapted to the entire operating range of run-out lengths and angles of elevation. Furthermore, this often leads to highly damped positions with sluggish response behaviour.
  • In the signal flow, the electro-hydraulic controls firstly convert the hand lever deflection into an electrical signal which is further processed in a control device with a microprocessor. Thereby, the signal, according to state of the art, is damped by ramp functions so that movements of the turntable ladder or working platform are less jerky and smoother. The processed electrical signal is then passed to the hydraulic proportional valve. The slope of the ramp function limits the damping effect and is a measure of the response behaviour.
  • Whereas the damping of vibration or oscillatory movements of conventional simple turntable ladders, which carry the cage at the end of their telescopic ladder unit, is satisfactorily possible by means of the control described above, the vibration-free guidance of turntable ladders with an articulated arm at the end of a telescopic ladder unit, which can moreover be telescopic itself, causes significant problems as, in this case, further degrees of freedom and vibration components must be considered. This is beyond the capabilities of known command and control systems, according to the state of the art, so that the entire ladder system can degrade into critical operating states in deployment, which can lead to dangerous situations.
  • Summary of the Invention
  • The objective of the invention is to equip a turntable ladder, having an articulated arm, with a position path control which actively damps vibrations which occur (either during movement or in the static position, e.g. through wind effects or loading changes) or guides the cage or working platform on a specified position path.
  • This objective is achieved according to the invention by means of a turntable ladder having an articulated arm or telescopic arm or the like with a position path control or active vibration damping according to Claim 1.
  • Preferable embodiments of the turntable ladder according to the invention result from the subclaims.
  • The attached claims are considered an integral part of the present description.
  • The position path control with active vibration damping is based on the principle of describing the dynamic behaviour of the mechanical and hydraulic systems of the turntable ladder firstly as a dynamic model based on differential equations.
  • Based on this dynamic model, a pilot control can be designed which, under the idealised conditions of the dynamic model, generates no vibrations of the ladder unit when moving the axes of the articulated ladder and guides the cage exactly on the specified position path. Unlike simple turntable ladders, on account of the retracted articulated arm, additional torsional vibrations occur in the case of articulated ladders, which also have to be damped by the rotary actuation. Furthermore, the telescopic axis of the articulated arm has to be taken into account. These additional axes must be considered in the position path planner.
  • The prerequisite for the pilot control is firstly the generation of the position path in the working area which has to be undertaken by the position path planning module. The position path planning module generates the position path which is given to the pilot control in the form of time functions for the cage position, velocity and acceleration, the jerking and, if necessary, the time derivative of the jerking, from the input requirement of the reference velocity proportional to the deflection of the hand lever in the case of semi-automatic operation or target points in the case of fully automatic operation.
  • As, nevertheless, vibrations or deviations from the reference position path can arise, the system of pilot control and position path planning module is supported by a state controller during strong deviations from the idealised dynamic model (e.g. through disturbance). This feeds back at least one of the measured variables: angle of elevation, run-out length, angle of rotation, articulation angle, bending of the ladder in the horizontal and vertical direction or torsion respectively.
  • Brief Description of the Drawings
  • The invention will be exemplified below with the aid of the drawings, in which:
    • Fig. 1 shows the basic mechanical structure of a turntable ladder by way of example
    • Fig. 2 shows rigid and elastic degrees of freedom of the system
    • Fig. 3 shows interaction of hydraulic control and position path control
    • Fig. 4 shows the entire structure of the position path control
    • Fig. 5 shows the semi-automatic and fully automatic operation of the position path planning module
    • Fig. 6 shows modelling as a system with equivalent masses and spring damper elements
    • Fig. 7 shows the structure of the axis controller for the axis of rotation
    • Fig. 8 shows the axis controller for the axis of elevation/inclination
    • Fig. 9 shows kinematics for the axis of elevation.
    Detailed Description of the Invention
  • Fig. 1 shows the basic mechanical structure of a turntable ladder with articulated arm or the like. The turntable ladder is generally mounted on a vehicle 1. To position the cage 3 in the working area, the ladder unit 5 can be tilted with the elevation/inclination axis 7 by the angle ϕA and folded with the articulation axis 8 by the angle ϕK. The articulated arm can be extended and retracted with the telescopic articulated arm axis 10. The ladder length l can be varied with the run-out/run-in axis 9. The rotation axis 11 allows orientation by the angle ϕD about the vertical axis. In the case of a vehicle which is not standing horizontally, an undesirable additional inclination can be compensated with the level axis 13 upon rotation of the ladder unit by tilting the ladder mechanism 15 by the angle ϕN.
  • Fig. 2 shows once more separately the rigid and elastic degrees of freedom of the system relevant for the derivation of the dynamic model. The rigid degrees of freedom ϕA, ϕK, ϕD,l,lK correspond to the 5 main ladder axes (without level axis). The elastic degrees of freedom are the horizontal and vertical bending vx,vy, as well as the torsion of the ladder unit αx and the horizontal and vertical bending wx,wy as well as the torsion βx of the articulated arm.
  • Generally, the turntable ladder has a hydraulic drive system 21. It consists of the hydraulic pump 33 driven by the drive motor, the proportional valve 39 and the hydraulic motors 311 and hydraulic cylinders 313. The hydraulic control is generally equipped with systems with auxiliary flow rate control for the hydraulic circuits with load-sensing properties. It is essential in this case that the control voltages uStD, uStA, uStN, uStE uStK, uStT at the proportional valves are converted by the auxiliary flow rate control into proportional flow rates QFD, QFA, QFN, QFE, QFK, QFT in the corresponding hydraulic circuit (Fig. 3).
  • It is essential that the time functions for the control voltages of the proportional valves are no longer derived directly from the hand levers, for example by ramp functions, but are calculated in the position path control 31 in such a way that no vibrations occur when the ladder is moved and the cage follows the desired position path in the working area.
  • The basis for this is a dynamic model of the turntable ladder system with the aid of which this object is achieved based on the sensor data of at least one of the variables vy, vz, αx, l, ϕA, ϕD, ϕN, ϕK, lK and the command inputs Ziel = [ϕ̇DZiel,ϕ̇AZiel,ϕ̇KZiel,iZiel,iKZiel ] T for semi-automatic operation from hand lever 35 or q Ziel = [ϕDZielAZielKZiel,lZiel,lKZiel ] T for fully automatic operation from the target position matrix 37. ϕAZiel is thereby the target angle co-ordinate in the direction of the elevation/inclination axis 7 for the centre of the cage. ϕDZiel corresponds to the target angle co-ordinate for the axis of rotation 11 and φKZiel the target angle co-ordinate for the articulation axis 8. lZiel is the target position for the telescopic articulated arm axis 10, lZiel is the target position for the run-out/run-in axis 9 for the centre of the cage. The components for the target velocity vector are to be understood analogue to the components for the target position vector explained above. The corresponding vectors for the cage position with reference to the angle of rotation co-ordinate, to the angle of elevation co-ordinate, to the angle of articulation co-ordinate and to the run-out length and their derivatives are calculated from these pre-set variables in the position path planning module 39 or 41 (Fig. 4), as explained in detail below.
  • Firstly, the entire structure (Fig. 4) of the position path control 31 will be explained below.
  • The function of the position path planning module 39 or 41 is the calculation of the time functions of the reference cage position, of the rotation, elevation, run-out, telescopic and articulation axes and their derivatives which are combined in the vectors ϕ Dref, ϕ Aref, l ref,, l Kref,, ϕ Kref. Each of these vectors comprises at most 4 components up to the 3rd derivative (position, velocity, acceleration, jerking). The reference position vectors are fed to the axis controllers 43, 45, 47, 49, 411 and 413 which hence calculate the control functions uStD, uStA, uStE, uStT, uStN, uStK for the proportional valves 39 of the hydraulic drive system 21 by evaluating at least one of the sensor values vy, vx, αx, l, lK, ϕA, ϕD, ϕN ϕK.
  • The operator pre-selects the target speeds or the destinations either via the hand lever 35 at the operating panels (semi-automatic operation) or via a target point matrix 37 which has been stored in the computer during a previous turntable ladder run (fully automatic operation). By taking into account the kinematic restrictions (maximum velocity and maximum acceleration), the semi-automatic position path planning module (41) calculates the corresponding time functions of the reference cage position from the hand lever signals for the various directions of movement (rotation, elevation/inclination, run-in/run-out and articulation of the articulated arm) which can be taken as the target velocity for the respective axis. As the kinematic restrictions (especially the maximum velocity for each axis) are not constant, but can vary, for example depending on the run-out length or the mass in the cage, position path planning methods which calculate in advance the entire position path to be followed are not suitable for the present application. The aim of fully automatic operation is to move along a previously travelled position path as quickly as possible (possibly slowly for the purpose of avoiding collisions with obstacles) while maintaining a previously defined maximum allowed deviation. A calculation of the time function by the steepness limiter 53 is adequate for semi-automatic operation. For fully automatic operation, the steepness limiter 53 is supplemented by a positioning loop with a proportional controller (p-controller) with variable limitation 57 (Fig. 5).
  • The difference between the target position and actual corrected reference position is amplified by the p-controller and limited to the maximum allowed velocity ϕ̇ Dmax. The output of the additional feedback is then the corresponding target velocity ϕ̇Dziel, which in turn forms the input of the steepness limiter 53 of the semi-automatic position path planning module (41). In order to allow for altered kinematic limitations, the maximum velocity for each axis can be changed proportionally by a factor, as the limitation is variable as a function of the maximum velocity. This factor can also be use for the synchronisation of the axes and is calculated in the module 'calculation of synchronisation factors' 51.
  • The calculation of the axis synchronisation is carried out taking into account the distance to the next target point in the target point matrix. The axis requiring the longest time to reach the next target point limits the movement. This means that the proportional factor for the axis which has to cover the longest position path to the next target point is equal to 1. The corresponding target velocity is thus equal to the maximum velocity. Moreover, the velocities of the other axes reduce proportionally.
  • The transfer to the next target point of the respective axis in the target point matrix is dependent upon the remaining distance from the actual position of the ladder to the actual target point and the maximum deviation which can occur if the next target point in the target point matrix is used as actual target position. For this the actual ladder position is first of all converted into Cartesian co-ordinates in the co-ordinate transformation module 55. As prerequisite for subsequent switching/changing to the next target point, the Euclidean distance to the next target point and the distance in the normal direction of a straight line from the actual position of the ladder to the next but one target position are then calculated 59. Switching occurs if both distances lie within a specified limit. The ladder thus remains within a defined corridor while travelling.
  • The time functions for the reference position of the cage in all relevant directions of motion with the mentioned derivatives are thereby available at the output of the semi-automatic position path planner as well as the fully automatic position path planner, taking into account the kinematic restrictions.
  • The time functions are fed to the respective axis controllers, whose structure is described below.
  • The output functions of the position path planning module are fed to the corresponding pilot control blocks in the form of reference cage position in the individual directions as well as their derivatives (velocity, acceleration, jerking and derivative of jerking). The functions are amplified in these blocks in such a way that, as a result, position path-true travel of the ladder without vibrations ensues under the idealised assumptions/conditions of the dynamic model. The basis for the determination of the pilot control gains is the dynamic model which will be derived for the individual axes in the following sections. Under these idealised conditions, the vibration of the turntable ladder is thereby eliminated and the cage follows the generated position path.
  • As, however, disturbance such as wind effects can affect the turntable ladder and the idealised model can only partially reproduce the existing dynamic circumstances, the pilot controls can be supplemented by corresponding state controller blocks. The measured variables for the respective positions as well as for the bending and torsion of the ladder unit (and optionally their derivatives) are amplified in these blocks and fed back again to the servo input The derivatives of the measured variables are generated numerically in the microprocessor control.
  • The derivation of the dynamic model, which is the basis for the calculation of the pilot control gains and the state controller, should now serve to explain the procedure in detail.
  • The model is derived as a multiple body system with springs and damper elements via the Lagrange formalism. A turntable ladder or the like is considered exemplary as multiple axis manipulator with three rotational as well as one linear degrees of freedom. In addition to these rigid degrees of freedom, the movements of the elastic degrees of freedom in the articulated arm and ladder unit (bending in the longitudinal and transverse direction as well as torsion about the longitudinal axis) are taken into account in the model. In summary, the rigid degrees of freedom listed as follows result for the creation of the model (Fig. 6):
    • ϕA : Angle of elevation
    • ϕD : Angle of rotation
    • ϕK : Articulation angle
    • lA : Length of ladder unit
    as well as the following elastic degrees of freedom (Fig. 6):
    • αx : Torsion of the ladder unit
    • vy : Bending of the ladder unit in the horizontal direction
    • vz : Bending of the ladder unit in the vertical direction
    • βx : Torsion of the articulated arm
    • wy : Bending of the articulated arm in the horizontal direction
    • wz : Bending of the articulated arm in the vertical direction
  • In the creation of the model, the turntable ladder or the like is not regarded as a system of large elements. By calculating the equivalent masses and equivalent moments of inertia, the entire system can be regarded as a system consisting of three point masses. The system elements are thereby approximated by three equivalent masses and the elastic degrees of freedom considered as spring damper elements (see Fig. 6). By the method of 2nd order Lagrange equations, one obtains ten mutually independent differential equations with a total of ten degrees of freedom of the system. Represented in matrix form, this results in: M ̲ q ̲ ¨ + D ̲ q ̲ ˙ + C ̲ q ̲ ˙ q ̲ + K ̲ q ̲ + G ̲ q ̲ = F ̲
    Figure imgb0001
    • M: Mass matrix
    • D: Damping matrix
    • C: Coriolis and centripetal vector
    • K: Stiffness vector
    • G: Gravitation vector
    • F: Vector of external forces
  • The generalised forces F on the right-hand side of the equation of motion are the moments or forces applied by the hydraulic drives. The equation of motion (Equ. 11) is simplified in the following way. The displacement of the centres of gravity of the part bodies results exclusively from movements in the rigid co-ordinates, whereby the displacements in bending and torsion in the elements of the mass matrix can be set to zero. The elastic degrees of freedom belonging to the articulated arm can be neglected owing to the high bending and torsion stiffness of the articulated arm. These two assumptions result in a reduction in the dimensions of the system from ten to seven degrees of freedom. The elements of the individual equations of motion of Equ. 10 can be determined by using symbolic methods available in commercial computer algebra systems. The simplified structure of the mass matrix of the equations of motion (Equ. 10) results in:
    Figure imgb0002
  • Two groups of differential equations can be extracted from Equ. 11, each of which can be summarised in a subsystem. The rows marked by a single dashed line show the subsystem rotation and the rows marked by a dotted line show the subsystem elevation/inclination. With the implemented simplification one obtains the following structure for the other matrices of the equation of motion:
    • Damping matrix: D ̲ q ˙ ̲ = d 11 0 0 0 0 0 0 0 d 22 0 0 0 0 0 0 0 d 33 0 0 0 0 0 0 0 d 44 0 0 0 0 0 0 0 d 55 0 0 0 0 0 0 0 d 66 0 0 0 0 0 0 0 d 77 φ ˙ D φ ˙ A φ ˙ S l ˙ A α ˙ x v ˙ y v ˙ z
      Figure imgb0003
    • Coriolis and Centripetal vector: C ̲ q ˙ ̲ q ̲ = c 11 c 12 c 13 0 c 15 0 0 c 21 c 22 c 23 0 c 25 0 0 c 31 c 32 c 33 0 c 35 0 0 c 41 c 42 c 43 0 0 0 0 c 51 c 52 c 53 0 c 55 0 0 c 61 0 c 63 0 c 65 0 0 c 71 m 72 c 73 0 c 75 0 0 [ φ ˙ D φ ˙ A φ ˙ S l ˙ A α ˙ x v ˙ y v ˙ z ] + 0 z 12 z 13 0 z 15 0 0 z 21 0 z 23 0 z 25 0 0 z 31 z 32 0 0 z 35 0 0 z 41 z 42 z 43 0 0 0 0 z 51 z 52 z 53 0 0 0 0 z 61 0 z 63 0 z 65 0 0 z 71 z 72 z 73 0 z 75 0 0 φ ˙ D 2 φ ˙ A 2 φ ˙ S 2 l ˙ A 2 α ˙ x 2 v ˙ y 2 v ˙ z 2
      Figure imgb0004
    • Stiffness matrix: K ̲ q ̲ = 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 k 55 = ^ c αx 0 0 0 0 0 0 0 k 66 = ^ c vy 0 0 0 0 0 0 0 k 77 = ^ c vz φ D φ A φ S l A α x v y v z
      Figure imgb0005

      (The elements of the stiffness matrix depend heavily on the run-out length of the ladder. A function which reflects this dependence is calculated from simulations.)
    • Gravitation vector: G ̲ q ̲ = [ 0 g 21 g 31 g 41 0 0 0 ]
      Figure imgb0006
  • In the following, the equations of motion of subsystems, necessary for the setting up of the state-space model and the computation of the following control unit, are specified. The elements of the equations of motion listed in the following are in part quite extensive so that a detailed description will be dispensed with here. It is only mentioned here that the elements of the following equations of motion are generally non-linearly dependent on various system variables such as, for example, the equivalent masses, moments of inertia, the various angles of the rotational degree of freedom etc.
  • Subsystem rotation:
    • Equation of motion for ϕD : m 11 φ ¨ D + m 15 α ¨ x + m 16 v ¨ y + c 11 φ ˙ D + c 13 α ˙ x + d 11 φ ˙ D = M D
      Figure imgb0007
    • Equation of motion for αx : m 51 φ ¨ D + m 55 α ¨ x + m 56 v ¨ y + k 55 α x + c 51 φ ˙ D + c 53 φ ˙ S + d 55 α ˙ x = 0
      Figure imgb0008
    • Equation of motion for vY : m 61 φ ¨ D + m 65 α ¨ x + m 66 v ¨ y + k 66 v y + c 61 φ ˙ D + c 63 φ ˙ S + d 66 v ˙ y = 0
      Figure imgb0009
  • Subsystem elevation/inclination:
    • Equation of motion for ϕA : m 22 φ ¨ A + m 23 φ ¨ S + m 24 l ¨ A + m 27 v ¨ z + g 21 + c 21 φ ˙ D + c 22 φ ˙ A + z 21 φ ˙ D 2 + z 23 φ ˙ S 2 + z 25 α ˙ x 2 + d 22 φ ˙ A = M A
      Figure imgb0010
    • Equation of motion for ϕK : m 32 φ ¨ A + m 33 φ ¨ S + m 34 l ¨ A + m 37 v ¨ z + g 31 + c 31 φ ˙ D + c 32 φ ˙ A + z 31 φ ˙ D 2 + z 32 φ ˙ A 2 + z 35 α ˙ x 2 + d 33 φ ˙ S = M K
      Figure imgb0011
    • Equation of motion for lA : m 42 φ ¨ A + m 43 φ ¨ S + m 44 l ¨ A + g 41 + c 41 φ ˙ D + c 42 φ ˙ A + z 41 φ ˙ D 2 + z 42 φ ˙ A 2 + z 43 φ ˙ S 2 + d 44 l ˙ A = M lA
      Figure imgb0012
    • Equation of motion for vz : m 72 φ ¨ A + m 73 φ ¨ S + m 77 v ¨ z + g 71 + c 71 φ ˙ D + c 72 φ ˙ A + z 71 φ ˙ D 2 + z 72 φ ˙ A 2 + z 73 φ ˙ S 2 + z 75 α ˙ x 2 + d 77 v ˙ z + k 77 v z = 0
      Figure imgb0013
  • In the following, the state-space model for the subsystem rotation will firstly be derived which then forms the basis for the design of the controller and pilot control.
  • The drive torque MD, from Equ. 16, supplied by a corresponding hydraulic motor, can be described by the following equations: M D = i D V D 2 π Δ p D Δ p ˙ D = 1 V D β Q FD - i D V D 2 π φ ˙ D Q FD = K PD u StD
    Figure imgb0014

    Whereby
  • MD
    denotes drive torque
    ΔpD
    denotes pressure difference
    ϕ̇D
    denotes angular velocity
    QFD
    denotes hydraulic oil flow rate
    uStD
    denotes control voltage servo valve without backlash
    iD
    denotes transmission ratio
    VD
    denotes displacement volume of hydraulic motor
    β
    denotes hydraulic oil compressibility
    KPD
    denotes proportionality factor
  • The equations 10 to 23 can also be used to estimate the bending signals from the pressure signals of the hydraulic drives by designing an observer.
  • For the state-space representation of the system and the subsequent controller computation, the following simplification can be applied for the hydraulic drive units, taking into account the auxiliary flow rate control: Q FD = K PD 1 + sT u StD
    Figure imgb0015
  • T is a time delay constant which is determined from measurements on real systems. By assuming ΔṗD = 0 (steady state) the following relationship is obtained: 0 = 1 V D β Q FD - i D V D 2 π φ ˙ D Umstellen Q FD = i D V D 2 π φ ˙ D
    Figure imgb0016
  • If equations 24 and 25 are equated and the resulting expression is correspondingly rearranged with respect to ϕ̈ D , the following expression results: φ ¨ D = K PD 2 π i D V D T u StD - 1 T φ ˙ D
    Figure imgb0017
  • A further simplification consists of neglecting the Coriolis and centripetal terms in the equations 16 to 18 on account of their small effect. By applying the simplifications described, the representation of the equations of motion for the subsystem rotation in state-space form is as follows: x ̲ ˙ D = A ̲ D x ̲ D + B ̲ D u ̲ D y ̲ D = C ̲ D x ̲ D
    Figure imgb0018

    with: State vector x ̲ D = [ φ ˙ D α x α ˙ x v y v ˙ y ]
    Figure imgb0019
    Control value : u D = u StD
    Figure imgb0020
    Output value : y D = φ ˙ D
    Figure imgb0021
  • With the form of state vector chosen in Equ. 28, one firstly obtains the relationship 1 0 0 0 0 m 51 0 m 55 0 m 56 0 1 0 0 0 m 61 0 m 65 0 m 66 0 0 0 1 0 H ̲ x ˙ D ̲ = - 1 T 0 0 0 0 0 - k 55 - d 55 0 0 0 0 1 0 0 0 0 0 - k 66 - d 66 0 0 0 0 1 x D ̲ + K PD 2 π i D V D T 0 0 0 0 u D ̲
    Figure imgb0022
  • The system and input matrices AD and BD result from multiplication of the matrix equation 31 with the inverse of H. The composition is only shown schematically here, on account of the complexity of the individual elements: A D ̲ = a 11 0 0 0 0 0 0 1 0 0 a 31 a 32 a 33 a 34 a 35 0 0 0 0 1 a 51 a 52 a 53 a 54 a 55 B D ̲ = b 1 0 b 3 0 b 5
    Figure imgb0023
  • From Equ. 30 the output vector C D produces: C D ̲ = 1 0 0 0 0
    Figure imgb0024
  • The dynamic model of the axis of rotation is interpreted as a changeable parameter system with respect to run-out length l, angle of elevation ϕ A and articulation angle ϕK. The derived state equations are the basis for the pilot control 71 and state controller 73 described in the following design (Fig. 7). Input variables of the pilot control block 71 are the reference angular velocity ϕ̇ Dref, the reference angular acceleration ϕ̈ Dref and the reference jerking
    Figure imgb0025
    (if necessary also the derivative of the reference jerking). The command variable w D is thus w ̲ D = φ ˙ Dref φ ¨ Dref φ Dref
    Figure imgb0026
  • The components of w D are weighted with the pilot control gains KVD0 to KVD2 and the total fed to the servo input. The pilot control block 71 is supported by a state controller 73, as the dynamic model, as already mentioned, only abstractly reproduces the real relationships and can also react to non-deterministic disturbance (e.g. wind effects, load fluctuations in the cage, etc.) with the aid of the controller. At least one of the quantities to be measured of the state vector (Equ. 28) is weighted with a control gain and fed back to the servo input. There the difference between the output value of the pilot control block 71 and the output value of the state controller block 73 is generated. The following goes into the computation of the pilot control gains in more detail. If the state controller is available, as is always assumed in the following, this must be taken into account in the computation of the pilot control gains. (Without state controller the feedback in Equ. 34 would no longer apply and only the system matrix AD taken into account in the relationship above. The procedure then continues in the same way.)
  • The state-space representation from Equ. 27 is expanded, taking into account pilot control and controller feedback, to: x ̲ ˙ D = A ̲ D - B ̲ D K ̲ D x ̲ D + B ̲ D S ̲ D w ̲ D y ̲ D = C ̲ D x ̲ D
    Figure imgb0027

    with the pilot control matrix: S D = K VD 0 K VD 1 K VD 2
    Figure imgb0028

    and the pilot control gains K VD0 to K VD2 (to be calculated). After analysis of Equ. 35, the output voltage of the pilot control block is given by: u DVorst = K VD 0 ϕ ˙ Dref + K VD 1 ϕ ¨ Dref + K VD 2 ϕ Dref
    Figure imgb0029
  • The individual pilot control coefficients are calculated as follows. The Laplace transformation of Equ. 35 leads to the following result: x ̲ D = s I ̲ - A ̲ D + B ̲ D K ̲ D - 1 B ̲ D S ̲ D w D s w D s 2 w D = s I ̲ - A ̲ D + B ̲ D K ̲ D - 1 B ̲ D S ̲ D 1 s s 2 w D s y ̲ D s = C ̲ D s I ̲ - A ̲ D + B ̲ D K ̲ D - 1 B ̲ D S ̲ D G D s 1 s s 2 w D s
    Figure imgb0030
  • From this results the control transfer function given below (the output value yD (s) corresponds to the rotational velocity from Equ. 30): y D s w D s = b 0 + b 1 s + b n - 2 s n - 2 N s K VD 0 + K VD 1 s + K VD 2 s 2 G ˜ D s
    Figure imgb0031
  • The output value thus follows the command variable exactly if D (s) 1 is valid. In this case one obtains an ideal system performance with respect to the rotational velocity, the acceleration and the jerking. Although these requirements cannot be met fully, a favourable performance can be achieved, if the following conditions are fulfilled: G ˜ D s = ! 1 = ! b ˜ 0 K VDi + b ˜ 1 K VDi s + b ˜ 2 K VDi s 2 + a 0 + a 1 s + a 2 s 2 + a 0 = b ˜ 0 K VDi a 1 = b ˜ 1 K VDi a 2 = b ˜ 2 K VDi :
    Figure imgb0032
  • The set of linear equations above can be solved analytically for the unknown pilot control gains K VD0 to K VD2 . The representation of the transfer function D (s) from Equ. 39 is dispensed with here, owing to the complexity of the entire system.
  • The pilot control gains are available henceforth dependent on the elements of the mass matrix, the damping matrix, the stiffness matrix and further model parameters. The corresponding matrix elements are in turn dependent on further characteristics, such as the angle of elevation, the articulation angle, the run-out length etc. If these parameters change, then the pilot control gains also change automatically, so that the vibration damping behaviour of the pilot control is maintained while moving the cage. Moreover, a dependency of the pilot control coefficients upon the control gains k 1D to k 5D can be identified in the pilot control gains. Their derivation is explained in the following section of the description of the invention.
  • The control feedback 73 is configured as state controller. A state controller is characterised in that every state parameter, that is every component of the state vector x D is weighted with a control gain kiD and is fed back to the servo input of the control system.
  • The control gains kiD are combined as the feedback vector K D.
  • According to "Unbehauen, Regelungstechnik 2, a. a. O.", the dynamic behaviour of the system is determined by the position of the eigen- values of the system matrix A D , which, at the same time, are poles of the transfer function in the frequency range. The eigen-values of the matrix can be determined as follows by calculating the zeros from the determinants with respect to the variables s of the characteristic polynomials. det s I ̲ - A ̲ D 0
    Figure imgb0033
  • I is the unit matrix. In the case of the chosen state-space model from Equ. 32, the analysis of Equ. 42 leads to a fifth order polynomial with the general form: s 5 + a 4 s 4 + a 3 s 3 + a 2 s 2 + a 1 s + a 0 0
    Figure imgb0034
  • These eigen-values can be selectively displaced by feeding back the state variables via the control matrix K D to the control input, as the position of the eigen-values is now determined by the analysis of the following determinants: det s I ̲ - A ̲ D + B ̲ D K ̲ D 0
    Figure imgb0035
  • The analysis of Equ. 44 leads again to a fifth order polynomial which is now, however, dependent on the control gains kiD (i=1..5). In the case of the model from Equ. 32, Equ. 43 becomes s 5 + a 4 k 5 D k 3 D k 1 D s 4 + a 3 ( k 5 D , k 4 D , k 3 D , k 2 D , k 1 D ) s 3 + a 2 ( k 5 D , k 4 D , k 3 D , k 2 D , k 1 D ) s 2 + a 1 ( k 4 D , , k 1 D , k 1 D ) s + a 0 k 1 D 0
    Figure imgb0036
  • It is now required that the Equ. 44 and 45 respectively adopt particular zeros through the control gains kiD in order to selectively influence the system dynamics which is reflected in the zeros of this polynomial. The way the poles are located is known from the calculation of the open-loop poles for the subsystem rotation (Equ. 42). There exists a negative real pole (conditional on the time delay constant of the hydraulics from Equ. 24) and one each of conjugated complex pole pairs conditional upon the bending and torsion. With this a priori knowledge, the following structure of the pole specifying polynomial results: p D s = s - p h ( s - p α , r + i p α , im ) ( s - p α , r - i p α , im ) ( s - p v y , r + i p v y , im ) ( s - p v y , r - i p v y , im )
    Figure imgb0037
  • ph
    Hydraulic pole
    pα,r
    Real part torsion pole
    pα,im
    Imaginary part torsion pole
    pvy,r
    Real part bending pole
    pvy,im
    Imaginary part bending pole
  • In this connection, the conjugated complex poles are not addressed individually but through direct access to the real and imaginary parts. In this way one can selectively influence the vibration and damping for torsion and bending of the arm by the adjustment of the controller. The control coefficients are therefore a function of the real and imaginary parts of the pole.
  • The pole positions are to be chosen from Equ. 46 in such a way that the system is stable, the controller works adequately fast with good damping and the limit of the variables is not reached under the typically arising control deviations. The exact values can be established before initial operation via simulation according to these criteria.
  • The control gains can now be determined by comparing coefficients of the polynomials Equ. 46 and 44. det s I ̲ - A ̲ D + B ̲ D K ̲ D p D s
    Figure imgb0038
  • Based on Equ. 47, there results a set of linear equations to be solved dependent on the control gains kiD. The analysis of this set of equations leads to analytic expressions for the respective control gains dependent upon the desired poles from Equ. 46 and the individual system parameters. If these parameters change, as for example the angle of articulation or the run-out length, then these changes are immediately taken into account by a variation of the individual control parameters. A separate description of the individual control coefficients will be dispensed with here on account of the complexity of the individual expressions.
  • With feedback of φ̇Dx,α̇x,vy,v̇y , the output of the state controller block 73 is then u Drück = k 1 D ϕ ˙ D + k 2 D α x + k 3 D α ˙ x + k 4 D v y + k 5 D v ˙ y
    Figure imgb0039
  • Taking into account the pilot control 71, the reference control voltage of the proportional valve for the axis of rotation is then u Dref = u Dvorst - u Drück
    Figure imgb0040
  • The states φ̇Dx ,α̇x,vy,v̇y of the subsystem rotation being considered are either directly or indirectly measured by suitable sensors. The angular velocity is generally measured with corresponding encoders on the swivel joint. If strain gauges (SG) are used as measurement pick-up sensors for the elastic degrees of freedom, it follows to locate these in corresponding positions on the ladder unit. For example, two SGs can be installed right- and left-sided respectively on the lower and upper rails of the ladder in a vertical preferred direction (vertical SG) and horizontal preferred direction (horizontal SG), so that a differential sensitivity results with torsional deflections. Thus horizontal bending motions as well as torsional motions are measured coupled by means of this installation of the SGs. The signals are decoupled according to the invention by means of a measurement data signal conditioner 75, so that the feedback law (48) can be achieved. It is thereby assumed that the difference signal of the vertical SG is a suitable measure of the torsional angle.
  • Static tests for the torsion and bending can be drawn upon to calibrate the SG signals. From this results α x = k t ( ε vr - ε vl ) l A 3 l A - l 0 v
    Figure imgb0041

    with
  • εv -
    Strain at SG position (vertical SG)
    l0v -
    SG position (distance from the fixing point in the x direction)
    kt -
    proportionality factor
  • The horizontal bending essentially has an effect on the difference signal of the horizontal SG. As mentioned, it is also influenced by the torsion of the ladder. Assuming ε hr - ε hl = l A - l 0 h l A 3 v y k h + l A - l 0 h l A 3 α x k th
    Figure imgb0042

    one obtains v y = k h ( ε hr - ε hl ) l A 3 l A - l 0 h - k h α x k th
    Figure imgb0043

    with
  • εh -
    Strain at SG position (horizontal SG)
    l0h -
    SG position (distance from the fixing point in the x direction)
    kh -
    proportionality factor
    kth -
    proportionality factor
  • This can be summarised as the solution to a set of linear equations v y α x = l A - l 0 h l A 3 k h l A - l 0 h l A 3 k th 0 l A - l 0 v l A 3 k t - 1 ε hr - ε hl ε vr - ε vl
    Figure imgb0044
  • The corresponding time derivatives of the decoupled bending states can be implemented with the aid of suitable real differentiator modules.
  • In the context of the calculation for active vibration damping, the articulated ladder is considered as a discrete multiple body system with three point masses and corresponding spring and damper elements. In practice, dynamic effects occur which are not thereby taken into account. As there exists a system with locally distributed parameters, higher harmonics occur, for example, which are correspondingly recorded by the sensor elements and thereby coupled in the signal flow of the control feedback. The control behaviour is thus negatively influenced. On the other hand, it can happen that the measurement signal of the elastic degrees of freedom has an offset. This can lead to a non-damped rotary motion. In order to solve this problem, the processing of measured data can be supplemented by a disturbance observer with the following functions:
    1. 1.) Correction of offsets on the measured signal inherent in the measuring principle.
    2. 2.) Elimination of frequency content on the measuring signal, caused by ladder higher harmonics.
  • As a result, for the signal processing, one disturbance observer is used for the torsional vibrations and the horizontal bending vibrations respectively. The vibration differential equation which describes the progression of the vibrations to be actively damped is represented as follows: φ ¨ α x , vy = - w α x , vy 2 φ α x , vy - 2 d α x , vy w α x , vy φ ˙ α x , vy
    Figure imgb0045
  • The angular amplitude of the vibration ϕαx,vy is approximated by a 2nd order damped differential equation with the parameters resonance frequency ω̅αx,vy and damping αx,vy. It is essential here that the parameters are variable with respect to the system states, such as ladder length, angles of elevation and articulation or load masses. They can, for example, be obtained experimentally or from suitable physical models.
  • The angular offset error ϕ̇offset,αx,vy is assumed to be constant in part. φ ¨ offset , α x , vy = 0
    Figure imgb0046
  • In order to eliminate the ladder higher harmonics from the measurement signal, the resonance frequency ω̅ober,αx,vy and the damping ober,αx,vy are determined experimentally, these being also here generally dependent on the variable system parameters such as ladder length, angles of elevation and articulation and load masses. Alternatively, the resonance frequency and the damping can be determined from a suitable physical model description. The corresponding vibration differential equation of the harmonic is: φ ¨ ober , α x , vy = - w ober , α x , vy 2 φ ober , α x , vy - 2 d ober , α x , vy w ober , α x , vy φ ˙ ober , α x , vy
    Figure imgb0047
  • The state-space representation from the previous sub-models shows: x ˙ ̲ α x , vy = A ̲ α x , vy x ̲ α x , vy + B ̲ α x , vy u ̲ α x , vy y m α x , vy = C ̲ α x , vy x ̲ α x , vy
    Figure imgb0048

    whereby the following matrices and vectors are adopted: State vector : x ̲ α x , vy = [ φ α x , vy φ ˙ α x , vy φ Ober α x , vy φ Ober αjx , vy φ ˙ Ober α x , vy ] Input matrix : B ̲ α x , vy = [ 0 1 0 0 0 ]
    Figure imgb0049
    System matrix : A ̲ α x , vy = 0 1 0 0 0 - w α x , vy - 2 d α x , vy w α x , vy 0 0 0 0 0 0 0 0 0 0 0 0 1 0 0 0 - w Ober α x , vy - 2 d Ober α x , vy w Ober α x , vy output matrix : C ̲ α x , vy = 1 0 1 1 0
    Figure imgb0050
  • According to the invention, the disturbance signal portions are eliminated from the measurement signal with an estimation procedure supported by an observer. A complete observer is derived in the case at hand. The observer equation for the modified state-space model is thus: x ̲ ˙ ^ α x , vy = A ̲ α x , vy - H ̲ α x , vy C ̲ α x , vy x ̲ α x , vy + B ̲ α x , vy u ̲ α x , vy + H ̲ α x , vy y ̲ m α x , vy
    Figure imgb0051
  • The disturbance observer matrix H αx,vy = [h αx,vy,1,h αx,vy,2,h αx,vy,3,h αx,vy,4,h αx,vy,5] T is calculated, for example, according to the Riccati design procedure. It is essential here that the variable parameters such as ladder length, angle of elevation and load masses are likewise taken into account in the observer by adapting the observer differential equation and the observer gains. The estimated values for
    Figure imgb0052
    and ϕ̂αx,vy from the disturbance observer can be fed directly to the state controller. In this way the function of vibration damping can be improved significantly.
  • As an alternative to the observer-based elimination of higher harmonics, the feedback gain of the state controller 73 during the rotational motion can also be attenuated by means of the proportional attenuator 72. In this way, the control function for the ladder at standstill can be improved if no observer-based elimination has been performed.
  • The individual components of the axis controller for the axis of rotation are thereby explained. As a result, the combination of position path planning module and rotation axis controller fulfils the requirement for a vibration-free and position path-accurate movement with the axis of rotation.
  • In the following, the axis controller for the axis of elevation/ inclination 7 will be explained by using the results from the derivation of the control module for the axis of rotation. Fig. 8 shows the basic structure of the axis controller for the axis of elevation/inclination.
  • The output functions of the position path planning module, in the form of the reference cage velocity in the direction of the axis of elevation/inclination as well as its derivatives (acceleration, jerking and, if necessary, derivative of the jerking) are given to the pilot control block 91 (corresponds to block 71 for the axis of rotation). These functions are amplified in the pilot control block in such a way that there results a position path-accurate steering of the ladder without vibrations under the idealised conditions of the dynamic model. The basis for the determination of the pilot control gains is the dynamic model which will be derived in the following sections for the axis of elevation/inclination. In this way, under idealised conditions, the vibration of the ladder is suppressed and the cage follows the generated position path.
  • As with the axis of rotation, the pilot control can optionally be supplemented by a state controller block 93 to compensate for disturbances (e.g. wind effects) and modelling errors (cf. axis of rotation 73). In this block at least one of the quantities to be measured, angle of elevation ϕA, angle of articulation ϕK, run-out length 1, bending of the ladder in the vertical direction vz or the derivative of the vertical bending z, is amplified and fed back to the servo input. The derivative of the measurements ϕA and z is formed numerically in the microprocessor control.
  • The value for the servo input formed from the pilot control uAvorst and the optional state controller output uArück is then fed to the proportional valve for the cylinder of the axis of elevation/inclination of the hydraulic circuit.
  • The derivation of the dynamic model for the elevation axis which is the basis for the calculation of the pilot control gains and the state controller will now be exemplified.
  • The kinematics of the elevation/inclination axis is shown in Fig. 9. The actuation occurs by means of two hydraulic cylinders, whereby the position and speed of the ram are to be taken into account in the model. The actuation moment MA from Equ. 19 can be described by the following equations: M A = F ZylA d bA cos φ PA F ZylA = p ZylA A ZylA p ˙ ZylA = 2 β V ZylA Q FA - A ZylA z ˙ ZylA Q FA = K PA u StA z ZylA = d aA 2 + d bA 2 - 2 d aA d bA cos φ A + φ 0 A z ˙ ZylA = d aA d bA sin φ A + φ 0 A z ZylA φ ˙ A cos φ PA = d aA sin φ A + φ 0 A z ZylA
    Figure imgb0053

    whereby
  • MA
    denotes actuation moment
    ϕPA
    denotes projection angle
    PZylA
    denotes pressure in hydraulic cylinder
    AZylA
    denotes effective cross-sectional area
    ϕ̇A
    denotes angular velocity elevation/inclination
    ZZylA
    denotes position of the ram
    QFA
    denotes volume flow of hydraulic oil
    uStA
    denotes activation voltage of servo valve
    uStA,min
    denotes minimum activation voltage of servo valve
    StA
    denotes working activation voltage
    VZylA
    denotes volume of hydraulic cylinder (each cylinder)
    β̇
    denotes compressibility of hydraulic oil
    KPA
    denotes proportionality factor
    daA
    denotes distance pivot point to attachment point of hydraulic cylinder on ladder gear unit
    dbA
    denotes distance pivot point to attachment point of hydraulic cylinder on ladder unit
    ϕ0A
    denotes angle, see Fig. 9
  • The bending and torsion signals can also be estimated for the elevation axis from the pressure signals of Equ. 50 via an observer, as for the axis of rotation.
  • By neglecting the Coriolis and centripetal terms, as well as the angular acceleration of the articulated arm ϕ̈ K, Equ. 22 serves as starting point for the compilation of the state-space model and consequently is presented as follows. m 72 φ ¨ A + m 77 v ¨ z + g 71 + d 77 v ˙ z + k 77 v z = 0
    Figure imgb0054
  • The relationship shown in Equ. 50, for the calculation of pressure changes in the hydraulic cylinder ZylA, is taken as the basis for the following calculations. A first-order lag element is chosen as computational model for the determination by approximation of the variable QFA contained in the equation. Consequently, the dynamic aspects of a auxiliary flow rate control are taken into account in a simple approach. This simplification describes sufficiently accurately the correlation between the activation voltage and the volume flow of the hydraulic oil. Q FA = K PA 1 + sT u StA
    Figure imgb0055
  • Putting ZylA = 0 (steady state), the following relationship is obtained from Equ. 50: 0 = 1 V ZylA β Q FA - A ZylA z ˙ ZylA Umstellen Q FA = A ZylA z ˙ ZylA
    Figure imgb0056
  • By using the relationship between ram speed and speed of elevation from Equ. 50, the dependence of the volume flow on the speed of elevation results: z ˙ ZylA = d aA d bA sin φ A + φ 0 A z Zyl , A Ψ φ A φ ˙ A Einsetzen Q FA = A ZylA Ψ φ A φ ˙ A
    Figure imgb0057
  • Equating Equ. 52 (in the time domain) and 54 and subsequently rearranging the resulting expression for ϕ̈ A, leads, after corresponding collecting of the coefficients, to the following expression. φ ¨ A = K PA A ZylA T Ψ u StA + - 1 T - Ψ ˙ Ψ φ ˙ A
    Figure imgb0058
  • By using the derived relationship, the following representation of the equations of motion for the subsystem elevation/inclination in state-space form is produced: x ˙ ̲ A = A ̲ A x ̲ A + B ̲ A u ̲ A y ̲ A = C ̲ A x ̲ A
    Figure imgb0059

    with: State vector : x ̲ A = φ ˙ A v z v ˙ z
    Figure imgb0060
    Control variable : u A = u StA
    Figure imgb0061
    Output variable : y A = Ψ φ ˙ A
    Figure imgb0062
  • With the form of the state vector chosen in Equ. 57, one initially obtains the relationship 1 0 0 m 72 0 m 77 0 1 0 H ̲ x ̲ ˙ A = [ - 1 T - Ψ ˙ Ψ 0 0 0 - k 77 - d 77 0 0 1 ] x ̲ A + K PA A ZylA T Ψ 0 0 u ̲ A
    Figure imgb0063
  • The system and input matrices AA and BA are obtained by matrix multiplication of the inverses of H in Equ. 60. [ A ̲ A = - Ψ + Ψ ˙ T Ψ T 0 0 0 0 1 m 72 Ψ + Ψ ˙ T m 77 Ψ T - k 77 m 77 - d 77 m 77 B ̲ A = [ K PA A ZylA T Ψ 0 - m 72 K PA m 77 A ZylA Ψ T ]
    Figure imgb0064
  • As the hydraulic cylinder ram speed is to be taken as output variable, the output vector C A, from Equ. 59, becomes: C ̲ A = Ψ 0 0
    Figure imgb0065
  • The dynamic model of the elevation/inclination axis is understood as a variable parameter system with respect to the run-out length l, the trigonometric function component of the angle of elevation ϕA and of the angle of articulation ϕK. The Equ. 56 - 62 form the basis for the design of the pilot control 91 and state controller 93, to be described now.
  • Input variables of the pilot control block 91 are the reference angular velocity ϕ̇Aref the reference angular acceleration ϕ̈ Aref and the reference jerking
    Figure imgb0066
    (and, if necessary, the derivative of the reference jerking). The command variable vector w A is thus w ̲ A = φ ˙ Aref φ ¨ Aref φ Aref
    Figure imgb0067
  • The components of w A are weighted with the pilot control gains K VA0 to K VA2 in the pilot control block 91 and their summation fed to the servo input. The pilot control block 91 is supported by a state controller 93, because as already mentioned, the dynamic model only reproduces the real relationships in an abstract way and, with the aid of the controller, non-deterministic disturbances (e.g. wind effects, load fluctuations in the cage, etc.) can also be reacted to. At least one of the measured quantities of the state vector from Equ. 57 is weighted with a control gain and fed back to the servo input. There, again, the difference between the output value of the pilot control block 91 and the output value of the state controller 93 is formed, analogue to the structure of the axis controller for the sub-system rotation. The existence of the state controller block, which should be assumed in the following, has to be taken account in the computation of the pilot control gains. (Without the state controller, the arrangement implemented in the derivation of the rotation axis controller is valid).
  • Taking into account the pilot control and the control feedback, the state controller from Equ. 56 expands to: x ̲ ˙ A = A ̲ A - B ̲ A K ̲ A x ̲ A + B ̲ A S ̲ A w ̲ A y ̲ A = C ̲ A x ̲ A
    Figure imgb0068

    with the pilot control matrix: S A = K VA 0 K VA 1 K VA 2
    Figure imgb0069

    and the pilot control gains K VD0 to K VD2, to be calculated. After evaluating Equ. 65, the output voltage of the pilot control block 91 is given by: u AVorst = K VA 0 ϕ ˙ Aref + K VA 1 ϕ ¨ Aref + K VA 2 ϕ Aref
    Figure imgb0070
  • The calculation of the individual pilot control coefficients is carried out in the same way as described in Equ. 38 - 40 for the rotation axis controller.
  • The pilot control gains are, in turn, available depending on the elements of the mass matrix, the damping matrix, the stiffness matrix and further model parameters. The corresponding matrix elements are dependent on further characteristics, such as the angle of elevation, the articulation angle, the run-out length etc. If these parameters change, then the pilot control gains also change automatically, so that the vibration damping behaviour of the pilot control is maintained while moving the cage. Furthermore, in the pilot control gains for elevation, a dependency of the pilot control coefficients upon the control gains k 1A to k 3A can be identified, as already in the rotation axis controller.
  • The derivation of these feedback coefficients is explained in the following section of the description of the invention.
  • The control feedback 93 is implemented as a state controller. The individual feedback gains are calculated analogue to the rotation axis controller (Equ. 42 - 48). The components of the state vector x A are weighted with the control gains kiA of the control matrix K A and fed back to the servo input control system.
  • The eigen-values of the system can be selectively displaced by feeding back the state variables via the control matrix K A to the control input, as the position of the eigen-values is in turn determined by the analysis of the following determinants: det s I ̲ - A ̲ A + B ̲ A K ̲ A 0
    Figure imgb0071
  • The analysis of Equ. 68 leads to a 3rd order polynomial which is again dependent on the control gains kiA (i=1..3). The characteristic equation of the controlled system then becomes: s 3 + a 2 k 3 A k 1 A s 2 + a 1 ( k 2 A , k 1 A ) s + a 0 0
    Figure imgb0072
  • The zeros of Equ. 45 (and thus the dynamics of the closed-loop system) can again be influenced by the control gains kiA . The position of the poles is known from the calculation of the open-loop poles. There exists a negative real pole (conditional on the time delay constant of the hydraulics from Equ. 52) and one conjugated complex pole pair conditional upon the vertical bending. With this a priori knowledge, the following structure of the pole specifying polynomial results: p A s = s - p h ( s - p v z , r + i p v z , im ) ( s - p v z , r - i p v z , im )
    Figure imgb0073
  • ph
    Hydraulic pole
    pvz,r
    Real part bending pole
    pvz,im
    Imaginary part bending pole
  • Access to the conjugated complex pole pair again takes place in direct manner on the real and imaginary parts. In this way one can selectively influence the vibration and damping for the vertical bending of the arm by adjustment of the controller. As with the rotational axis controller, the control coefficients are functions of the real and imaginary parts of the conjugated complex pole pair.
  • The pole positions, according to Equ. 70, are to be chosen so that the system is stable, the controller works adequately fast with good damping and the limit of the variables is not reached under the typically arising control deviations. The exact values can be established before initial operation via simulation according to these criteria.
  • As with the axis of rotation, the control gains can be determined by comparing coefficients of the polynomials analogue to Equ. 47 det s I ̲ - A ̲ A + B ̲ A K ̲ A p A s
    Figure imgb0074
  • Based on Equ. 71, there results a set of linear differential equations to be solved dependent on the control gains kiA, as with the axis of rotation. The analysis of this set of equations produces analytic expressions for the respective control gains dependent upon the desired poles from Equ. 70 and the individual system parameters. If these parameters change, as for example the angle of articulation or the run-out length, then these changes are immediately taken into account by a variation of the individual control parameters.
  • With feedback of ϕ̇A,vz,v̇z, the output of the state controller block 93 is then u Arück = k 1 A φ ˙ A + k 2 A v z + k 3 A v ˙ z
    Figure imgb0075
  • Taking into account the pilot control 91, the reference control voltage of the proportional valve for the axis of elevation/inclination is then u Aref = u Avorst - u Arück
    Figure imgb0076
  • The states ϕ̇A,vz,v̇z of the subsystem elevation under consideration are measured either directly or indirectly by suitable sensors. The elevation velocity is usually measured on the ladder hinge with corresponding encoders. If strain gauges (SG) are used as measurement pick-up sensors for the elastic degrees of freedom, it follows to locate these in corresponding positions on the ladder unit. The sensor data is further processed in block 95, measurement data processing. For example, two SGs can be installed right- and left-sided respectively on the lower and upper rails of the ladder in a vertical preferred direction (vertical SG). From this results v z = b ε v - ( ε vr - ε vl ) / 2 l A 3 l A - l 0 v
    Figure imgb0077

    with
  • εv -
    Strain at SG position
    l0v -
    SG position (distance from the fixing point in the x direction)
    bεv -
    proportionality factor
  • Only the dynamic signal portions of the bending are relevant for the control. Steady-state signal portions come about through the gravitational force of the ladder and through possibly existing offset portions of the SG signal and must be filtered out reliably. For compensation, a high pass filter can be used in combination with an upstream gravitational compensation. v z = b ε v - ( ε vr - ε vl ) / 2 - ε offs l A 3 l A - l 0 v - - m ers g cos φ A c v l A
    Figure imgb0078

    with
    • v'z - vertical displacement at reference point articulated joint after gravitational compensation
    • εoffs -SG-Offset (εoffs = -69.65µm/m)
  • The parameter εoffs can be determined from a series of measurements with slowly varying ladder run-out length.
  • The corresponding time derivatives of the decoupled bending states can be implemented with the aid of suitable real differentiator modules.
  • As there exists a system with locally distributed parameters, higher harmonics also occur in the subsystem elevation. These are correspondingly recorded by the sensor elements and coupled in the signal flow of the control feedback. The control behaviour is thus negatively influenced. On the other hand, it can happen that the measurement signal of the vertical bending has an offset, or the gravitational compensation does not present a sufficiently robust performance. This can lead to a non-damped raising motion. In order to solve this problem, the processing of measured data can be supplemented by a disturbance observer with the following functions:
    1. 1. Correction of offsets on the measured signal owing to gravity and inherent in the measuring principle.
    2. 2. Elimination of frequency content on the measuring signal, caused by ladder higher harmonics.
  • The vibration differential equation which describes the progression of vibrations of the vertical vibrations to be actively damped, is represented, analogue to Equ. 49e for the axis of rotation, as a damped vibration with an experimentally determined resonant frequency ω̅vz, dependent on angle of elevation, run-out length and articulation angle, and damping vz : φ ¨ vz = - w vz 2 φ vz - 2 d vz w vz φ ˙ vz
    Figure imgb0079
  • The angular offset error is assumed to be constant in part. φ ¨ offset , vz = 0
    Figure imgb0080
  • In order to eliminate the ladder higher harmonics from the measurement signal, the resonance frequency ω̅ober,vz and the damping ober,vz are determined experimentally , these being also here generally dependent on the variable system parameters such as ladder length, angles of elevation and articulation and load masses. Alternatively, the resonance frequency and the damping can be determined from a suitable physical model. φ ¨ ober , vz = - w ober , vz 2 φ ober , vz - 2 d ober , vz w ober , vz φ ˙ ober , vz
    Figure imgb0081
  • With the state-space representation: x ˙ ̲ vz = A ̲ vz x ̲ vz + B ̲ vz u ̲ vz y m vz = C ̲ vz x ̲ vz
    Figure imgb0082
    State vector : x ̲ vz = [ φ vz φ ˙ vz φ Offset vz φ Ober vz φ ˙ Ober vz ] Input matrix : B ̲ vz = [ 0 1 0 0 0 ] System matrix : A ̲ vz = [ 0 1 0 0 0 - w vz - 2 d vz w vz 0 0 0 0 0 0 0 0 0 0 0 0 1 0 0 0 - w Ober vz - 2 d Ober vz w Ober vz ] output matrix : C ̲ vz = [ 1 0 1 1 0 ]
    Figure imgb0083
  • According to the invention, the disturbance signal portions are eliminated from the measurement signal with an estimation procedure supported by an observer. The observer equation for a complete observer for the modified state-space model is thus: x ̲ ˙ ^ vz = A ̲ vz - H ̲ vz C ̲ vz x ̲ vz + B ̲ vz u ̲ vz + H ̲ vz y ̲ m vz
    Figure imgb0084
  • The disturbance observer matrix H ̲ vz = h vz , 1 h vz , 2 h vz , 3 h vz , 4 h vz , 5 T
    Figure imgb0085

    is calculated, for example, according to the Riccati design procedure. It is essential here that the variable parameters such as ladder length, angle of elevation and load masses are likewise taken into account in the observer by adapting the observer differential equation and the observer gains. The estimated values for
    Figure imgb0086
    and ϕ̂ vz from the disturbance observer can be fed directly to the state controller. In this way the function of vibration damping can be improved significantly.
  • As an alternative to the observer-based elimination of higher harmonics, the feedback gain of the state controller 93 during the raising motion can also be attenuated by means of the proportional attenuator 92. In this way, the control function for the ladder at standstill can be improved if no observer-based elimination has been performed.
  • The individual components of the axis controller for the axis of elevation are thereby explained. As a result, the combination of position path planning module and elevation/inclination axis controller fulfils the requirement for a vibration-free and position path-accurate movement of the cage during raising and lowering.
  • The axis controllers for extending and retracting the ladder 47, to telescope the articulated arm 413, for the level axis 49 and for the articulated arm 411 are provided with conventional cascade control with an external servo loop for the position and an internal one for the speed, as these axes exhibit only a slight tendency to vibration.
  • Therefore a turntable ladder is achieved, the position path control of which allows for position path-accurate travel of the cage with all axes and suppresses active vibrations of the ladder in the process.

Claims (11)

  1. Turntable ladder or the like, with a telescopic ladder unit and, attached at the end of the ladder unit, an articulated arm which carries a cage, which turntable ladder contains a control for moving the ladder sections, formed in such a way that, during cage travel, vibrations of the ladder sections are suppressed, while at least one of the measured variables, bending of the ladder unit in the horizontal and vertical direction, angle of elevation, angle of rotation, run-out length and torsion of the ladder unit is fed back via a controller to the control variables for the drives and for which a pilot control is provided which represents the idealised movement behaviour of the ladder during cage travel in a dynamic model, based on differential equations and calculates the idealised control variables for the ladder section drives from the dynamic model for an essentially vibration-free movement of the ladder.
  2. Turntable ladder according to Claim 1, characterised in that the articulated arm is itself telescopic.
  3. Turntable ladder according to Claim 1 or 2, characterised in that a position path-planning module is available for the generation of the ladder movement position path in the working area which feeds the movement position path in the form of time functions for the cage position, cage speed, cage acceleration, cage jerking and, if necessary, the derivative of cage jerking to a pilot control block which controls the ladder section drives.
  4. Turntable ladder according to Claim 3, characterised in that the position path-planning module allows the input of kinematic restrictions for the time functions cage position, cage speed, cage acceleration and the cage jerking.
  5. Turntable ladder according to Claim 4, characterised in that that the position path-planning module also generates the time function for the derivative of the jerking.
  6. Turntable ladder according to Claim 4 and 5, characterised in that the position path-planning module contains steepness limiters to take into account the kinematic restrictions.
  7. Turntable ladder according to Claim 6, characterised in that the position path-planning module generates continuous jerking functions and from these determines, through integration, the time functions for the cage acceleration, cage speed and cage position.
  8. Turntable ladder according to one of the preceding claims, characterised through strain gauges as measurement sensors for the bending of the ladder unit in the horizontal and vertical direction and for its torsion.
  9. Turntable ladder according to one of the Claims 1 to 7, characterised in that the bending of the ladder unit in the horizontal and vertical direction and its torsion can be reconstructed from the pressure signals of the hydraulic drives of the ladder sections.
  10. Turntable ladder according to one of the preceding claims, characterised through a disturbance observer module for correcting the offset of the measurement signals of bending of the ladder unit in the horizontal and vertical direction and the torsion and for eliminating the frequency portion of the respective signals which correspond to higher harmonics of the ladder unit.
  11. Turntable ladder according to one of the preceding claims, characterised in that the controller is designed to weight the fed-back measurement values with a control gain and to reduce the control gain for eliminating ladder unit higher harmonics.
EP20060119983 2005-09-08 2006-09-01 Articulated ladder or raisable platform with position path control and active vibration damping Active EP1772588B1 (en)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
DE200510042721 DE102005042721A1 (en) 2005-09-08 2005-09-08 Rotating ladder e.g. fire fighting ladder, for use on vehicle, has controller provided to move ladder parts, where map-based pilot control representing idealized movement behavior of ladder in dynamic model is provided

Publications (3)

Publication Number Publication Date
EP1772588A2 true EP1772588A2 (en) 2007-04-11
EP1772588A3 EP1772588A3 (en) 2009-10-07
EP1772588B1 EP1772588B1 (en) 2013-06-19

Family

ID=37762988

Family Applications (1)

Application Number Title Priority Date Filing Date
EP20060119983 Active EP1772588B1 (en) 2005-09-08 2006-09-01 Articulated ladder or raisable platform with position path control and active vibration damping

Country Status (3)

Country Link
EP (1) EP1772588B1 (en)
DE (1) DE102005042721A1 (en)
ES (1) ES2427563T3 (en)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2103760A3 (en) * 2008-03-17 2010-04-07 Cifa S.p.A. Method to control the vibrations in an articulated arm for pumping concrete, and relative device
CN102707730A (en) * 2012-04-05 2012-10-03 大连理工大学 Hydraulic aerial cage operation platform trajectory control device
FR2980184A1 (en) * 2011-09-19 2013-03-22 Manitou Bf Method for managing displacement of boom lift of personnel, involves controlling and adjusting hydraulic flow of actuators producing movements of boom lift in continuous manner to impose linear velocity of constant evolution of basket
WO2013097509A1 (en) * 2011-12-30 2013-07-04 中联重科股份有限公司 Method, device, and system for controlling jib retraction, and vehicle for jib retraction
US8505184B2 (en) 2009-03-13 2013-08-13 Cifa Spa Method to make an arm for the distribution of concrete, and arm thus made
RU2695006C2 (en) * 2014-12-18 2019-07-18 Ивеко Магирус Аг Method for controlling an air device and an air device with a controller which realizes said method
EP3556969A1 (en) * 2018-04-17 2019-10-23 Liebherr-Mischtechnik GmbH Concrete pump
EP3556968A1 (en) * 2018-04-17 2019-10-23 Liebherr-Mischtechnik GmbH Concrete pump
EP3556967A1 (en) * 2018-04-17 2019-10-23 Liebherr-Mischtechnik GmbH Large manipulator, especially for concrete pumps
CN110509276A (en) * 2019-08-28 2019-11-29 哈尔滨工程大学 The motion modeling and parameter identification method of a kind of airfield runway detection robot
RU2748090C1 (en) * 2020-11-12 2021-05-19 Валерий Иванович Паутов Pendulum carriage fire device

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102007038016A1 (en) 2007-08-10 2009-02-12 Iveco Magirus Ag Drehleiter
US9651112B2 (en) 2011-10-20 2017-05-16 Zoomlion Heavy Industry Science And Technology Co., Ltd. Vibration suppression method, controller, device of boom and pump truck
RU2700735C1 (en) * 2019-04-23 2019-09-19 Валерий Иванович Паутов Expandable fire-rescue system
CN114572909B (en) * 2022-03-09 2022-12-16 杭州爱知工程车辆有限公司 Method for expanding working range of working bucket of overhead working truck

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10016137C2 (en) 2000-03-31 2003-08-21 Iveco Magirus Drehleiter
DE10016136C2 (en) 2000-03-31 2003-08-21 Iveco Magirus Turntable ladder control

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE9416367U1 (en) * 1994-10-11 1994-12-01 Iveco Magirus Aerial ladder for emergency vehicles
DE10353134A1 (en) * 2003-11-14 2005-06-09 Marte Feuerwehrfahrzeuge Feuerwehrtechnologie Ges.M.B.H. Rescue device

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10016137C2 (en) 2000-03-31 2003-08-21 Iveco Magirus Drehleiter
DE10016136C2 (en) 2000-03-31 2003-08-21 Iveco Magirus Turntable ladder control

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2103760A3 (en) * 2008-03-17 2010-04-07 Cifa S.p.A. Method to control the vibrations in an articulated arm for pumping concrete, and relative device
US8082083B2 (en) 2008-03-17 2011-12-20 Cifa Spa Method to control the vibrations in an articulated arm for pumping concrete, and relative device
US8505184B2 (en) 2009-03-13 2013-08-13 Cifa Spa Method to make an arm for the distribution of concrete, and arm thus made
FR2980184A1 (en) * 2011-09-19 2013-03-22 Manitou Bf Method for managing displacement of boom lift of personnel, involves controlling and adjusting hydraulic flow of actuators producing movements of boom lift in continuous manner to impose linear velocity of constant evolution of basket
WO2013097509A1 (en) * 2011-12-30 2013-07-04 中联重科股份有限公司 Method, device, and system for controlling jib retraction, and vehicle for jib retraction
CN102707730A (en) * 2012-04-05 2012-10-03 大连理工大学 Hydraulic aerial cage operation platform trajectory control device
RU2695006C2 (en) * 2014-12-18 2019-07-18 Ивеко Магирус Аг Method for controlling an air device and an air device with a controller which realizes said method
EP3556969A1 (en) * 2018-04-17 2019-10-23 Liebherr-Mischtechnik GmbH Concrete pump
EP3556968A1 (en) * 2018-04-17 2019-10-23 Liebherr-Mischtechnik GmbH Concrete pump
EP3556967A1 (en) * 2018-04-17 2019-10-23 Liebherr-Mischtechnik GmbH Large manipulator, especially for concrete pumps
CN110509276A (en) * 2019-08-28 2019-11-29 哈尔滨工程大学 The motion modeling and parameter identification method of a kind of airfield runway detection robot
RU2748090C1 (en) * 2020-11-12 2021-05-19 Валерий Иванович Паутов Pendulum carriage fire device

Also Published As

Publication number Publication date
DE102005042721A1 (en) 2007-03-15
ES2427563T3 (en) 2013-10-31
EP1772588A3 (en) 2009-10-07
EP1772588B1 (en) 2013-06-19

Similar Documents

Publication Publication Date Title
EP1772588B1 (en) Articulated ladder or raisable platform with position path control and active vibration damping
JP4795228B2 (en) Crane or excavator with optimal movement guidance for handling rope-loaded luggage
CN105717947B (en) Method for controlling aerial device and aerial device having controller for implementing the method
CN111295354B (en) Crane and method for controlling such a crane
EP1591857B1 (en) Vibration control device
EP3556969B1 (en) Concrete pump
CN112585079B (en) Crane and control method thereof
KR100230691B1 (en) Front control system and recording medium for construction machine
US20040164041A1 (en) Crane or digger for swinging a load hanging on a support cable with damping of load oscillations
US20060129348A1 (en) System for collision a voidance of rotary atomizer
JPWO2019087866A1 (en) Steering control device
US20070209445A1 (en) Velocity feedback compensation for force control systems
EP3556967B1 (en) Large manipulator, especially for concrete pumps
JP5362158B2 (en) Turntable ladder equipment
KR20090124560A (en) Device and method for controlling a manipulator
DE102018109098A1 (en) concrete pump
EP1138868B1 (en) Turntable ladder control
JP2021134022A (en) Vibration prevention system for cargo handling vehicle and cargo handling vehicle
JPH06332535A (en) Robot controller
JP5037065B2 (en) Machine control device
CN116002585A (en) Control method and device for lifting mechanism, processor and readable storage medium
JP3600025B2 (en) Shape measuring device
KR20240016203A (en) Control method and control device based on dynamic torque compensation
Torfs et al. Modeling and control of a flexible one-link robot driven by a velocity controlled actuator

Legal Events

Date Code Title Description
PUAI Public reference made under article 153(3) epc to a published international application that has entered the european phase

Free format text: ORIGINAL CODE: 0009012

AK Designated contracting states

Kind code of ref document: A2

Designated state(s): AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HU IE IS IT LI LT LU LV MC NL PL PT RO SE SI SK TR

AX Request for extension of the european patent

Extension state: AL BA HR MK YU

PUAL Search report despatched

Free format text: ORIGINAL CODE: 0009013

AK Designated contracting states

Kind code of ref document: A3

Designated state(s): AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HU IE IS IT LI LT LU LV MC NL PL PT RO SE SI SK TR

AX Request for extension of the european patent

Extension state: AL BA HR MK RS

17P Request for examination filed

Effective date: 20100330

17Q First examination report despatched

Effective date: 20100504

AKX Designation fees paid

Designated state(s): AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HU IE IS IT LI LT LU LV MC NL PL PT RO SE SI SK TR

GRAP Despatch of communication of intention to grant a patent

Free format text: ORIGINAL CODE: EPIDOSNIGR1

RIC1 Information provided on ipc code assigned before grant

Ipc: E06C 5/06 20060101ALI20121212BHEP

Ipc: E06C 5/36 20060101ALI20121212BHEP

Ipc: E06C 5/44 20060101AFI20121212BHEP

Ipc: B66F 11/04 20060101ALI20121212BHEP

GRAS Grant fee paid

Free format text: ORIGINAL CODE: EPIDOSNIGR3

GRAA (expected) grant

Free format text: ORIGINAL CODE: 0009210

AK Designated contracting states

Kind code of ref document: B1

Designated state(s): AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HU IE IS IT LI LT LU LV MC NL PL PT RO SE SI SK TR

REG Reference to a national code

Ref country code: GB

Ref legal event code: FG4D

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: 617757

Country of ref document: AT

Kind code of ref document: T

Effective date: 20130715

REG Reference to a national code

Ref country code: IE

Ref legal event code: FG4D

REG Reference to a national code

Ref country code: DE

Ref legal event code: R096

Ref document number: 602006036851

Country of ref document: DE

Effective date: 20130814

REG Reference to a national code

Ref country code: SE

Ref legal event code: TRGR

REG Reference to a national code

Ref country code: NL

Ref legal event code: T3

PG25 Lapsed in a contracting state [announced via postgrant information from national office to epo]

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: 20130920

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: 20130619

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: 20130619

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: 20130619

REG Reference to a national code

Ref country code: ES

Ref legal event code: FG2A

Ref document number: 2427563

Country of ref document: ES

Kind code of ref document: T3

Effective date: 20131031

REG Reference to a national code

Ref country code: AT

Ref legal event code: MK05

Ref document number: 617757

Country of ref document: AT

Kind code of ref document: T

Effective date: 20130619

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: 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: 20130919

PG25 Lapsed in a contracting state [announced via postgrant information from national office to epo]

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: 20130619

PG25 Lapsed in a contracting state [announced via postgrant information from national office to epo]

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: 20131021

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: 20130619

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: 20130717

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: 20130619

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: 20130619

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: 20131019

Ref country code: BE

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: 20130619

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: 20130619

PG25 Lapsed in a contracting state [announced via postgrant information from national office to epo]

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: 20130619

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: 20130619

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: 20130619

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: 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: 20130619

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: 20130619

REG Reference to a national code

Ref country code: CH

Ref legal event code: PL

26N No opposition filed

Effective date: 20140320

REG Reference to a national code

Ref country code: DE

Ref legal event code: R097

Ref document number: 602006036851

Country of ref document: DE

Effective date: 20140320

REG Reference to a national code

Ref country code: IE

Ref legal event code: MM4A

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: 20130930

Ref country code: IE

Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES

Effective date: 20130901

Ref country code: CH

Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES

Effective date: 20130930

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: 20130619

PG25 Lapsed in a contracting state [announced via postgrant information from national office to epo]

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: 20060901

Ref country code: LU

Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES

Effective date: 20130901

REG Reference to a national code

Ref country code: FR

Ref legal event code: PLFP

Year of fee payment: 10

REG Reference to a national code

Ref country code: FR

Ref legal event code: PLFP

Year of fee payment: 11

REG Reference to a national code

Ref country code: FR

Ref legal event code: PLFP

Year of fee payment: 12

REG Reference to a national code

Ref country code: FR

Ref legal event code: PLFP

Year of fee payment: 13

P01 Opt-out of the competence of the unified patent court (upc) registered

Effective date: 20230522

PGFP Annual fee paid to national office [announced via postgrant information from national office to epo]

Ref country code: NL

Payment date: 20230926

Year of fee payment: 18

Ref country code: IT

Payment date: 20230912

Year of fee payment: 18

Ref country code: GB

Payment date: 20230926

Year of fee payment: 18

PGFP Annual fee paid to national office [announced via postgrant information from national office to epo]

Ref country code: SE

Payment date: 20230926

Year of fee payment: 18

Ref country code: FR

Payment date: 20230926

Year of fee payment: 18

Ref country code: DE

Payment date: 20230928

Year of fee payment: 18

PGFP Annual fee paid to national office [announced via postgrant information from national office to epo]

Ref country code: ES

Payment date: 20231018

Year of fee payment: 18