The disclosure relates generally to motion control. More particularly, the disclosure relates to a device and to a method for controlling motion of a load that is non-rigidly connected to a suspension point whose speed and position are controllable. Furthermore, the disclosure relates to system for handling a load. The system can be, for example but not necessarily, a crane. Furthermore, the disclosure relates to a computer program for controlling motion of a load non-rigidly connected to a suspension point whose speed and position are controllable.
Unwanted swinging is a problem that affects performance of many mechanical systems where a load is non-rigidly connected to a suspension point whose speed and position are controlled. For example, when the suspension point is moved the load has tendency to swing. The tendency to swing may represent a risk of damaging the load and/or its surroundings, and/or may decrease productivity by forcing the mechanical system to be operated slowly. The mechanical system can be for example a crane comprising a crane carriage from which, by means of a suspension rope, a load is suspended. A crane operator gives a speed instruction via a control terminal connected to a control unit which controls speed of the crane carriage. In crane applications of the kind mentioned above, load swinging is a problem especially in automatic cranes as well as in cranes without a skilled person controlling the load motion.
It is a known fact that load swinging can be reduced by increasing acceleration and deceleration ramp times and using long S-curve speed shaping, i.e. limiting the time-derivative of acceleration i.e. limiting the jerk. An inherent challenge of this approach is that response and settling times may increase to an unacceptable level.
Another approach is to use a swinging angle sensor and to utilize an output signal of the swinging angle sensor in model-based control of load motion. The model can be based on motion equations according to the classical Newtonian dynamics. In many cases there is, however, a desire to avoid instrumentations such as a swinging angle sensor which may be susceptible to damages in harsh environmental conditions under which a crane may sometimes have to operate.
There are published open-loop methods which do not need a swinging angle sensor, and which are based on a pendulum model based on the classical Newtonian dynamics. An exemplifying open-loop method based on a pendulum model is described in the publication WO9411293. A challenge related to these open-loop methods is their sensitivity to errors in model parameters such as rope length and a distance between a hook and the center of mass of a load.
The following presents a simplified summary to provide a basic understanding of some aspects of different invention embodiments. The summary is not an extensive overview of the invention. It is neither intended to identify key or critical elements of the invention nor to delineate the scope of the invention. The following summary merely presents some concepts of the invention in a simplified form as a prelude to a more detailed description of exemplifying and non-limiting embodiments of the invention.
In accordance with the invention, there is provided a new control device for controlling motion of a load that is non-rigidly connected to a suspension point whose speed and position are controllable. The suspension point can be, for example but not necessarily, a part of a crane and the load can be suspended with a suspension rope from the suspension point.
A control device according to the invention comprises an input interface for receiving an input signal indicative of a target speed of the load, an output interface for submitting an output signal indicative of a reference speed of the suspension point, and a processing system constituting a signal processing path for producing the output signal based on the input signal, wherein signal processing path comprises at least one finite impulse response “FIR” filter for suppressing a signal component whose frequency is a natural swinging frequency of the load.
Thanks to the above-mentioned at least one finite impulse response filter, the speed of the suspension point has substantially no frequency component to excite the swinging of the load. As the above-mentioned filter has a finite impulse response, the temporal length of settling and tail effects caused by the filter is limited and deterministic. To improve robustness against variation in properties of the non-rigid connection, e.g. against variation in rope length, the signal processing path is advantageously arranged to have a stop-band whose width covers a range of variation of the natural swinging frequency.
In accordance with the invention, there is provided also a new system for handling a load. A system according to the invention comprises a carrier device comprising a suspension point for carrying the load non-rigidly connected to the suspension point, and a controllable drive for moving the suspension point, and a control device according to the invention for receiving an input signal indicative of a target speed of the load and for supplying, to the controllable drive, an output signal indicative of a reference speed of the suspension point.
The above-mentioned carrier device can be for example a crane for carrying the load with a suspension rope connected to the suspension point.
In accordance with the invention, there is provided also a new method for controlling motion of a load that is non-rigidly connected to a suspension point whose speed and position are controllable. A method according to the invention comprises; receiving an input signal indicative of a target speed of the load, supplying the input signal to a signal processing path for producing an output signal indicative of a reference speed of the suspension point, and controlling motion of the suspension point in accordance with the output signal of the signal processing path, wherein the signal processing path comprises at least one finite impulse response filter for suppressing a signal component whose frequency is a natural swinging frequency of the load.
In accordance with the invention, there is provided also a new computer program for controlling motion of a load that is non-rigidly connected to a suspension point whose speed and position are controllable. A computer program according to the invention comprises computer executable instructions for controlling a programmable processor to constitute a signal processing path, receive an input signal indicative of a target speed of the load, supply the input signal to the signal processing path to produce an output signal indicative of a reference speed of the suspension point, and control motion of the suspension point in accordance with the output signal of the signal processing path, wherein the computer program comprises computer executable instructions for configuring the signal processing path to comprise at least one finite impulse response filter for suppressing a signal component whose frequency is a natural swinging frequency of the load.
In accordance with the invention, there is provided also a new computer program product. The computer program product comprises a non-volatile computer readable medium, e.g. a compact disc “CD”, encoded with a computer program according to the invention.
Various exemplifying and non-limiting embodiments of the invention are described in accompanied dependent claims.
Exemplifying and non-limiting embodiments of the invention both as to constructions and to methods of operation, together with additional objects and advantages thereof, are best understood from the following description of specific exemplifying embodiments when read in conjunction with the accompanying drawings.
The verbs “to comprise” and “to include” are used in this document as open limitations that neither exclude nor require the existence of un-recited features. The features recited in dependent claims are mutually freely combinable unless otherwise explicitly stated. Furthermore, it is to be understood that the use of “a” or “an”, i.e. a singular form, throughout this document does not exclude a plurality.
Exemplifying and non-limiting embodiments of the invention and their advantages are explained in greater detail below with reference to the accompanying drawings, in which:
The specific examples provided in the description below should not be construed as limiting the scope and/or the applicability of the accompanied claims. Lists and groups of examples provided in the description below are not exhaustive unless otherwise explicitly stated.
The control device 101 comprises an input interface 102 for receiving the input signal indicative of the target speed of the load 109. The control device 101 comprises an output interface 103 for submitting, to the controllable drive 106, an output signal indicative of a reference speed vSP,ref of the suspension point 108. In this exemplifying case, the output signal is the reference speed vSP,ref of the suspension point 108. It is also possible that the output signal is e.g. a reference position or a reference acceleration which is indicative of the reference speed of the suspension point 108 via a known mathematical relation. In
An amplitude response, i.e. the absolute value of a frequency response, of the signal processing path 211 is shown in
where g is the acceleration of gravity=9.82 m/s2 and l is the length of the suspension rope 110. The frequency of the first transfer-zero of the FIR-filter 212 is advantageously selected to be the same as or slightly smaller than the minimum natural swinging frequency i.e. the natural swinging frequency corresponding to the maximum length of the suspension rope 110.
In a control device according to an exemplifying and non-limiting embodiment of the invention, the input interface 202 of the control device is configured to receive data indicative of the natural swinging frequency fN. The processing system 204 is configured to change the decimation ratio ND of the decimator 213 in accordance with a change of the natural swinging frequency. The above-mentioned data can express for example the value of the natural swinging frequency fN or the length l of the suspension rope 110 based on which the natural swinging frequency fN can be computed according to the above-presented equation 1. The decimation ratio ND can be selected so that the frequency fs/(N×ND) of the first transfer-zero is the same as or slightly smaller than the natural swinging frequency fN. The interpolation ratio is advantageously changed together with the decimation ratio ND so as to have a constant sample rate at the output of the control device.
As can be seen in
where g is a gain for setting a total gain of the signal processing path 411 to be at a suitable level. The gain g can be for example 1/7100 to compensate for the DC-gains 100 and 71 of the FIR-filters 412a and 412b.
In the above-mentioned exemplifying case, the first transfer-zero of the FIR-filter 412b is substantially in the middle of the frequency band between the first and second transfer-zeros of the FIR-filter 412a. The amplitude responses of the FIR-filters 412a and 412b and the amplitude response of the series-connection of the FIR-filters 412a and 412b are shown in
The impulse response of a series-connection of moving average FIR-filters is symmetric in the time domain and the impulse response can be quite long. Thus, a response latency of the control device may be too long in some cases. Therefore, in some cases it is advantageous to replace a moving average FIR-filter with a FIR-filter or with an infinite impulse response “IIR” filter whose impulse response is asymmetric in the time domain so that the impulse response has most of its energy in the beginning portion of the impulse response. The filter having the asymmetric impulse response can be for example a minimum phase-filter.
where P(Z−1) and Q(Z−1) are polynomials of Z−1. It is however also possible that the band-stop filter is located upstream of the interpolator 214 in which case the sample rate of the band-stop filter is the same as that of the FIR-filter.
The band-stop filter 519 can be for example a time-discrete equivalent of a time-continuous filter that has the following Laplace-domain transfer function:
where s is a Laplace-variable, ωz is frequency of a transfer-zero, i.e. a notch frequency, and k is a damping-factor with the aid of which the shape of the frequency response can be tuned. The damping-factor k can be tuned for example experimentally. In some exemplifying cases, it has turned out that 1.7 is a suitable value of the damping factor k. The time-continuous transfer function presented by formula 3 can be converted into its time-discrete equivalent with the aid of a suitable conversion rule. For example, the following trapezoid rule maps the left-half s-plane to the interior of an origin-centered unit-circle of the Z-plane:
where T is the temporal length of the sample interval corresponding to the sample rate of the band-stop filter 519.
It is also possible to select the notch frequency ωz of the band-stop filter 519 to be the natural swinging frequency corresponding to the maximum rope length, and to design the FIR-filter 512 to be a moving average filter whose first transfer-zero is at a natural swinging frequency corresponding to the half of the maximum rope length. This makes the operation faster but may provide less damping at natural swinging frequencies corresponding to short rope lengths.
It is also possible to design the band-stop filter 519 directly in the Z-domain. For example, the Z-domain transfer function of a 2nd order IIR band-stop filter can be:
where zz=ejωzT, zz*=e−jωzT, zz=rpejωpT, zz*=rpe−jωpT,ωz is the notch frequency, T is the temporal length of the sample interval corresponding to the sample rate of the band-stop filter 519, rp is the pole radius, ωp is the pole frequency, j is the imaginary unit, and g is a coefficient that can be selected e.g. so that the gain at the zero-frequency i.e. the DC-gain has a desired value. As zz and zz* are complex conjugates of each other and correspondingly zp and zp* are complex conjugates of each other, the transfer function presented by formula 5 can be presented in a form having real-valued coefficients. The shape of the frequency response can be tuned by adjusting the pole radius rp and the pole frequency ωp.
A processing system of a control device according to an exemplifying and non-limiting embodiment of the invention, e.g. the processing systems 104, 204, 304, 404, and 504 shown in the accompanying drawings, can be implemented with one or more processor circuits, each of which can be a programmable processor circuit provided with appropriate software, a dedicated hardware processor such as for example an application specific integrated circuit “ASIC”, or a configurable hardware processor such as for example a field programmable gate array “FPGA”. Furthermore, the processing system may comprise one or more memory devices each of which can be for example a Random-Access-Memory “RAM” circuit.
The above-described control devices 101, 201, 301, 401, and 501 are examples of a control device that comprises:
In a method according to an exemplifying and non-limiting embodiment of the invention, the at least one finite impulse response filter has a transfer-zero at or near to the natural swinging frequency of the load. In a method according to an exemplifying and non-limiting embodiment of the invention, the at least one finite impulse response filter comprises a moving average filter.
In a method according to an exemplifying and non-limiting embodiment of the invention, the at least one finite impulse response filter comprises at least two series, or parallel, connected finite impulse response filters. The impulse response of a series-connection of finite impulse response filters is a convolution of the impulse responses of the finite impulse response filters which are connected in series. In a method according to an exemplifying and non-limiting embodiment of the invention, the at least two finite impulse response filters comprise a moving average filter.
In a method according to an exemplifying and non-limiting embodiment of the invention, the signal processing path comprises a band-stop filter having a stop-band on a first side-band of the at least one finite impulse response filter. In a method according to an exemplifying and non-limiting embodiment of the invention, the band-stop filter is an infinite impulse response filter. In a method according to an exemplifying and non-limiting embodiment of the invention, the band-stop filter is a minimum-phase filter.
In a method according to an exemplifying and non-limiting embodiment of the invention, the signal processing path comprises a decimator in front of the at least one finite impulse response filter and an interpolator after the at least one finite impulse response filter. The decimator makes the sample rate of the at least one finite impulse response filter to be less than the sample rate of the input signal, and the interpolator makes the sample rate of the output signal to be greater than the sample rate of the at least one finite impulse response filter.
A method according to an exemplifying and non-limiting embodiment of the invention comprises receiving data indicative of the natural swinging frequency and changing the decimation ratio of the above-mentioned decimator in accordance with a change of the natural swinging frequency.
In a method according to an exemplifying and non-limiting embodiment of the invention, the signal processing path comprises an input shaper limiting a rate of change of a filter input signal supplied to the at least one finite impulse response filter. The input shaper is advantageously inserted upstream of the at least one finite impulse response filter, or the input shaper is integrated into a first one of the at least one finite impulse response filter. In a method according to an exemplifying and non-limiting embodiment of the invention, the input shaper limits an absolute value of a difference between the filter input signal and a delayed version of the filter input signal.
A computer program according to an exemplifying and non-limiting embodiment of the invention comprises computer executable instructions for controlling a programmable processor to carry out actions related to a method according to any of the above-described exemplifying and non-limiting embodiments of the invention.
A computer program according to an exemplifying and non-limiting embodiment of the invention comprises software modules for controlling motion of a load that is non-rigidly connected to a suspension point whose speed and position are controllable. The software modules comprise computer executable instructions for controlling a programmable processor to:
The above-mentioned software modules can be e.g. subroutines and/or functions implemented with a programming language suitable for the programmable processor under consideration.
A computer program product according to an exemplifying and non-limiting embodiment of the invention comprises a computer readable medium, e.g. a compact disc “CD”, encoded with a computer program according to an exemplifying embodiment of invention.
A signal according to an exemplifying and non-limiting embodiment of the invention is encoded to carry information that defines a computer program according to an exemplifying embodiment of invention.
The non-limiting, specific examples provided in the description given above should not be construed as limiting the scope and/or the applicability of the appended claims. Furthermore, any list or group of examples presented in this document is not exhaustive unless otherwise explicitly stated.
While the present disclosure has been illustrated and described with respect to a particular embodiment thereof, it should be appreciated by those of ordinary skill in the art that various modifications to this disclosure may be made without departing from the spirit and scope of the present disclosure.
Number | Name | Date | Kind |
---|---|---|---|
5359542 | Pahmeier | Oct 1994 | A |
5495955 | Shibata | Mar 1996 | A |
5960969 | Habisohn | Oct 1999 | A |
7367464 | Agostini | May 2008 | B1 |
9385737 | Yu | Jul 2016 | B1 |
20040006930 | Fahrion | Jan 2004 | A1 |
20080110844 | Lewis | May 2008 | A1 |
20090030647 | Stocker | Jan 2009 | A1 |
20090164345 | Pierce | Jun 2009 | A1 |
20100145526 | Yamaguchi | Jun 2010 | A1 |
20100181165 | Finn | Jul 2010 | A1 |
20110076130 | Stocker | Mar 2011 | A1 |
Number | Date | Country |
---|---|---|
103998367 | Aug 2014 | CN |
106927366 | Jul 2017 | CN |
106959610 | Jul 2017 | CN |
9411293 | May 1994 | WO |
Number | Date | Country | |
---|---|---|---|
20190315601 A1 | Oct 2019 | US |