CONTROL OF OVERHEAD CRANES

Abstract

A method of positioning a movable structure of an overhead crane, the movable structure being either a trolley or a bridge of the overhead crane, the method comprising providing a position reference for the movable structure, controlling with a state-feedback controller the position of the movable structure, the position of the movable structure and a sway angle of the load being state variables of the system used in the state-feedback controller. Further the method comprises determining the position or speed of the movable structure and the sway angle of the load or angular velocity of the load, providing the determined position or speed of the movable structure, the determined sway angle of the load or angular velocity of the load and the output of the state-feedback controller to an observer, producing with the observer at least two estimated state variables, forming a feedback vector from the estimated state variables or from the estimated state variables together with determined state variables, using the formed feedback vector as a feedback for the state-feedback controller, and providing the output of the controller to a frequency converter.

Description

FIELD OF THE INVENTION

The invention relates to control of overhead cranes, and particularly to swayless control of an overhead crane using a frequency converter.

BACKGROUND OF THE INVENTION

Overhead cranes are widely used for material handling in many industrial areas, including factories, steelworks and harbors. An overhead crane contains a trolley, which moves on rails along a horizontal plane. The rails on which the trolley moves are attached to a bridge which is also a movable structure. FIG. 1 shows a typical overhead crane. The payload is connected to the trolley with a cable which length varies when hoisting the payload.

There are two directions of motion known as the trolley and the long-travel movement as shown in FIG. 1. As overhead cranes are flexible in nature, the payload tends to oscillate when moving the load or as a result of external disturbances such as wind. Naturally, these uncontrolled oscillations cause safety hazards and make the transportation and unloading of loads problematic. Since extremely light damping is characteristic for overhead cranes, the accurate positioning of the load is difficult and thereby reduces productivity. In order to compensate the large payload oscillations induced by commanded motions, automatic sway controllers, often referred to as “anti-sway” controllers, have been developed. The task of the anti-sway controller is to eliminate the residual swaying of the load and thereby enable faster transportation of the load. The aforementioned crane function is often referred to as “swayless” crane control.

An anti-sway controller can be designed for speed and position control modes. A speed controlled crane follows a given speed reference whereas in the position control mode the crane moves to a given reference position. As many industrial processes and operations are becoming more and more automated and intelligent, the interest for fully-automated cranes is growing as well. Such cranes require point-to-point positioning and, hence, the anti-sway position control mode.

A swayless position controller for an overhead crane can be implemented with open-loop and closed-loop methods. However, since open-loop control is based on anticipatory suppression of oscillations by modifying a reference command, it cannot compensate initial swaying of the load nor oscillations caused by external disturbances such as wind. A traditional approach for solving the aforementioned problems is combining open-loop methods such as command shaping with closed-loop feedback control. As external disturbances such as wind mainly effect only the movement of the payload, a sway angle or sway velocity measurement is needed for feedback to maximize robustness against such disturbances. Additionally, the position or speed of the movable structure, such as the trolley or the bridge, is typically measured in order to enhance positioning accuracy. The sway angle measurement is, however, noisy. Even though the sensor technologies for measuring the sway angle are slowly developing, the implementation of a precise, low cost and noise-free sway angle measurement is difficult.

Multiple closed-loop control schemes are presented in the literature, which utilize the sway angle measurement. Commonly closed-loop anti-sway methods use linear control theory in the feedback-loop design. A typical approach is using separate P/PD/PI/PID compensators for controlling the position/speed of the movable structure and the swaying of the load, respectively. However, implementing the feedback controller by combining separate controllers can be complicated and lead to undesired positioning dynamics, like overshoot. Moreover, using a separate PD/PI/PID controller for controlling the sway angle does not consider sway angle measurement noise.

It is thus desirable to develop a swayless position controller for an overhead crane, which enables precise and smooth positioning without any residual swaying even in windy conditions.

BRIEF DESCRIPTION OF THE INVENTION

An object of the present invention is to provide a method and an arrangement for implementing the method so as to overcome the above problems. The objects of the invention are achieved by a method and an arrangement which are characterized by what is stated in the independent claims. The preferred embodiments of the invention are disclosed in the dependent claims.

The invention is based on the idea of using a model-based control method in controlling the position of an overhead crane. In the model-based control method, such as state-space control, a physical model of the overhead crane is employed. With a state-space controller, both the position of the movable structure as well as the sway angle of the load can be controlled with a single feedback vector.

The use of state-space control gives freedom to place all the closed-loop poles as desired. In state-space control a high number of sensors is needed to measure all the states of the system. However, the number of sensors needed can be reduced by using estimates for some of the state variables. In the invention, another dynamical system called the observer or estimator is employed. The observer is used to produce estimates of the state variables of the original system, for which there are no measurements. Further, according to an alternative an observer employed filter out measurement noise and thereby increase the robustness of the control system. The signal from the sway angle measurement can also be low-pass filtered before the measurement signal is fed to an observer. The measurement noise is preferably filtered out from feedback signals like the sway angle measurement.

An advantage of the method and arrangement of the invention is that the overhead crane can be controlled to a desired position without residual sway of the load even when disturbances, such as wind, influence on the load of the crane.

BRIEF DESCRIPTION OF THE DRAWINGS

In the following the invention will be described in greater detail by means of preferred embodiments with reference to the attached drawings, in which

FIG. 1 shows an example of an overhead crane;

FIG. 2 shows a high-level block diagram of closed-loop swayless position control of an overhead crane;

FIG. 3 shows an overhead crane model for trolley movement;

FIG. 4 shows force of the wind acting on the pendulum;

FIG. 5 shows basic principle of swayless position control of an overhead crane when using a variable speed drive controlled AC motor as the actuator;

FIG. 6 shows a block diagram of a state feedback controller with integral action;

FIG. 7 shows a block diagram of combining state feedback control with a reduced-order observer;

FIG. 8 shows a block diagram of combining state feedback control with a full-order observer;

FIG. 9 shows an example of a block diagram of converting the position controller output to a torque reference using the speed controller of the drive;

FIG. 10 shows a block diagram of the 2DOF crane position controller;

FIG. 11 shows a position reference and the corresponding speed profile created by an interpolator;

FIG. 12 shows an example of a discrete-time implementation of a state-space model; and

FIG. 13 shows an example of positioning control with changing wind.

DETAILED DESCRIPTION OF THE INVENTION

In the following, it is described in detail, how an observer-based state-space control is structured for swayless control of overhead cranes. Since state-space control is a model-based control method, a physical model of an overhead crane is derived from its equations of motion and presented in state-space form. Further, the effects of wind disturbances acting on the crane pendulum are modelled and the state-space control and state observer design for the swayless position controller of the invention is presented. In the following description, the state-space control is described in connection with a trolley of an overhead crane. However, the invention relates to control of a movable structure of an overhead crane. The movable structure can be either the trolley of the crane or the bridge of the crane. In an overhead crane typically the movement of both the trolley and the bridge are controlled. Thus the crane comprises two separate controllers, one for controlling the trolley and another for controlling the bridge.

According to an embodiment a motion profile generator is combined with the observer-based state-space controller to form a two-degree-of-freedom (2DOF) control structure. In addition, different embodiments for integrating the swayless position controller with the actuator by utilizing the internal control loops of a variable speed drive are discussed.

FIG. 2 shows a high-level block diagram of a swayless position control system of the overhead crane of the disclosure. The input of the system is a position reference for the trolley. In the example of FIG. 2, the swayless position controller uses the two measured output signals, i.e. sway angle and position, as feedback and computes a control reference for the actuator. The actuator reference is calculated in the invention to drive the trolley to the reference position in a manner, which leaves no residual swaying even under external disturbances. Further, by generating a mechanical force F_x, the actuator drives the trolley to the target position in accordance with the actuator reference set by the swayless position controller.

In the invention, model-based control method is used for the swayless position controller and a model of the crane system under consideration is created. A nonlinear physical model of an overhead crane is derived from its equations of motion and presented in state-space form. The non-linear model is used in the simulations to demonstrate the operation of the controller. The effect of wind disturbances on the system is modelled as a force acting on the pendulum and is included in the nonlinear model. Further, a linearized model of the system in state-space form is formed and used for controller design purposes.

A model of the overhead crane for the trolley movement is shown in FIG. 3. The actuator output force F_x used to drive the trolley causes the payload to oscillate around the cable-trolley attachment point and the payload is treated as a one-dimensional pendulum. The trolley and the payload are considered as point masses and the tension force, which may cause the hoisting cable to elongate, is ignored. In addition, it is assumed that there is no friction in the system.

In FIG. 3 L is the length of the cable. The mass and position of the trolley are M and x, respectively. The sway angle and the mass of the payload are θ and m, respectively. The position vectors of the payload and trolley on a two-dimensional plane can be defined as

s _L ={x+L sin(θ)), −L cos(θ)}  (1)

s _T ={x,0}  (2)

The kinetic energy of the overhead crane system is

$\begin{array}{cc}\begin{array}{c}{E}_k=\frac{1}{2}M{\stackrel{.}{s}}_T·{\stackrel{.}{s}}_T+\frac{1}{2}m{\stackrel{.}{s}}_L·{\stackrel{.}{s}}_L\\ =\frac{1}{2}M{\stackrel{.}{x}}^2+\frac{1}{2}m\left[{\left({\stackrel{.}{x}}^2+\stackrel{.}{L}\sin \left(\theta \right)+L\stackrel{.}{\theta }\cos \left(\theta \right)\right)}^2+{\left(-\stackrel{.}{L}\cos \left(\theta \right)+L\stackrel{.}{\theta }\sin \left(\theta \right)\right)}^2\right]\end{array}& \left(3\right)\end{array}$

The potential energy is

U=−mgL cos(θ)  (4)

where g is the gravitational acceleration.

The Euler-Lagrange equation is used in characterizing the dynamic behavior of the crane system and it is defined as follows:

$\begin{array}{cc}\frac{d}{\mathrm{dt}}\left(\frac{\partial ℒ}{\partial {\stackrel{.}{q}}_i}\right)-\frac{\partial ℒ}{\partial q_i}=F_i,i=1,2& \left(5\right)\end{array}$

where =E_lr−U is the Lagrangian and the generalized forces corresponding to the generalized displacements

q={x,θ}

are

F={F _x ,F _θ}.

The generalized displacement coordinates are the chosen variables which describe the crane system. The viscous damping force Fe is defined as

F _θ =−bL{dot over (θ)}  (6)

where b is the damping coefficient.

The equations of motion are obtained by solving Lagrangian's equation (5):

(m+M){umlaut over (x)}+mL{umlaut over (θ)} cos(θ)+m{dot over (L)}{dot over (θ)} cos(θ)−mL{dot over (θ)}² sin(θ)=F_x  (7a)

mL(L{umlaut over (θ)}+g sin(θ)+2{dot over (θ)}{dot over (L)}+{umlaut over (x)} cos(θ))=−bL{dot over (θ)}  (7b)

The desired positioning controller has to be able to compensate wind disturbances coming from the same or opposite direction as the payloads direction of motion. FIG. 4 describes the impact of such wind disturbances on the pendulum in steady state.

In FIG. 4 F_t is the tangential component of the gravitational force F_g. It describes the force, which the wind needs to overcome to be able to deviate the sway angle by the amount of θ₀ in steady state. Now we can approximate the effect of the wind on the pendulum by defining the tangential force component of the wind F_w as

F _w =−F _t =mg sin(θ₀)  (9)

The equations of motion (7a) can now be completed by adding the steady state tangential force component F_w of the wind to the equations

(m+M){umlaut over (x)}+mL{umlaut over (θ)} cos(θ)+m{dot over (L)}{dot over (θ)} cos(θ)−mL{dot over (θ)}² sin(θ)=F_x  (7a)

mL(L{umlaut over (θ)}+g sin(θ)+2{dot over (θ)}{dot over (L)}+{umlaut over (x)} cos(θ))=−bL{dot over (θ)}  (7b)

The idea of the disclosure is to use state-space methods for designing a swayless position controller. For this reason, the equations of motion (10a) and (10b) are expressed as state equations, i.e., functions of state variables, actuator output force F_x and wind disturbance force F. Since Eqs. (10a) and (10b) contain nonlinear functions and do not have a finite number of analytical solutions, first a nonlinear state-space model of the system is created. However, the equations of motion can be linearized with reasonable assumptions, which will be explained later. Linearizing the system model enables to use linear analysis in the controller design and the linear model is used as a starting point for the observer-based state-space swayless position controller development of the invention. Before forming the state equations of a system, the state variables of the state vector x are chosen first.

Based on the system described in (10a), the state vector x is defined as follows:

$\begin{array}{cc}x=\left[\begin{array}{c}\begin{array}{c}\begin{array}{c}p\\ \theta \end{array}\\ \stackrel{.}{p}\end{array}\\ \stackrel{.}{\theta }\end{array}\right]=\left[\begin{array}{c}\begin{array}{c}\begin{array}{c}p\\ \theta \end{array}\\ v\end{array}\\ \Omega \end{array}\right]=\left[\begin{array}{c}\begin{array}{c}\begin{array}{c}\mathrm{trolley}\mathrm{position}\\ \mathrm{swing}\mathrm{angle}\end{array}\\ \mathrm{trolley}\mathrm{velocity}\end{array}\\ \mathrm{angular}\mathrm{velocity}\end{array}\right]& \left(12\right)\end{array}$

and the state equations of the nonlinear crane system are

$\begin{array}{cc}\begin{array}{c}x=\left[\begin{array}{c}\begin{array}{c}\begin{array}{c}\stackrel{.}{p}\\ \stackrel{.}{\theta }\end{array}\\ \ddot{p}\end{array}\\ \ddot{\theta }\end{array}\right]\\ \mathrm{where}\\ \stackrel{.}{p}=v\stackrel{.}{\theta }=\Omega \ddot{p}=\frac{F_x+\cos \left(\theta \right)\left(m\stackrel{.}{L}\stackrel{.}{\theta }+mL{\stackrel{.}{\theta }}^2\sin \left(\theta \right)-\frac{F_w}{L}+b\stackrel{.}{\theta }+\mathrm{mg}\sin \left(\theta \right)\right)}{\left(m+M-m{\cos \left(\theta \right)}^2\right)}\ddot{\theta }=\frac{1}{L}\left(\frac{F_w}{m_L}-\frac{b\stackrel{.}{\theta }}{m}-g\sin \left(\theta \right)-2\stackrel{.}{L}\stackrel{.}{\theta }-\cos \left(\theta \right)\left(\frac{F_x+\cos \left(\theta \right)\left(m\stackrel{.}{L}\stackrel{.}{\theta }+mL{\stackrel{.}{\theta }}^2\sin \left(\theta \right)-\frac{F_w}{L}+b\stackrel{.}{\theta }+\mathrm{mg}\sin \left(\theta \right)\right)}{\left(m+M-m{\cos \left(\theta \right)}^2\right)}\right)\right)\end{array}& \left(13\right)\end{array}$

The nonlinear equations of motion (13) are linearized with the following assumptions. It is assumed that the swing angles are small and the cable length is kept constant, and the sine and cosine terms are approximated with the first terms of their Taylor polynomials, thus sin(x)≈x and cos(x)≈0. The approximation error is less than 1% when θ<14° and less than 5% when θ=30°. In addition, due to the small swing angle, the square of the derivative of the swing angle is approximated to be zero, i.e. {dot over (θ)}²≈0.

Since extremely light damping is characteristic for overhead cranes it is assumed for the linearized equations of motion that the damping ratio b is zero. Additionally, the wind disturbance force F_w and the changes in cable length, i.e. derivative of L are omitted.

As the linearized model is used for the controller design, the actuator output force F_x is denoted directly as the position controller output F_x,ref in the linearized equations. Based on these aforementioned approximations, the equations of motion are written in the following form:

$\begin{array}{cc}\left(m+M\right)\ddot{p}+mL\ddot{\theta }=F_{x,\mathrm{ref}}& \left(14a\right)\\ \ddot{\theta }+\frac{g}{L}\theta +\frac{\ddot{p}}{L}=0& \left(14b\right)\end{array}$

The linearized equations of motion, are now be presented as state equations

$\begin{array}{cc}\stackrel{.}{x}=\left(\begin{array}{c}\begin{array}{c}\begin{array}{c}\stackrel{.}{p}\\ \stackrel{.}{\theta }\end{array}\\ \ddot{p}\end{array}\\ \ddot{\theta }\end{array}\right)=\left(\begin{array}{c}\begin{array}{c}\begin{array}{c}v\\ \Omega \end{array}\\ \frac{\mathrm{mg}}{M}\theta +\frac{1}{M}F_{x,\mathrm{ref}}\end{array}\\ -\frac{g\left(M+m\right)}{\mathrm{ML}}\theta -\frac{1}{\mathrm{ML}}F_{x,\mathrm{ref}}\end{array}\right)& \left(15\right)\end{array}$

Equation (15) can also be expressed in the general state-space matrix form

$\begin{array}{cc}\{\begin{array}{c}\stackrel{.}{x}=\mathrm{Ax}+{\mathrm{BF}}_{x,\mathrm{ref}}\\ p=\mathrm{Cx}\end{array}& \left(16a\right)\end{array}$

where the system matrix A describes the internal dynamics of the system and the input vector B describes the impact of the control signal F_x,ref on the state variables. A and B are defined based on Eqs. (15) and (16a) as

$\begin{array}{cc}A=\left[\begin{array}{cccc}0& 0& 1& 0\\ 0& 0& 0& 1\\ 0& \frac{\mathrm{mg}}{M}& 0& 0\\ 0& -\frac{\left(M+m\right)g}{\mathrm{ML}}& 0& 0\end{array}\right]& \left(16b\right)\\ B=\left[\begin{array}{c}\begin{array}{c}\begin{array}{c}0\\ 0\end{array}\\ \frac{1}{M}\end{array}\\ -\frac{1}{\mathrm{ML}}\end{array}\right]& \left(16c\right)\end{array}$

Since the trolley position is set as the system output, the output matrix C can be defined as

C=[1 0 0 0]  (16d)

The linear state-space model of the system presented in Eqs. (16a . . . 16d) is used for the position controller design of the invention

In the disclosure, the swayless position controller is designed to be combined with a variable speed drive controlled AC motor as the actuator. Furthermore, it is assumed that the variable speed drive is capable of precise and fast torque control. The swayless positioning of an overhead crane is thereby based on cascade control, where the inner loop is the fast torque controller of the drive and the outer loop is a slower swayless position controller. The integration of the swayless position controller to the overhead crane control system is shown in FIG. 5.

As mentioned above, the crane system under consideration has two determined output signals, which according to an embodiment are the position of the trolley p and the sway angle of the payload θ. The trolley position reference p_ref is used as input. The swayless position controller uses the two determined output signals as feedback and calculates the force F_x,ref required to drive the trolley to the reference position in accordance with the acceleration and speed limitations of the crane and without residual swaying of the payload even in windy conditions. In the force-to-torque conversion block, the output F_x,ref of the position controller is converted into a torque reference T_ref and fed to the torque control loop of the drive as shown is FIG. 5. The operation of the force-to-torque conversion block is explained below in more detail. The torque controller adjusts the drives output voltage u_m, which is fed to the motor of the trolley. The voltage u_m controls the motor to generate the desired mechanical torque, and thereby the desired force initially set by the position controller, on the trolley. As a result, the mechanical torque of the motor drives the trolley to the target position with dynamics set by the swayless position controller.

The torque controller and the motor of the trolley are not described in detail, as the torque control is assumed to be accurate and much faster than the swayless position controller. In addition, the transmission line of the trolley is omitted as well. The control system is designed by using directly the swayless position controller output force F_x,ref for the crane positioning.

The implementation of two-degrees-of-freedom crane positioning with observer-based state-space control capable of withstanding external disturbances such as wind is presented in the following. The controller design is performed in continuous-time as it simplifies taking into account the characteristic physical phenomena of the system, such as the natural resonance frequency, in the control analysis. First, analytical expressions for the gain values of the state-space controller are derived by assuming all states are measured. Next, two different state observer approaches for utilizing the two measurement signals of the crane system are introduced and analytical expressions for their gain values are presented. The second degree-of-freedom is added to the control structure by developing a technique to create a smooth positioning profile out of a step input reference. And finally, the designed observer-based state-space controllers are implemented in discrete-time.

The structure of the swayless position state-space controller of the crane is shown in FIG. 6. The crane dynamics are modelled for the position controller based on the state-space model of Eqs. (16a . . . 16d). The state variables are the position of the trolley p, the speed of the trolley {dot over (p)}, the angle of the sway θ and the angular velocity of the sway {dot over (θ)}. The controller output is the desired force F_x,ref to be applied to the trolley. In the controller structure presented in the example of FIG. 6, the closed-loop poles are placed with the feedback gain vector K and with the integrator gain k_i. The feedforward gain k_ff for the position reference p_ref gives one additional degree-of-freedom for placing the closed-loop zeros.

The integral action is added to the control system as it is needed to remove the steady-state error in input reference tracking. Now the state-space description of (16a . . . 16d) can be augmented with an integral state

x _i=∫(p−p_ref)dt  (17)

The idea is to create a state within the controller that computes the integral of the error signal e=p−p_ref, which is then used as a feedback term.

The derivative of the integral state can be expressed based on the position reference and the state variables

{dot over (x)} _i =p−p _ref =Cx−p _ref  (18)

Now the control law of the augmented closed-loop system is

F _x,ref =−Kx−k _i x _i +k _ff p _ref  (19)

Based on the expressions of the derivative (18) of the integrator state, the control law (19) and the open-loop state space model (16a . . . 16d) the closed-loop state-space description of the control system is presented in the following form

$\begin{array}{cc}\{\begin{array}{c}\stackrel{.}{x}=\mathrm{Ax}+B\left(-\mathrm{Kx}-k_ix_i+k_{\mathrm{ff}}p_{\mathrm{ref}}\right)\\ {\stackrel{.}{x}}_i=\mathrm{Cx}-p_{\mathrm{ref}}\\ p=\mathrm{Cx}\end{array}& \left(20\right)\end{array}$

The augmented closed-loop state-space model is written in matrix format as

$\begin{array}{cc}\left[\begin{array}{c}\stackrel{.}{x}\\ {\stackrel{.}{x}}_i\end{array}\right]=\underset{\tilde{A}}{\underset{}{\left[\begin{array}{cc}A-\mathrm{BK}& -{\mathrm{Bk}}_i\\ C& 0\end{array}\right]}}\left[\begin{array}{c}x\\ x_i\end{array}\right]+\underset{\tilde{B}}{\underset{}{\left[\begin{array}{c}{\mathrm{Bk}}_{\mathrm{ff}}\\ -1\end{array}\right]}}p_{\mathrm{ref}}& \left(21a\right)\\ \begin{array}{cc}p=& \underset{\tilde{C}}{\underset{}{\begin{array}{cc}[C& 0]\end{array}}}\left[\begin{array}{c}x\\ x_i\end{array}\right]\end{array}& \left(21b\right)\end{array}$

where à is the closed-loop system matrix, {tilde over (B)} is the input matrix of the closed-loop system and {tilde over (C)} is the output matrix of the closed-loop system. Since the system has four state variables, the feedback vector K is defined as

K=[k₁k₂k₃k₄]  (22)

The transfer function of the closed-loop system can be solved from the closed-loop state-space model of Eqs. (21a) and (21b)

$\begin{array}{cc}G\left(s\right)=\frac{p\left(s\right)}{p_{\mathrm{ref}}\left(s\right)}={\tilde{C}\left(\mathrm{sI}-\tilde{A}\right)}^{-1}\tilde{B}=\frac{b_3s^3+b_2s^2+b_1s+b_0}{s^5+a_4s^4+a_3s^3+a_2s^2+a_1s+a_0}& \left(23\right)\end{array}$

where the characteristic equation is

C(s)=det(sI−Ã)=s⁵+a₄s⁴+a₃s³+a₂s²+a₁s+a₀  (24)

The coefficients for the numerator polynomial of the closed-loop transfer function can be solved from Eq. (24)

$\begin{array}{cc}{b}_3=\frac{k_{\mathrm{ff}}}{M}& \left(25a\right)\\ b_2=\frac{k_i}{M}& \left(25b\right)\\ b_1=\frac{{\mathrm{gk}}_{\mathrm{ff}}}{\mathrm{LM}}& \left(25c\right)\\ b_0=\frac{{\mathrm{gk}}_i}{\mathrm{LM}}& \left(25d\right)\end{array}$

The coefficients of the characteristic equation are solved similarly from Eq. (24)

$\begin{array}{cc}{a}_0=\frac{{\mathrm{gk}}_i}{\mathrm{LM}}& \left(26a\right)\\ a_1=\frac{{\mathrm{gk}}_1}{\mathrm{LM}}& \left(26b\right)\\ a_2=\frac{{\mathrm{Lk}}_i+{\mathrm{gk}}_3}{\mathrm{LM}}& \left(26c\right)\\ a_3=\frac{\mathrm{mg}-k_2+\mathrm{Mg}+{\mathrm{Lk}}_1}{\mathrm{LM}}& \left(26d\right)\\ a_4=\frac{{\mathrm{Lk}}_3-k_4}{\mathrm{LM}}& \left(26e\right)\end{array}$

As can be seen from Eqs. (26a . . . 26e), the closed-loop system dynamics or in other words the coefficients of the characteristic equation, can be defined based on the state feedback coefficients k₁ . . . k₄ and the integrator gain k_i. Additionally, a closed-loop zero can be placed with the feedforward gain k_ff.

Choosing the closed-loop pole locations can be challenging. However, some tools for finding the appropriate closed-loop pole locations for a crane system are known in the art. The most common ones are LQ (linear quadratic) control and analytical pole placement methods where the closed-loop poles are placed using the open-loop and the desired closed-loop characteristics (e.g., resonance damping, rise time and overshoot) of the system. Since the open-loop characteristics such as the natural resonance frequency can be easily identified from the overhead crane system in question, an analytical pole placement method, which uses the open-loop pole locations as a starting point, is used for the state-space controller design.

The linearized open-loop crane system has two poles in the origo and one undamped pole pair at its natural resonance frequency (s=±jωn). Now the five poles of the closed loop characteristic equation (24) are divided into a pair of complex poles (resonant poles), a pair of real poles (dominant poles) and a single pole (integrator pole). The characteristic equation of such a system is

C(s)=(s+ω_i)(s+ω_d)²(s²+2ξ_rω_rs+ω_r²)  (27)

where ω_d is the dominant pole frequency, ω_i is the integrator pole frequency, ω_r is the resonant pole frequency and ξ_r is the damping ratio for the resonant pole frequency.

When the coefficients of the characteristic polynomial Eq. (24) of the closed-loop system are set to equal the desired coefficients Eq. (27) of the closed-loop system, the integrator gain k_i and the coefficients of the feedback gain matrix K can be solved

$\begin{array}{cc}{k}_1=\frac{\left(2{\xi }_r{\omega }_d^2{\omega }_i{\omega }_r+{\omega }_d^2{\omega }_r^2+2{\omega }_d{\omega }_i{\omega }_r^2\right)\mathrm{LM}}{g}& \left(28a\right)\\ k_2=g\left(m+M\right)+{\mathrm{Lk}}_1-\left({\omega }_r^2+4{\xi }_r{\omega }_d{\omega }_r+{\omega }_d^2+2{\xi }_r{\omega }_r{\omega }_i+2{\omega }_d{\omega }_i\right)\mathrm{LM}& \left(28b\right)\\ k_3=\frac{\left({\omega }_i{\omega }_r^2+2{\omega }_d{\omega }_r^2+{\omega }_d^2{\omega }_i+2{\xi }_r{\omega }_r{\omega }_d^2+4{\xi }_r{\omega }_d{\omega }_r{\omega }_i+2{\omega }_d{\omega }_i\right)\mathrm{LM}-{\mathrm{Lk}}_i}{g}& \left(28c\right)\\ k_4={\mathrm{Lk}}_3-\left(2{\xi }_r{\omega }_r+{\omega }_i+2{\omega }_d\right)\mathrm{LM}& \left(28d\right)\\ k_i=\frac{{\omega }_d^2{\omega }_i{\omega }_r^2\mathrm{LM}}{g}& \left(28e\right)\end{array}$

Since the natural resonance frequency ω_n is directly proportional to the length of the cable, the closed-loop pole frequencies ω_r, ω_d and are expressed as functions of ω_n. The idea of the state-space crane position control is to keep the speed curve of the trolley smooth and the control effort F_x,ref reasonable by placing the closed-loop poles appropriately. The control effort of the controller is proportional to the amount the open-loop poles are moved on the complex plane. When the cable is long and thereby the natural resonance frequency is low, the poles are moved closer to the origo on the left side of the complex plane. On the contrary, with a shorter cable the natural period of the pendulum is shorter so the trolley can be controlled with faster dynamics (poles closer to origo). In other words linking the pole locations to the length of the cable ensures desired closed-loop dynamics in all operating points.

The natural period of the crane pendulum r is defined as

$\begin{array}{cc}\tau =2\pi \sqrt{\frac{L}{g}}& \left(29\right)\end{array}$

and the natural resonance frequency as

$\begin{array}{cc}{\omega }_n=\frac{2\pi }{\tau }& \left(30\right)\end{array}$

As mentioned before, the open-loop resonant pole pair has zero damping. To optimize control effort, it is desired to leave the resonant pole pair at the natural resonance frequency (ω_r=ω_n). This way the control effort is used to damp the resonating pole pair by tuning its damping ratio ξ_r. The pair of complex resonant poles s_ωr1,2 can be placed in the following way

s _ωr1,2=−ξ_rω_r±ω_r√{square root over (ξ_r²−1)}  (31)

The dominant pole pair can now be used to adjust the desired dominant dynamics of the closed-loop system. The dominant pole frequency can be presented as

ω_d=dω_n  (32)

where d is the dominant pole frequency coefficient. The integrator pole frequency needs to be higher than ω_d and ω_r and it is defined as

ω_i=pω_n  (33)

where p>d is the integrator pole frequency coefficient.

The feedback gains k₁ . . . k₄ and the integrator gain k₁ are defined based on the closed-loop pole placement. With the feedforward gain k_ff a zero is placed to the closed-loop system which can enhance the closed-loop step response. One natural way to place the zero is to cancel one of the poles of the system with it. The dominant pole pair is at the frequency ω_d so by defining the feedforward gain as

$\begin{array}{cc}{k}_{\mathrm{ff}}=\frac{{\omega }_d{\omega }_i{\omega }_r^2\mathrm{LM}}{g}& \left(34\right)\end{array}$

one of the dominant poles s=−ω_d can be compensated.

Now as the equations for the controller gains k₁ . . . k₄, k₁ and k_ff have been derived, the swayless position controller output can be solved based on Eqs. (28a . . . 28e) and (34) as

F _x,ref =−Kx−k _i x _i +k _ff p _ref  (35)

As mentioned above in connection with the state-space controller design, it is assumed that all the state variables are known (measured) at all times. Since the crane system of the disclosure has only measurements for two state variables (p and θ), a state observer for estimating the remaining two state variables ({dot over (p)} and {dot over (θ)}) based on the controller output F_x,ref and the output measurements is employed. As mentioned above, implementing an accurate and noise-free sway angle measurement is known to be problematic.

According to embodiments of the invention, state observer used in the invention is either a reduced-order observer or a full-order observer. A reduced-order state observer has less filtering capability for a noisy measurement input whereas finding its optimal observer pole locations is quite straightforward. On the other hand, a full-order observer has the ability to filter measurement noise much more effectively but finding its optimal pole locations can be more complicated.

The block diagram of combining state-feedback control with a reduced-order observer is shown in FIG. 7. Before defining the equations for the reduced-order observer, some of the system matrixes introduced above have to be arranged into a slightly different form. As mentioned before, the actual system has two output measurements, which are the position of the trolley and the sway angle of the cable. Now two separate output matrixes are created

$\begin{array}{cc}{C}_m=\left[\begin{array}{cccc}1& 0& 0& 0\\ 0& 1& 0& 0\end{array}\right]\mathrm{and}& \left(36\right)\\ C_e=\left[\begin{array}{cccc}0& 0& 1& 0\\ 0& 0& 0& 1\end{array}\right]& \left(37\right)\end{array}$

where C_m is the output matrix for the two measured state variables and C_e is the output matrix for the two state variables that are estimated using the reduced-order observer. Now the measured states x_m can be defined as

$\begin{array}{cc}{x}_m=C_mx=\left[\begin{array}{c}{x}_1\\ x_2\end{array}\right]=\left[\begin{array}{c}p\\ \theta \end{array}\right]& \left(38\right)\end{array}$

and the estimated states as

$\begin{array}{cc}{\hat{x}}_{\mathrm{ro}}=C_ex=\left[\begin{array}{c}{\hat{x}}_3\\ {\hat{x}}_4\end{array}\right]=\left[\begin{array}{c}\stackrel{\stackrel{.}{^}}{p}\\ \stackrel{\stackrel{.}{^}}{\theta }\end{array}\right]& \left(39\right)\end{array}$

As can be seen from FIG. 7, the designed reduced-order observer takes the controller output F_x, and the two measured states x_m as input and estimates the remaining two state variables {circumflex over (x)}_ro. The output of the reduced-order observer is the estimated state matrix {circumflex over (x)}, which is a combination of the two measured states and the two estimated states:

$\begin{array}{cc}\hat{x}=\left[\begin{array}{c}{x}_m\\ {\hat{x}}_{\mathrm{ro}}\end{array}\right]=\left[\begin{array}{c}p\\ \theta \\ \stackrel{\stackrel{.}{^}}{p}\\ \stackrel{\stackrel{.}{^}}{\theta }\end{array}\right]& \left(40\right)\end{array}$

Based on the two output matrixes C_m and C_e, two more matrixes are defined for the reduced-order observer with the notation

$\begin{array}{cc}{\left[\begin{array}{c}{C}_m\\ C_e\end{array}\right]}^{-1}=\left[L_1L_2\right]& \left(41\right)\end{array}$

The matrixes L₁ and L₂ can now be solved based on Eq. (41) as

$\begin{array}{cc}{L}_1=\left[\begin{array}{cc}1& 0\\ 0& 1\\ 0& 0\\ 0& 0\end{array}\right]& \left(42\right)\\ L_2=\left[\begin{array}{cc}0& 0\\ 0& 0\\ 1& 0\\ 0& 1\end{array}\right]& \left(43\right)\end{array}$

Now we can define a reduced-order observer {circumflex over ({dot over (x)})}_ro for the estimated states {circumflex over (x)}_ro as follows

{circumflex over ({dot over (x)})}_ro=A_ro{circumflex over (x)}_ro+B_roF_x,ref+B_mx_m  (44a)

where

A _ro =C _e AL ₂ −L _fb C _m AL ₂  (44b)

B _ro =C _e B−L _fb C _m B  (44c)

B _m =C _e AL ₂ L _fb +C _e AL ₁ −L _fb C _m AL ₁ −L _fb C _m AL ₂ L _fb  (44d)

In the reduced-order observer Eqs. (44a . . . 44d), the matrix A_ro describes the internal dynamics of the observer and the input vector B_ro describes the impact of the control signal F_x,ref on the estimated state variables {circumflex over (x)}_ro. The input matrix B_m describes the effect of the measured states x_m on the estimated state variables.

The estimates of the state-space variables of the original system are now obtained as

{circumflex over (x)}=L ₂ {circumflex over (x)} _ro+(L₁+L₂L_fb)x_m  (45)

Based on the definition of {circumflex over (x)} in Eq. (45), it is noticed that the reduced-order observer only uses half of the system model for estimation purposes. It estimates only the two states

({circumflex over (x)}_ro=[{dot over ({circumflex over (p)})}{dot over ({circumflex over (θ)})}]^T)

which are not measured. The measured states

(x_m=[pθ]^T)

are only multiplied with the observer feedback gain L_fb and then summed with the estimated states at the output of the observer. In other words, the ability of the reduced-order observer to filter possible noise from a measurement x_m is limited since the observer is not estimating the measured states x_m and thereby not minimizing any estimation error regarding x_m.

The observer feedback gain can be defined based on the dimensions of the reduced-order observer as

$\begin{array}{cc}{L}_{\mathrm{fb}}=\left[\begin{array}{cc}{L}_{\mathrm{fb}11}& L_{\mathrm{fb}12}\\ L_{\mathrm{fb}21}& L_{\mathrm{fb}22}\end{array}\right]& \left(46\right)\end{array}$

The poles of the reduced-order state observer can be placed in the same way as the poles of the state feedback controller. The equations for the observer feedback gain coefficients can be simplified by defining the observer poles as a pair of real poles. The characteristic equation of the reduced-order system matrix A_ro is now

det[sI(C_eAL₂−L_fbC_mAL₂)]=(s+ω_ro)²  (47)

where ω_ro is the reduced-order observer pole pair.

Based on the characteristic equation (47), the observer feedback gain coefficients can be solved as

L _fb11=ω_ro  (48a)

L _fb12=0  (48b)

L _fb22=0  (48c)

L _fb12=ω_ro  (48d)

An alternative for the reduced-order observer, a full order-order observer may be employed in the controller structure. The state vector x of the state-space model (16a . . . 16d) can be estimated by simulating a model representing the state-space description with the controller output force F_x,ref. The model can contain parameter inaccuracies or there might be external disturbances present, which would result in an erroneous estimate {circumflex over (x)}_fo of the state vector. However, the estimation error (x_m−{circumflex over (x)}_m) can be corrected with a gain matrix L_fo, which leads to a full-order state observer of the following form

$\begin{array}{cc}{\stackrel{\stackrel{.}{^}}{x}}_{\mathrm{fo}}=A{\hat{x}}_{\mathrm{fo}}+{\mathrm{BF}}_{x,\mathrm{ref}}+L_{\mathrm{fo}}\left(x_m-{\hat{x}}_m\right)=A{\hat{x}}_{\mathrm{fo}}+{\mathrm{BF}}_{x,\mathrm{ref}}+L_{\mathrm{fo}}\left(C_mx-C_m{\hat{x}}_{\mathrm{fo}}\right)& \left(49a\right)\\ {\hat{y}}_{\mathrm{fo}}=I_{4\mathrm{x4}}{\hat{x}}_{\mathrm{fo}}=C_{\mathrm{fo}}{\hat{x}}_{\mathrm{fo}}& \left(49b\right)\end{array}$

where C_fo is the output matrix of the full-order observer. The block diagram of combining state feedback control with the full-order observer is shown in FIG. 8. Based on the state-space model (16a . . . 16d) and the full-order state observer (49a . . . 49b) the dynamics of the estimation error of the state variables {tilde over (x)}=x−{circumflex over (x)}_fo can be presented as

$\begin{array}{cc}\stackrel{\stackrel{.}{~}}{x}=\stackrel{.}{x}-{\stackrel{\stackrel{.}{^}}{x}}_{\mathrm{fo}}=\mathrm{Ax}+{\mathrm{BF}}_{x,\mathrm{ref}}-\left[A{\hat{x}}_{\mathrm{fo}}+{\mathrm{BF}}_{x,\mathrm{ref}}+L_{\mathrm{fo}}\left(C_mx-C_m{\hat{x}}_{\mathrm{fo}}\right)\right]=\mathrm{Ax}-L_{\mathrm{fo}}C_mx-A{\tilde{x}}_{\mathrm{fo}}+L_{\mathrm{fo}}C_m{\hat{x}}_{\mathrm{fo}}=\left(A-L_{\mathrm{fo}}C_m\right)\left(x-{\hat{x}}_{\mathrm{fo}}\right)& (50\end{array}$

which means

{dot over ({tilde over (x)})}=(A−L_foC_m){tilde over (x)}  (51)

Looking at the full-order observer equations (49a . . . 51), it is seen that the observer estimates also the state-variables which are already measured. If the full-order observer gain L_fo is tuned appropriately to minimize the estimation error, it can provide filtering against noise in the output measurements x_m.

The poles of the full-order observer still need to be placed by deriving equations for the gains of the observer feedback matrix L_fo. Based on the dimensions of the system L_fo is defined as

$\begin{array}{cc}{L}_{\mathrm{fo}}=\left[\begin{array}{cc}{l}_{11}& l_{12}\\ l_{21}& l_{22}\\ l_{31}& l_{32}\\ l_{41}& l_{42}\end{array}\right]& \left(52\right)\end{array}$

The equations for the observer feedback gains can be simplified by defining the full-order observer poles as two pairs of real poles. The characteristic equation of the dynamics of the estimation error is now

det[sI−(A−L_foC_m)]=(s+ω_fo1)²(s+ω_fo2)²  (53)

where ω_fo1 and ω_fo2 are the pole frequencies of the full-order observer. Now the coefficients of the observer feedback gains are solved as

$\begin{array}{cc}{l}_{11}={\omega }_{\mathrm{fo}1}+{\omega }_{\mathrm{fo}2}& \left(54a\right)\\ l_{12}=0& \left(54b\right)\\ l_{21}={\omega }_{\mathrm{fo}1}+{\omega }_{\mathrm{fo}2}& \left(54c\right)\\ l_{22}=0& \left(54d\right)\\ l_{31}=\frac{2{\omega }_{\mathrm{fo}1}^2{\omega }_{\mathrm{fo}2}+2{\omega }_{\mathrm{fo}2}^2-l_{11}\frac{mg}{\mathrm{LM}}+\frac{g}{L}}{2*l_{11}}& \left(54e\right)\\ l_{32}=0& \left(54f\right)\\ l_{41}=0& \left(54g\right)\\ l_{42}=\frac{\sqrt{{g^2\left(m+M\right)}^2+4L^2M^2{\omega }_{\mathrm{fo}2}^2{\omega }_{\mathrm{fo}2}^2}+g\left(m+M\right)}{2*L*M}& \left(54h\right)\end{array}$

As a general rule, the poles of the observer should be 2 . . . 6 times faster than the poles of the state-feedback controller. When the observer is faster than the state feedback controller, it does not constrain the control rate. However, using a fast observer might cause problems when the measurement signal has a lot of noise. The state observer can be designed separately from the state feedback controller but it is important to acknowledge the impact of the observer poles to the dynamics of the entire system. The poles of the controlled system are a combination of poles of the observer and state feedback controller. In other words, the characteristic equation of the entire system is a product of observer poles and state feedback controller poles.

For the observer poles to be in line with the poles of the state feedback controller in all operating points, the observer poles are expressed as functions of the fastest pole cod of the state feedback controller. The reduced-order observer pole pair is defined as

ω_ro=rω_d  (55)

where r is the reduced-order observer pole coefficient.

The two pole pairs ω_fo1 and ω_fo2 of the full-order observer can be defined as

ω_fo1=f₁ω_d  (56)

and

ω_fo2=f₂ω_d  (57)

where f₁ and f₂ are the full-order observer pole coefficients, respectively.

As explained in connection with FIG. 5, the output F_x, of the swayless position controller must still be converted into a torque reference for the torque controller of the drive. The force-to-torque conversion block in FIG. 5 can be implemented using two different approaches: a direct conversion method or a dynamic conversion using the internal speed controller of the variable speed drive. In the direct conversion, the output F_x, of the position controller is converted into a torque reference based on the specifications of the electric motor of the trolley, gear ratio, inertia and friction.

A dynamic force-to-torque conversion procedure is described in connection with FIG. 9. In this procedure, it is assumed that the variable speed drive has a properly tuned internal speed controller. In the most common torque control methods of electric drives, such as the vector control or the direct torque control (DTC), the aforementioned speed controller is needed to form a cascade control structure with the torque control loop where the output of the speed controller is a torque reference for the torque control chain. The input of the speed controller is a motor speed reference. In order to utilize the speed controller of the drive for the force-to-torque conversion, a speed reference v_ref for the trolley movement is first derived based on the position controller output F_x. This is achieved, for example, by first defining the relationship between the acceleration of the trolley and the position controller output force F_x, based on the linearized equations of motion (14a, 14b))

(m+M){umlaut over (p)}+mL{umlaut over (θ)}=F_x,ref  (58)

Two different methods for generating a speed reference for the trolley based the controller output are presented in the following. The first one referred to as the force-to-velocity reference conversion with angular acceleration (F2VwA-method) and the second one will be named as the force-to-velocity reference conversion without angular acceleration (F2V-method).

The F2VwA-method is directly based on Eq. (58) by solving its acceleration

$\begin{array}{cc}\ddot{p}=\frac{F_{x,\mathrm{ref}}-mL\ddot{\theta }}{m+M}& \left(59\right)\end{array}$

The angular acceleration {umlaut over (θ)} can be obtained from the derivative of the estimated angular velocity {dot over (θ)} provided by the state observer. Now using the F2VwA-method the position controller output F_x,ref can be converted into a speed reference for the trolley by simply integrating the equation of the trolley acceleration (59)

$\begin{array}{cc}\stackrel{.}{p}=v_{\mathrm{ref},\mathrm{F2VwA}}=\int \frac{F_{x,\mathrm{ref}}-mL\ddot{\theta }}{m+M}\mathrm{dt}& \left(60\right)\end{array}$

In the F2V-method the linearized equation of motion (58) is approximated even further to omit the estimate of the angular acceleration {umlaut over (θ)}. Since the swayless position controller is required to move the trolley smoothly and in accordance with the acceleration and speed limitations of the crane, the changes in the sway angle during motion are small and occur slowly compared to the cycle time of the position controller. That means the second derivative of the sway angle in Eq. (58) can be approximated to zero. The relationship of trolley acceleration and controller output can be thereby reduced to the following form

$\begin{array}{cc}\ddot{p}=\frac{F_{x,\mathrm{ref}}}{m+M}& \left(61\right)\end{array}$

Now using the F2V-method a speed reference for the trolley can be generated by integrating the equation of the trolley acceleration (61)

$\begin{array}{cc}\stackrel{.}{p}=v_{\mathrm{ref},F2V}=\int \frac{F_{x,\mathrm{ref}}}{m+M}\mathrm{dt}& \left(62\right)\end{array}$

The estimate of the angular acceleration {umlaut over (θ)} can contain noise in case of a noisy sway angle measurement. Therefore, in theory, the F2V-method can be more robust against measurement noise compared to the F2VwA-method. However, in case of a long cable, the speed reference generated using the F2V-method can be inaccurate.

In order to use the speed controller of the drive for the dynamic force-to-torque conversion, the speed reference of the trolley v_ref created with either of the aforementioned methods is converted next into a motor speed reference v_m,ref using only the gear ratio of the transmission line. The motor speed reference v_m,ref is fed to the internal speed controller of the drive as shown in FIG. 9. The speed controller uses the measured or estimated motor speed v_m as feedback and adjusts the motor speed to respond to the speed reference by producing a torque reference T_ref for the fast torque controller.

Carrying out the dynamic force-to-torque conversion by utilizing the internal speed controller of the drive has in theory a few upsides over the direct force-to-torque conversion. First, it needs less information about the mechanics of the system, e.g., the conversion does not require friction compensation or information about the radius of the motor shaft. Secondly, since the dynamic conversion has integral action, it acts as a filter for possible measurement noise and thereby improves robustness. Due to the nature of state feedback control, noisy feedback measurements would cause spikes in the position controller output F_x,ref. The integral action of the dynamic force-to-torque conversion shown in Eqs. (60) and (62) filters the noise before feeding the trolley speed reference v_ref up the control chain. On the contrary, the direct force-to-torque conversion is a static amplification and therefore the possible spikes in the position controller output F_x,ref would result in a more noisy torque reference for the torque controller. In conclusion, using one of the two presented speed reference generation schemes, the dynamic force-to-torque conversion can be performed by utilizing the cascade control structure of a variable speed drive. This way the trolley can be controlled robustly via the speed controller with minimal knowledge of the mechanics of the system.

Motion control systems are often required to enable precise input reference tracking ability while being robust with desired closed-loop dynamics. The conventional solution has been a two-degrees-of-freedom controller, where regulation and command tracking are separately designed. Since the crane position controller should enable precise and smooth positioning without any residual swaying even in windy conditions, the 2DOF control structure is preferred. The observer-based state-space controller designed above is used to stabilize the feedback loop against model uncertainties and external disturbances, such as wind acting on the load of the crane. The feedforward gain k_ff is preferably combined with a motion profile generator to improve the command-tracking ability. The block diagram of the 2DOF crane position controller is shown in FIG. 10. According to an embodiment, the position reference at the input of the controller is modified to a position profile. The obtained position profile limits the speed and acceleration of the trolley as presented below.

An interpolator (IPO) is used for generating the motion profile. The interpolator shapes a position step reference s_ref into a smooth position curve p_re. The output of the interpolator depends on the desired maximum speed and acceleration limits set for the crane as well as the step reference. Now the positioning profile can be generated based on known equations of motion. The duration of the acceleration and deceleration phases is t_acc. The acceleration is defined as

$\begin{array}{cc}{a}_{\mathrm{acc}}=\frac{v_t-v_{\mathrm{act}}}{t_{\mathrm{acc}}}& \left(63\right)\end{array}$

and the deceleration as

$\begin{array}{cc}{a}_{\mathrm{dec}}=\frac{v_t}{t_{\mathrm{acc}}}& \left(64\right)\end{array}$

where v_t is the maximum travel speed of the trolley and v_act is the actual speed.

The acceleration distance s_acc and deceleration distance s_dec can be presented as

$\begin{array}{cc}{s}_{\mathrm{acc}}=v_{\mathrm{act}}t_{\mathrm{acc}}+\frac{a_{\mathrm{acc}}t_{\mathrm{acc}}^2}{2}\mathrm{and}& \left(65\right)\\ s_{\mathrm{dec}}=\frac{a_{\mathrm{dec}}t_{\mathrm{acc}}^2}{2}& \left(66\right)\end{array}$

The duration of the constant speed phase is now

$\begin{array}{cc}{t}_c=\frac{s_t-s_{\mathrm{acc}}-s_{\mathrm{dec}}}{v_t}& \left(67\right)\end{array}$

where s_t is the target position. If the duration of the constant speed is less than zero, the constant speed phase will be omitted. As a result, the positioning profile contains only the acceleration and deceleration phases and the new values for the accelerations are

$\begin{array}{cc}{a}_{\mathrm{acc}}=\frac{s_t-2t_{\mathrm{acc}}v_{\mathrm{act}}}{t_{\mathrm{acc}}^2}& \left(68\right)\\ a_{\mathrm{dec}}=\frac{v_{\mathrm{act}}}{t_{\mathrm{acc}}}+a_{\mathrm{acc}}& \left(69\right)\end{array}$

FIG. 11 shows the new position reference created with the interpolator out of a position step reference with different acceleration/deceleration times tact. The corresponding speed profiles are shown in the figure just to illustrate the characteristics of the interpolator. With a position reference s_ref=8 m, constant speed limit of v_t=2 m/s and a ramp time of t_acc=2 s the constant speed phase exists as shown in the FIG. 11. However, by increasing the ramp time to t_acc=5 s the constant speed phase is omitted as the positioning can only consist of the acceleration and deceleration phases. The new accelerations are calculated from Eqs. (68) and (69) and the speed profile is triangular.

The interpolator's positioning profile generated with respect to the maximum speed and acceleration limitations is important when using a state-space controller. The state-space controller has no knowledge of a maximum speed or acceleration limit nor the ability to restrict its control effort with respect to the speed of the trolley. The state-space controller only follows the created position reference with dynamics set by the closed-loop poles. Setting appropriate closed-loop dynamics for input reference tracking ensures that the speed and acceleration limitations of the crane are not violated.

The crane position controller above is presented in continuous-time. However, in practice the controller is implemented digitally with a microprocessor, which is why the discrete-time implementation of the controller is needed. Additionally, the simulation tests are be performed with the discretized control system.

There are multiple known discretization methods, such as the forward Euler approach, Tustin's method and the backward Euler approach. The Tustin's method is often used in practice and it provides satisfactory closed-loop system behavior as long as the sampling intervals are sufficiently small. Since the cycle time of the control program of the positioning controller is only 1 ms-10 ms and the crane system dynamics are relatively slow, the Tustin's method is used below as an example of a discretization approach. Now the control system of the invention can be discretized using Tustin's bilinear equivalent

$\begin{array}{cc}s=\frac{2}{T_s}\frac{1-z^{-1}}{1+z^{-1}}& \left(70\right)\end{array}$

where T_s is the sampling period. For a general state-space representation

$\begin{array}{cc}\{\begin{array}{c}{\hat{x}}^{\prime }=A^{\prime }x^{\prime }+B^{\prime }u^{\prime }\\ y^{\prime }=C^{\prime }x^{\prime }+D^{\prime }u^{\prime }\end{array}& \left(71\right)\end{array}$

the Tustin's method can be written as

w(k+1)=Φw(k)+Γu′(k)  (72a)

y′(k)=Hw(k)+Ju′(k)  (72b)

where w is a modified state vector and the discretized system matrices are

$\begin{array}{cc}\Phi =\left(I+\frac{T_s}{2}A^{\prime }\right){\left(I-\frac{T_s}{2}A^{\prime }\right)}^{-1}& \left(73a\right)\\ \Gamma ={T_s\left(I-\frac{T_s}{2}A^{\prime }\right)}^{-1}B^{\prime }& \left(73b\right)\\ H=T_s{C^{\prime }\left(I-\frac{T_s}{2}A^{\prime }\right)}^{-1}& \left(73c\right)\\ J=D^{\prime }+\frac{T_s}{2}{C^{\prime }\left(I-\frac{T_s}{2}A^{\prime }\right)}^{-1}B^{\prime }& \left(73d\right)\end{array}$

In the state-space controller, only the integrator is discretized using Eqs. (72a . . . 73d) with the following expressions

y′ _i =x′ _i =x _i  (74a)

u′ _i =p−p _ref  (74b)

A′ _i=0  (74c)

B′ _i=1  (74d)

C′ _i=1  (74e)

D′ _i=0  (74f)

Now the discretized system matrixes of the integrator are

$\begin{array}{cc}{\Phi }_i=\left(I+\frac{T_s}{2}A_i^{\prime }\right){\left(I-\frac{T_s}{2}A_i^{\prime }\right)}^{-1}& \left(75a\right)\\ {\Gamma }_i={T_s\left(I-\frac{T_s}{2}A_i^{\prime }\right)}^{-1}B_i^{\prime }& \left(75b\right)\\ H_i=T_s{C_i^{\prime }\left(I-\frac{T_s}{2}A_i^{\prime }\right)}^{-1}& \left(75c\right)\\ J_i=D_i^{\prime }+\frac{T_s}{2}{C_i^{\prime }\left(I-\frac{T_s}{2}A^{\prime }\right)}^{-1}B_i^{\prime }& \left(75d\right)\end{array}$

and the Tustin's method for the discretized integrator can be presented in state-space format

w _i(k+1)=Φ_iw_i(k)+Γ_iu_i(k)  (76a)

y′ _i(k)=H_iw(k)+J_iu_i(k)  (72b)

where w_i is the discrete state vector for the discretized integrator.

In the case of the full-order state observer, the gain matrix L_fo is embedded into system matrices and the state-space matrices for the discretization are

$\begin{array}{cc}{x}_{\mathrm{fo}}^{\prime }={\hat{x}}_{\mathrm{ro}}& \left(77a\right)\\ u_{\mathrm{fo}}^{\prime }=\left[\begin{array}{c}{F}_{x,\mathrm{ref}}\\ x_m\end{array}\right]& \left(77b\right)\\ A_{\mathrm{fo}}^{\prime }=A-L_{\mathrm{fo}}C_m& \left(77c\right)\\ B_{\mathrm{fo}}^{\prime }=\left[\begin{array}{cc}B& L_{\mathrm{fo}}\end{array}\right]& \left(77d\right)\\ C_{\mathrm{fo}}^{\prime }=I_{4\times 4}& \left(77e\right)\\ D_{\mathrm{fo}}^{\prime }=0& \left(77f\right)\end{array}$

Based on Eqs. (77a . . . 77f) the discretized system matrices for the full-order observer are

$\begin{array}{cc}{\Phi }_{\mathrm{fo}}=\left(I_{4\times 4}+\frac{T_s}{2}A_{\mathrm{fo}}^{\prime }\right){\left(I_{4\times 4}-\frac{T_s}{2}A_{\mathrm{fo}}^{\prime }\right)}^{-1}& \left(78a\right)\\ {\Gamma }_{\mathrm{fo}}={T_s\left(I_{4\times 4}-\frac{T_s}{2}A_{\mathrm{fo}}^{\prime }\right)}^{-1}B_{\mathrm{fo}}^{\prime }& \left(78b\right)\\ H_{\mathrm{fo}}=T_s{C_{\mathrm{fo}}^{\prime }\left(I_{4\times 4}-\frac{T_s}{2}A_{\mathrm{fo}}^{\prime }\right)}^{-1}& \left(78c\right)\\ J_{\mathrm{fo}}=D_{\mathrm{fo}}^{\prime }+\frac{T_s}{2}{C_{\mathrm{fo}}^{\prime }\left(I_{4\times 4}-\frac{T_s}{2}A_{\mathrm{fo}}^{\prime }\right)}^{-1}B_{\mathrm{fo}}^{\prime }& \left(78d\right)\end{array}$

and the state-space representation is

w _fo(k+1)=Φ_fow_fo(k)+Γ_fou′_fo(k)  (79a)

y′ _fo(k)=H_fow_fo(k)+J_fou′_fo(k)  (79b)

where w_fo is the discrete state vector for the discretized full-order observer.

Using the Tustin's method, the reduced-order observer can be discretized similarly as the full-order observer with the following notations for its continuous-time state-space representation

$\begin{array}{cc}{x}^{\prime }={\hat{x}}_{\mathrm{ro}}& \left(80a\right)\\ u_{\mathrm{ro}}^{\prime }=\left[\begin{array}{c}{x}_m\\ F_{x,\mathrm{ref}}\end{array}\right]& \left(80b\right)\\ A_{\mathrm{ro}}^{\prime }=A_q& \left(80c\right)\\ B_{\mathrm{ro}}^{\prime }=\left[\begin{array}{cc}{B}_m& B_{\mathrm{ro}}\end{array}\right]& \left(80d\right)\\ C_{\mathrm{ro}}^{\prime }=L_2& \left(80e\right)\\ D_{\mathrm{ro}}^{\prime }=\left[\begin{array}{cc}{L}_1+L_2L_{\mathrm{fb}}& 0\end{array}\right]& \left(80f\right)\end{array}$

Based on Eqs. (80a . . . 80f) the discretized system matrices for the reduced-order observer can be presented as

$\begin{array}{cc}{\Phi }_{\mathrm{ro}}=\left(I_{2\times 2}+\frac{T_s}{2}A_{\mathrm{ro}}^{\prime }\right){\left(I_{2\times 2}-\frac{T_s}{2}A_{\mathrm{ro}}^{\prime }\right)}^{-1}& \left(81a\right)\\ {\Gamma }_{\mathrm{ro}}={T_s\left(I_{2\times 2}-\frac{T_s}{2}A_{\mathrm{ro}}^{\prime }\right)}^{-1}B_{\mathrm{ro}}^{\prime }& \left(81b\right)\\ H_{\mathrm{ro}}=T_s{C_{\mathrm{ro}}^{\prime }\left(I_{2\times 2}-\frac{T_s}{2}A_{\mathrm{ro}}^{\prime }\right)}^{-1}& \left(81c\right)\\ J_{\mathrm{ro}}=D_{\mathrm{ro}}^{\prime }+\frac{T_s}{2}{C_{\mathrm{ro}}^{\prime }\left(I_{2\times 2}-\frac{T_s}{2}A_{\mathrm{ro}}^{\prime }\right)}^{-1}B_{\mathrm{ro}}^{\prime }& \left(81d\right)\end{array}$

Now discretized system matrices of the reduced-order observer can be inserted into the state-space representation

w _fo(k+1)=Φ_fow_fo(k)+Γ_fou′_fo(k)  (82a)

y′ _fo(k)=H_fow_fo(k)+J_fou′_fo(k)  (82b)

where w_fo is the discrete state vector for the discretized full-order observer.

Finally, the discrete-time state-space description of the integrator as well as the full-order and the reduced-order observer can be implemented by using their respective discretized system matrices as shown in FIG. 12.

FIG. 13 shows simulation results of the discretized controller of the invention with changing wind. The upper plot shows the position of the trolley, the middle plot shows speed of the trolley and lower plot shows the angle of the load. Position reference s_ref=25 m is given for the controller and the position reference is changed to a position profile in the manner described above. The simulated position follows the position profile accurately. In the simulation, the wind direction is first opposite to the trolley movement during time t=0 s . . . 7 s. The wind direction changes at time t=7 s . . . 8 s and during time t=8 s . . . 19 s the wind direction is the same as the direction of the trolley movement. Other parameters are L=5 m, m=50 kg, M=80 kg, t_acc=3 s and v_t=2 m/s. The simulation is carried out both with a reduced-order observer (ROOB) and full-order observer (FOOB). It is seen from the simulation results that the control action with the both observers is quite similar.

In the method of the invention a position reference for the movable structure is provided and the position of the movable structure is controlled with a state-feedback controller. The position of the movable structure and sway angle of the load are state variables of the system which is used in the state-feedback controller. Further in the invention, the position or the speed of the movable structure is determined. In the above described embodiments the position of the movable structure is described to be measured. According to an embodiment, the position of the movable structure can also be estimated by using the frequency converter driving the movable structure in a manner known as such. Similarly, in an embodiment, the speed of the movable structure can be estimated. The estimation of speed can be carried out by the frequency converter.

Further in the invention, the sway angle of the load or angular velocity of the load is determined. The determination of the angle or the velocity of the load is preferably carried out by direct measurement.

The determined values, i.e. position or speed of the movable structure and determined sway angle of the load or angular velocity of the load and the output of the state-feedback controller are used as an input to an observer in a manner described above in detail.

The observer produces at least two estimated state variables. The state variables include estimated position of the movable structure, estimated sway angle of the load, estimated speed of the movable structure and the estimated angular velocity of the load.

The estimated state variables are used for forming a feedback vector. Alternatively, the feedback vector is formed from estimated state variables together with determined state variables. The feedback vector is used as a feedback for the state-feedback controller and the output of the controller is fed to a frequency converter which drives the movable structure of the overhead crane.

The control arrangement of the present invention for positioning a movable structure of an overhead crane, which is either a trolley or a bridge of the crane, comprises means for providing a position reference for the movable structure. The means is preferably an input means which is operated by an operator or an operating system of the crane. The arrangement further comprises a state-feedback controller adapted to control the position of the movable structure, the position of the movable structure and a sway angle of the load being state variables of the system used in the state-feedback controller. Further, the arrangement comprises means for determining the position or speed of the movable structure and the sway angle of the load or angular velocity of the load. The position or the speed of the movable structure is preferably estimated using the frequency converter which is used as an actuator in the arrangement. Alternatively, the position or the speed are measured using sensors which are suitable for the measurement of the speed or position of the crane.

The arrangement also comprises means for providing the determined position or speed of the movable structure, the determined sway angle of the load or angular velocity of the load and the output of the state-feedback controller to an observer.

The observer is adapted to produce at least two estimated state variables, the estimated state variables including estimated position of the movable structure, estimated sway angle of the load, estimated speed of the movable structure and the estimated angular velocity of the load. The controller also comprises means for forming a feedback vector from the estimated state variables or from the estimated state variables together with determined state variables and means for using the formed feedback vector as a feedback for the state-feedback controller. Further, the arrangement comprises means for providing the output of the controller to a frequency converter which is adapted to drive the movable structure of the overhead crane.

The method of the invention can be implemented by a frequency converter which together with a motor acts as the actuator, i.e. drives the movable structure according to the output of the control system. Frequency converters comprise internal memory and processing capability for implementing the method. The position reference for the trolley is given by the operator or an operating system to the frequency converter, and the controller structure is implemented in the frequency converter. That is, the observer and the controller presented in the drawings are preferably implemented in a processor of a frequency converter which drives the trolley. The one or more feedback signals from the sensors are fed to the frequency converter for the desired operation.

As mentioned above, the invention is mainly described in connection with a trolley as a movable structure of a crane. However, the above described structure of the controller is directly applicable to control of the position of the bridge of an overhead crane.

It will be obvious to a person skilled in the art that, as the technology advances, the inventive concept can be implemented in various ways. The invention and its embodiments are not limited to the examples described above but may vary within the scope of the claims.

Claims

1. A method of positioning a movable structure of an overhead crane, the movable structure being either a trolley or a bridge of the overhead crane, the method comprising providing a position reference for the movable structure,controlling with a state-feedback controller the position of the movable structure, the position of the movable structure and a sway angle of the load being state variables of the system used in the state-feedback controller,determining the position or speed of the movable structure and the sway angle of the load or angular velocity of the load,providing the determined position or speed of the movable structure, the determined sway angle of the load or angular velocity of the load and the output of the state-feedback controller to an observer,producing with the observer at least two estimated state variables, the estimated state variables including estimated position of the movable structure, estimated sway angle of the load, estimated speed of the movable structure and the estimated angular velocity of the load,forming a feedback vector from the estimated state variables or from the estimated state variables together with determined state variables,using the formed feedback vector as a feedback for the state-feedback controller, andproviding the output of the controller to a frequency converter which is adapted to drive the movable structure of the overhead crane.

2. The method according to claim 1, wherein the state variables of the system used in the state-feedback controller are the position of the movable structure, the speed of the movable structure, the sway angle of the load and the angular velocity of the load.

3. The method according to claim 1, wherein the observer is a full-order observer, and the forming of the feedback vector comprises forming the feedback vector from estimated state variables.

4. The method according to claim 1, wherein the observer is a reduced-order observer, and the forming of the feedback vector comprises forming the feedback vector from the determined sway angle of the load, determined position of the movable structure, the estimated angular velocity of the load and estimated speed of the movable structure.

5. The method according to claim 1, wherein the determining the position or speed of the movable structure comprises estimating the position or the speed of movable structure.

6. The method according to claim 5, wherein the position or speed of the movable structure is estimated using the frequency converter.

7. The method according to claim 1, wherein the determining the position or speed of the movable structure comprises measuring the position or the speed of movable structure.

8. The method according to claim 1, wherein the frequency converter comprises a speed controller.

9. The method according to claim 1, wherein the output of the controller is a force reference, which is changed to a torque reference in the frequency converter.

10. The method according to claim 1, wherein the method comprises modifying the position reference at the input of the controller to a position profile, the position profile limiting the speed and the acceleration of the movable structure.

11. A control arrangement for positioning a movable structure of an overhead crane, the movable structure being either a trolley or a bridge of the overhead crane, comprising means for providing a position reference for the movable structure,a state-feedback controller adapted to control the position of the movable structure, the position of the movable structure and a sway angle of the load being state variables of the system used in the state-feedback controller,means for determining the position or speed of the movable structure and the sway angle of the load or angular velocity of the load,means for providing the determined position or speed of the movable structure, the determined sway angle of the load or angular velocity of the load and the output of the state-feedback controller to an observer,the observer is adapted to produce at least two estimated state variables, the estimated state variables including estimated position of the movable structure, estimated sway angle of the load, estimated speed of the movable structure and the estimated angular velocity of the load,means for forming a feedback vector from the estimated state variables or from the estimated state variables together with determined state variables,means for using the formed feedback vector as a feedback for the state-feedback controller, andmeans for providing the output of the controller to a frequency converter which is adapted to drive the movable structure of the overhead crane.

12. The method according to claim 2, wherein the observer is a full-order observer, and the forming of the feedback vector comprises forming the feedback vector from estimated state variables.

13. The method according to claim 2, wherein the observer is a reduced-order observer, and the forming of the feedback vector comprises forming the feedback vector from the determined sway angle of the load, determined position of the movable structure, the estimated angular velocity of the load and estimated speed of the movable structure.

14. The method according to claim 2, wherein the determining the position or speed of the movable structure comprises estimating the position or the speed of movable structure.

15. The method according to claim 3, wherein the determining the position or speed of the movable structure comprises estimating the position or the speed of movable structure.

16. The method according to claim 2, wherein the determining the position or speed of the movable structure comprises measuring the position or the speed of movable structure.

17. The method according to claim 3, wherein the determining the position or speed of the movable structure comprises measuring the position or the speed of movable structure.

18. The method according to claim 2, wherein the method comprises modifying the position reference at the input of the controller to a position profile, the position profile limiting the speed and the acceleration of the movable structure.

19. The method according to claim 3, wherein the method comprises modifying the position reference at the input of the controller to a position profile, the position profile limiting the speed and the acceleration of the movable structure.

20. The method according to claim 2, wherein the output of the controller is a force reference, which is changed to a torque reference in the frequency converter.