This application claims priority to German Patent Application No. 10 2014 008 094.3, entitled “Method for Controlling the Orientation of a Crane Load and a Boom Crane” filed on Jun. 2, 2014, the entire contents of which is hereby incorporated by reference in its entirety for all purposes.
The present disclosure relates to a method for controlling the orientation of a crane load, wherein a manipulator for manipulating the load is connected by a rotator unit to a hook suspended on ropes and the skew angle of the load is controlled by a control unit of the crane.
In small and midsize harbours, boom cranes are used for multiple applications. These include bulk cargo handling and container transloading. An example for a boom crane used in small and midsize harbours with mixed freight types is depicted in
On boom cranes, containers are mounted to the crane hook using spreaders (manipulators), see
Since wind, impact, and uneven load distribution can cause skew vibrations, an active skew control is desirable for facilitating crane operation, improving positioning accuracy, and increasing turnover. Positioning the spreader requires damping the pendulum oscillations, which can be done either manually by the operator or automatically using anti-sway systems. Adapting the spreader orientation requires damping the torsional oscillations (“rotational vibrations” or “skewing vibrations”) using a rotational actuator, which is regularly done manually.
A few technical solutions for a skew control are known from the state of the art and which are mostly designed for a gantry crane. Due to specific properties of such cranes these implementations of skew controls are mostly not compliant with differing crane designs. In particular boom cranes comprise a longer rope length and a much smaller rope distance which yields to lower torsional stiffness compared to gantry cranes. This increases the relevance of constraints and also results in lower eigenfrequencies. Second, arbitrary skew angles are possible on boom cranes, while gantry cranes can only reach skew angles of a few degrees. Third, the well-established visual load tracking mechanism of gantry cranes using cameras and markers cannot be applied to boom cranes.
For instance, a solution for a skew control system is known from EP 1 334 945 A2 performing optical position measurements (e.g. camera based) for detecting the skew angle. However, such system may become unavailable during night or during bad weather conditions.
Another method for controlling the orientation of the crane load is known from DE 100 29 579 and DE 10 2006 033 277 A1. There, the hook suspended on ropes has a rotator unit containing a hydraulic drive, such that the manipulator for grabbing containers can be rotated around a vertical axis. Thereby, it is possible to vary the orientation of the crane loads. If the crane operator or the automatic control gives a signal to rotate the manipulator and thereby the load around the vertical axis, the hydraulic motors of the rotator unit are activated and a resulting flow rate causes a torque. As the hook is suspended on ropes, the torque would result in a torsional oscillation of the manipulator and the load. To position the load at a specific angle, this torsional oscillation has to be compensated. However, the solutions known from DE 100 29 579 and DE 10 2006 033 277 A1 use linear models for describing the skew motion. Such linear models are only valid in a small neighborhood around the steady state, i.e. only small deflection angles can be used. Further, the systems known from DE 100 29 579 and DE 10 2006 033 277 A1 employ a state observer which needs the second derivative of a position measurement. Such a double differentiation is disadvantageous due to noise amplification. Furthermore, both systems known from DE 100 29 579 and DE 10 2006 033 277 A1 require knowledge of the load inertia which varies heavily with the load mass. Especially in DE 10 2006 033 277 A1, a time-consuming calculation method is used for estimating the load inertia.
It is the objection of the present disclosure to provide an improved method for controlling the skew angle of a crane, in particular of a boom crane.
The aforementioned object is solved by a method performed on a control unit of a crane comprising a manipulator for manipulating the orientation of a load connected by a rotator unit to a hook suspended on ropes. For improvement of the operating of the crane the skew angle of the load is controlled by a control unit of the crane.
In the following, a rotation of the manipulator (spreader) and/or crane load (e.g. container) around the vertical axis is described as skew motion. The heading or yaw of a load is called skew angle and rotation oscillations of the skew angle are called skew dynamics.
The expression hook defines the entire load handling devic excluding the spreader.
A control of the skew angle normally requires a feedback signal which is usually based on a measurement of the current system status. However, implementation of a skew control according to the present disclosure requires states of the boom crane which cannot be measured or which are too disturbed to be used as feedback signals.
Therefore, the present disclosure recommends that one or more required states are estimated on the basis of a model describing the skewing dynamics during the crane operation. Further, a nonlinear model is used for describing the skew dynamics of the crane during operation instead of a linear model as currently applied by known skew controls. Implementation of a non-linear model enables consideration of the non-linear behaviour of the skew dynamics over a wider range or the full range of the possible skewing angle of the load. Since boom cranes permit a significantly larger skewing angle than gantry cranes the present disclosure essentially improves the performance and stability of the skew control applied to boom cranes.
According to the present disclosure a non-linear model is used which allows using larger deflection angles (up to90°). Larger deflection angles yield larger reactive torques and therefore faster motion.
Further, the present disclosure does not require any optical sensors to improve the system availability and system reliability. No optical position measurement has to be performed for detecting the skew angle as known from the state of the art.
In the method for controlling the orientation of a crane load of the present disclosure, torsional oscillations are avoided by an anti-torsional oscillation unit using the data calculated by the dynamic non-linear model. This anti-torsional oscillation unit uses the data calculated by the dynamic non-linear model to control the rotator unit such that oscillations of the load are avoided. The anti-torsional oscillation unit can generate control signals that counteract possible oscillations of the load predicted by the dynamical model. The rotator unit includes an electric and/or hydraulic drive. The anti-torsional oscillation unit can generate signals for activating the rotator motor, thereby applying torque generated by a hydraulic flow rate or electric current.
In particular, the non-linearity included in the model describing the skew dynamics refers to the non-linear behaviour of the resulting reactive torque caused by torsion of the load, i.e. the ropes. For instance, the reactive torque increases until a certain skew angle of the load is reached, for instance of about 90 degrees. By excessing said certain skew angle the reactive torque decreases due to twisting of the ropes. The skew dynamic model optionally includes one or more non-linear terms or expressions representing the non-linear behaviour as described before.
Former controller architectures as described before require the mass of the load and most importantly, the moment of inertia of the load as an input parameter. However, the distribution of mass inside the load, e.g. a container, is unknown and therefore the moment of inertia of the load is not known, either. Therefore, known prior art control architectures estimate the moment of inertia of the load on the basis of a complex and computationally intensive process. According to an example aspect of the present disclosure the implemented non-linear model for estimation of the system state is independent on the load mass and/or the moment of inertia of the load mass. Consequently, the performance of the skew control significantly increases while reducing the processor load and usage of the control unit.
In particular, the method according to a further preferable aspect does not require a Kalman filter for estimation of the system state.
In an example embodiment of the present disclosure the estimated system state includes the estimated skew angle and/or the velocity of the skew angle and/or one or more parasitic oscillations of the skew system. A possible parasitic oscillation which influences the skew dynamics may be caused by the slackness of the hook, for instance. Further, system state may further include besides the estimates parameters several parameters which are directly or indirectly measured by measurement means of the crane.
The control unit may be based on a two-degree of freedom control (2-DOF) comprising a state observer for estimation of the system state, a reference trajectory generator for generation of a reference trajectory in response to a user input and a feedback control law for stabilization of the nonlinear skew dynamic model.
This means that a control signal for controlling the rotator drive of the rotator unit and/or a slewing gear and/or any other drive of the crane comprises a feedforward signal from the reference trajectory generator and a feedback signal to stabilize the system and reject disturbances. The feedforward control signal is generated by the reference trajectory generator and designed in such a way that it drives the system along a reference trajectory under nominal conditions (nominal input trajectory). Deviation from a nominal state (nominal state trajectory) defined by the reference trajectory generator are determined by using the estimated state determined by the state observer on the basis of the non-linear model for skew dynamics. Any deviation is compensated by a feedback signal determined from the nominal and estimated state using a feedback gain vector. The resulting compensated signal is used as the feedback signal for generation of the control signal.
For estimation of the system state considering the skew dynamics the state observer optionally receives measurement data comprising at least the drive position of the rotator unit and/or the inertial skewing rate and/or the slewing angle of the crane. These parameters may be measured by certain means installed at the crane structure. For instance, the drive position of the rotator may be measured by an incremental encoder. Since the incremental encoder gives a reliable measurement signal the drive speed may be calculated by discrete differentiation of the drive position. Further, a gyroscope may be installed at the hook, in particular the hook housing, for measuring the inertial skewing rate of the hook. Said gyroscope measurement may be disturbed by a signal bias and a sensor noise. The slewing angle of the crane may be measured by another sensor, for instance an incremental encoder installed at the slewing gear.
Furthermore, the rope length may be measured precisely and a spreader length used for grabbing a container may be derived from a spreader actuation signal. It may be possible to calculate the radius of gyration from the spreader length.
A good quality for estimation of the system state is achieved by using a state observer of a Luenberger-type. However, any other type of a state observer may be applicable.
The state observer may be implemented without the use of a Kalman filter since the model for characterizing the skew dynamic is independent of the load mass and/or the moment of inertia of the load mass.
As described before, the systems known from DE 100 29 579 and DE 10 2006 033 277 A1 employ a state observer which needs the second derivative of a position measurement. Such a double differentiation is disadvantageous due to noise amplification. According to an example aspect of the present disclosure the used coordinate system for describing the state of the system has been changed to an extent that the present disclosure does not require double differentiation.
It is advantageous when the reference trajectory generator calculates a nominal state trajectory and/or a nominal input trajectory which is/are consistent with the crane dynamics, i.e. skew dynamics and/or rotator drive dynamics and/or measured crane tower motion. Consistency with skew dynamics means that the reference trajectory fulfills the differential equation of the skew dynamics and does not violate skew deflection constraints. Consistency with drive dynamics means that the reference trajectory fulfills the differential equation of the drive dynamics and violates neither drive velocity constraints nor drive torque constraints.
A generation of the nominal state and input trajectory is optionally performed by using the non-linear model for the skew dynamics. That is to say that a simulation of the non-linear skew dynamic model and/or a simulation of the rotator unit model is/are implemented at the reference trajectory generator for calculation of a nominal state trajectory and/or a nominal input trajectory consistent with the aforementioned crane dynamics.
Further, a disturbance decoupling block of the reference trajectory generator decouples the skewing dynamics from the crane's slewing dynamics. That is to say that the slewing gear can still be manually controlled by the crane operator during an active skew control. The same may apply to the dynamics of the luffing gear. Consequently, the control of the skewing angle may be decoupled from the slewing gear and/or the luffing gear of the crane.
In a particular embodiment of the present disclosure the reference trajectory generator enables an operator triggered semi-automatic rotation of the load of a predefined angle, in particular of about 90° and/or 180°. That is to say the control unit offers certain operator input options which will proceed an semi-automatically rotation/skew of the attached load for a certain angle, ideally 90° and/or 180° in a clockwise and/or counter-clockwise direction. The operator may simply push a predefined button on a control stick to trigger an automatic rotation/skew of the load wherein the active skew control of the skew unit avoid torsional oscillations during skew movements.
The present disclosure is further directed to a skew control system for controlling the orientation of a crane load using any one of the methods described above. Such a skew control unit may include a 2-DOF control for the skew angle. The skew control system may include a reference trajectory generator and/or a state observer and/or a control unit for controlling the control signal of a rotator unit and/or slewing gear and/or luffing gear.
The present disclosure further comprises a boom crane, especially a mobile harbour crane, comprising a skew control unit for controlling the rotation of a crane load using any of the methods described above. Such a crane comprises a hook suspended on ropes, a rotator unit and a manipulator.
Advantageously, the crane will also comprise an anti-sway-control system that interacts with the system for controlling the rotation of a crane. The crane may also comprise a boom that can be pivoted up and down around a horizontal axis and rotated around a vertical axis by a tower. Additionally, the length of the rope can be varied.
Further advantages and properties of the present disclosure are described on the basis of embodiments shown in the figures.
Boom cranes are often used to handle cargo transshipment processes in harbours. Such a mobile harbour crane is shown in
A control system 81 may be provided, for example positioned in or on or at the crane, reading information from various sensors 75 and/or estimates of parameters based on sensor and other data (including those sensors described herein), and adjusting actuators 65 in response thereto (including those actuators, such as motors, described herein). The control system may include an electronic analog and/or digital control unit for example including a physical processor and physical memory 98 with instructions stored therein for carrying out the various actions, including operating the controllers described herein.
For simplicity, only the rotation of a load suspended on an otherwise stationary crane will be discussed here. However, the control concept of the present disclosure can be easily integrated in a control concept for the whole crane.
The present disclosure presents the skew dynamics on a boom crane along with an actuator model and a sensor configuration. Subsequently a two-degrees of freedom control concept is derived which comprises a state observer for the skew dynamics, a reference trajectory generator, and a feedback control law. The control system is implemented on a Liebherr mobile harbour crane and its effectiveness is validated with multiple test drives.
The novelties of this publication include the application of a nonlinear skew dynamics model in a 2-DOF control system on boom cranes, the real-time reference trajectory calculation method which supports operating modes such as perpendicular transfer of containers, and the experimental validation on a harbour cranes with a load capacity of 124 t.
In this section, typical operating modes for container rotation during container transloading are discussed.
In most harbours, containers 10 are moved from a container vessel 40 to shore 50 without rotation. This is commonly called parallel transfer; see
When automatic skew control is enabled on a crane, the same user interface shall be used. This means that the operator shall control the spreader motion using only the two hand lever buttons. When there is no operator input, the skew angle shall be kept constant to allow parallel transfer of containers. This means that both known disturbances (e. g. slewing motion) and unknown disturbances (e. g. wind force) need to be compensated. Short-time button pushes shall yield small orientation changes to allow precise positioning. When a button is kept pushed for longer periods, the container is accelerated to a constant target speed, and it is decelerated again once the button is released. The target speed is chosen such that the braking distance is sufficiently small to ensure safe working conditions (the braking distance shall not exceed 45°). To simplify perpendicular transfer of containers or 180° container rotation, the skewing motion shall automatically stop at a given angle (90° or 180°) even if the operator keeps the button pressed.
According to the present disclosure a dynamic model for the skew angle is derived. As shown in
3.1 Load Rotation Dynamics
In this section, a model for the oscillation dynamics of the inertial skew angle ηL is derived. The
The spreader (with or without a container) is assumed to be a uniform cuboid of dimensions k1×k2×k3 with the mass mL (see
With the vertical position hL, the horizontal position xL, yL and the rotation rates {dot over (β)}, {dot over (γ)}, {dot over (δ)}, and the gravitational acceleration g, the potential energy and the kinetic energy of the container are:
Both (2) and (3) are combined to the Lagrangian =−. In order to apply the Euler-Lagrange equation
it must be identified which terms in (2) and (3) depend on either the skew angle ηL or its derivative {dot over (η)}L:
The Lagrangian can therefore be represented as:
In order to apply (4) to (5), the relative load height hL needs to be written as a function of the rotator deflection (i. e. the twist angle ⋄=ηL−φC−φD).
With sx known, geometric considerations in triangle B reveal
−hL=√{square root over (L2−sx2)}, (7)
which yields:
Using (5) and (8), the Euler-Lagrange formalism (4) yields the differential equation (9) which describes the skew dynamics.
The following assumptions are used to simplify equation (9):
With these assumptions, the skew dynamics (9) can be denoted as
The right-hand side of (10) is the torque T exerted on the load. The product of the halve rope distances is abbreviated as
which is a parameter that is known from the crane geometry. Combining (10) and (11) yields the skew dynamics model
Equation (12) illustrates that the eigenfrequency of the skew dynamics is independent of the load mass, i. e. only depends on the geometry and on the gravitational acceleration. Also, (12) illustrates that it is not reasonable to leave the deflection range
since larger deflections do not yield higher torques.
3.2 Actuator Model
The skewing device rotates the spreader with respect to the hook (see
T
S{umlaut over (φ)}C+{dot over (φ)}C=u. (14)
The actuator system is subject to two contraints. First, the control signal u cannot exceed given limits:
u
min
≦u≦u
max. (15)
Second, the drive system is limited in torque and/or pressure and/or current, therefore only a certain skew torque Tmax can be applied by the actuators. Considering (10), the skew torque constraint is:
This constraint is important for trajectory generation since the system will inevitably deviate from the reference trajectory if the constraint is violated.
3.3 Sensor Models
There are two sensors installed in the hook housing (see
y
1=φC. (17)
Since the incremental encoder gives a reliable measurement signal, the drive speed {dot over (φ)}C is found by discrete differentiation of the drive position. For measuring the skew dynamics, a gyroscope is installed in the hook housing, which measures its inertial skewing rate. The gyroscope measurement is disturbed by a signal bias and sensor noise:
y
2={dot over (η)}−{tilde over (φ)}C+νoffset+νnoise. (18)
The slewing angle of the crane is also measured by an incremental encoder (see
y
3=φD. (19)
Furthermore the rope length L of the crane is measured precisely, and the spreader length lapr is known from the spreader actuation signal (see
The crane's load measurement is only used to decide if the container has to be taken into account for the calculation of the radius of gyration kL.
For the skew control, two-degree of freedom control is used as shown in
u=ũ+Δu. (20)
The feedforward control signals is designed in such a way that it drives the system along a reference trajectory {tilde over (x)} under nominal conditions. Any deviation of the estimated system state {tilde over (x)} to the reference state {tilde over (x)} is compensated by the feedback signal Δu using the feedback gain vector kT:
Δu=kT({tilde over (x)}−{circumflex over (x)}). (21)
The system state x comprises the rotator angle φC, rotator angular rate {dot over (φ)}C, the skew angle ηL and the skew angular rate {dot over (η)}L:
In Section 4.1, a state observer is presented which finds the state estimate {circumflex over (x)} for the real system state x using the measurement signals. The design of the feedback gain kT is discussed in Section 4.2. Finally, the reference trajectory generator which calculates ũ and {tilde over (x)} is shown in Section 4.3.
4.1 State Observer
The aim of the state observer is to estimate those states of the state vector (22) which cannot be measured or whose measurements are too disturbed to be used as feedback signals. Both states of the actuator dynamics are measured using an incremental encoder. This means that φC and {dot over (φ)}C are known and do not need to be estimated. The two states of the skew dynamics, the skew angle ηL and its angular velocity {dot over (η)}L, are not directly measurable. They are estimated using a Luenberger-type state observer. The gyroscope measurement (18) is used as feedback signal for the observer. Since the gyroscope measurement carries a signal offset νoffset, an augmented observer model is introduced for observer design, i. e. the observer state vector zspiel comprises the skew angle ηL, the skew rate {dot over (η)}L and the signal offset νoffset and the skewing rate νspiel caused by the slackness of the hook and the time derivative {circumflex over (ν)}spiel thereof:
The nominal dynamics of zs are found by combining (12) with a random-walk offset model:
The observer is found by adding a Luenberger term to (24). The estimates state vector is denoted as {circumflex over (z)}s. The signals φC, φD, and {dot over (φ)}C are taken from the measurements (17) and (19):
The feedback gains l1, l2, l3, l4 and l5 and are found by pole placement to ensure required convergence times after situations with model mismatch. A typical example for model mismatch is a collision with a stationary obstacle (e. g. another container). For the pole placement procedure, a set-point linearization of the observer model is used.
From the estimated state vector {circumflex over (z)}s, the estimated skew angle and the skew rate are forwarded to the 2-DOF control, along with the actuator state measurements. The estimated gyroscope offset is not considered further:
4.2 Stabilization
Since both the skew dynamics (12) and the actuator dynamics (14) have open loop poles on the imaginary axis, any disturbance (e. g. wind) or error in the initial state estimate will cause non-vanishing deviations in between the reference trajectory {tilde over (x)} and the system trajectory x. Feedback control is added to ensure that the system converges to the reference trajectory (see
e={tilde over (x)}−x (27)
and designing the feedback gain k with
k
T
=┌k
1
k
2
k
3
k
4┐ (28)
for eq. (21) such that the control error is asymptotically stable. For the feedback design, a set-point linearization is considered. Afterwards it is verified that the feedback law stabilizes the nonlinear system model.
Assuming both the reference trajectory and the plant dynamics fulfill the model equations (12) and (14), the error dynamics can be found by differentiating (27) and plugging-in the model equations:
Together with the control equations (20), (21), and (28), and assuming the state estimation works sufficiently well ({circumflex over (x)}−x), the set-point linearization of (29) is
With the abbreviation
the characteristic polynomial of the dynamic matrix Φ is:
For any parameters θ and TS, the feedback gains k1, . . . k4 can be chosen in such a way that (31) is a Hurwitz polynomial. The final feedback gains can be chosen by various methods. A graphical tool are stability plots. For example, the stability region for k2=k3=0 is depicted in
4.3 Reference Trajectory Generation
As shown in
The general structure is known which uses a plant simulation to generate a reference state trajectory and an arbitrary control law for generating a control input for the plant simulation. The control input for the simulated plant is then used as a nominal control signal for the real system. In order to adapt this approach to the skew control problem, simulations of the actuator model and the skew model are implemented for generating a reference state trajectory from a reference input signal. In this design, the combined angle
{tilde over (φ)}CD=φC+φD (36)
is used instead of the actuator angle φC and the slewing gear angle φD at first. The two variables are later decoupled as discussed in Section 4.3.3. The remainder of this section discusses the control law which is used to stabilize the plant simulation.
Since the cut-off frequency of the actuator dynamics is significantly faster than the eigenfrequency of the skew dynamics, cascade control is applied inside the reference trajectory planner. This means that a skew reference controller is set up for stabilizing the simulated skew dynamics, and an underlying actuator reference controller is used for stabilizing the simulated actuator dynamics. The target value of the skew control loop is the target velocity {tilde over ({dot over (η)}L,target from the operator, and the target value of the underlying actuator control loop comes from the skew control loop. A disturbance decoupling block is added to decouple the skewing dynamics from the crane's slewing dynamics, i. e. reverting (36). Finally, the automatic deceleration at position constraints after 90° or 180° of motion are enforced by modification of the target velocity for the whole reference control loop.
The skew reference control loop is explained in Subsection 4.3.1, followed by the actuator reference control loop in Subsection 4.3.2. Subsequently, the decoupling of the slewing gear motion is shown in Subsection 4.3.3. Finally, the determination of the target velocity is discussed in Subsection 4.3.4.
4.3.1 Skew Reference Controller
The aim of the skew reference controller is to stabilize the skew dynamics simulation
and to ensure that it tracks the target velocity {tilde over ({dot over (η)}L,target, For this purpose the control law
{tilde over (φ)}CD,target={tilde over (η)}L+satη(Kη·({tilde over ({dot over (η)}L,target−{tilde over ({dot over (η)}L (38)
is introduced with the saturation function
The saturation function ensures that the target rope deflection neither exceeds the deflection which corresponds to maximum actuator torque as in (16), nor the maximum deflection angle Δηmax. The maximum deflection Δηmax<
ensures that the reference trajectory does not deflect the hook beyond the maximum torque angle as in (13), and that there is a reasonable safety margin in case of control deviation.
Assuming {tilde over (φ)}CD≈{tilde over (φ)}CD,target, get the skew dynamics (37) with the control law (38) breaks down to
A stability analysis of (40) reveals that for any positive Kη the load skew rate {tilde over ({dot over (η)}L converges to any constant target velocity {tilde over ({dot over (η)}L,target. The feedback gain Kη is chosen by gain scheduling in dependence of the skew eigenfrequency. It ensures quick convergence with minimum overshoot.
4.3.2 Actuator Reference Controller
The underlying control loop consists of the plant
and the actuator reference controller which is designed using the following model predictive control approach. The actuator reference controller is designed such that the cost function
is minimized. Here, s≧0 is a high-weighted slack variable which is introduced to ensure that the following set of input and state constraints is always feasible:
ũ
CD(t)≦umax, (43)
−ũCD(t)≦−umin, (44)
{tilde over (φ)}CD(t)−s(t)≦{tilde over (η)}L+satη(∞), (45)
−{tilde over (φ)}CD(t)−s(t)≦−{tilde over (η)}L+satη(∞). (46)
The input constraints (43)-(44) ensure that the valve limitations (15) are not violated. The state constraints (45)-(46) are used to prevent remaining overshot with respect to the hook deflection constraint (39).
The optimal control problem (42)-(46) is discretized and solved using an interior point method.
4.3.3 Disturbance Decoupling
So far, reference values for the combined angle {tilde over (φ)}CD were calculated. As defined in (36), {tilde over (φ)}CD comprises the rotator angle and the slewing gear angle. However, the reference trajectory planner needs to calculate a nominal trajectory for the rotator angle {tilde over (φ)}C only. Since the crane's slewing gear motion is known to the crane control system, it can be easily decoupled using the following formulas:
{tilde over (φ)}C={tilde over (φ)}CD−φD, (47a)
{tilde over ({dot over (η)}={tilde over ({dot over (η)}CD−{dot over (φ)}D, (47b)
{tilde over (μ)}={tilde over (μ)}CD−({dot over (φ)}D+Ts{umlaut over (φ)}D). (47c)
Equation (47a) directly reverts (36). Equation (47b) is found by differentiating (47a), and (47c) is found by further differentiation, and applying the actuator model (14) as well as (41).
4.3.4 Determination of the Target Velocity
The operator can only push joystick buttons in an on/off manner to operate the skewing system, i. e. the hand lever signal is
ωε{−1,0,+1}. (48)
The target velocity {tilde over ({dot over (η)}L,target for the skew reference controller is found by multiplying the joystick button signal with a reasonable maximum speed:
{tilde over ({dot over (η)}L,target={tilde over ({dot over (η)}L,max·ω. (49)
When the operator keeps a joystick button pressed permanently, the target velocity {tilde over ({dot over (η)}L,target is overwritten with 0 at some point to stop the skewing motion. The time instant of starting to overwrite the joystick button with 0 is chosen such that the systems comes to rest exactly at the desired stopping angle {tilde over (η)}stop. The stopping angle {tilde over (η)}stop is chosen application dependently. For turning a container frontside back, ηstop is chosen 180° after the starting point. To identify the right point in time for overwriting the hand lever signal with 0, a forward simulation of the trajectory generator dynamics is conducted in every sampling interval with a target velocity of 0, yielding a stopping angle prediction {tilde over (η)}pred. When this prediction reaches the desired stopping angle {tilde over (η)}stop, further motion is inhibited in this direction, i.e. (49) is replaced by:
For the sake of clarity, the full target speed determination signal flow is shown in
To validate the practical implementation of the presented skew control system, two experiments are presented in this section. These experiments were chosen to reflect typical operating conditions as discussed in Section 2. The experiments were conducted on a Liebherr LHM 420 boom crane.
5.1 Compensation of Crane Slewing Motion
When the containers can be moved from ship to shore at a constant skew angle, the most important feature of the presented control system is the decoupling of the skew dynamics from the slewing gear.
5.2 Large Angular Rotation
To demonstrate the usage of the semi-automatic container turning function, another test drive is shown in
A nonlinear model for the skew dynamics of a container rotator of a boom crane and a suitable control system for the skew dynamics have been presented. The control system is implemented in a two-degrees of freedom structure which ensures stabilization of the skew angle, decoupling of slewing gear motions and simplifies operator control. A linear control law is shown to stabilize the system by use of the circle criterion. The system state is reconstructed from a skew rate measurement using a Luenberger-type state observer. The reference trajectory for the control system is calculated from the operator input in real-time using a simulation of the plant model. The simulation comprises appropriate control laws which ensure that the reference trajectory tracks the operator signal and maintains system constraints. The performance of the control system is validated with test drives on a full-size mobile harbour boom crane.
Number | Date | Country | Kind |
---|---|---|---|
10 2014 008 094.3 | Jun 2014 | DE | national |