Suspended load steadying control device
Patent Information
- Application Number
- MYPI1997005310
- Authority / Receiving Office
- MY · MY
- Patent Type
- Applications
- Current Assignee / Owner
- Priority Date
- 1996-11-08
- Filing Date
- 1997-11-07
- Publication Date
- 1998-05-08
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
Conventional suspended load steadying control devices in cranes face challenges in minimizing swing motion during trolley movement, leading to safety concerns and increased positioning time, which affects handling efficiency.
A suspended load steadying control device that incorporates a run state-wise control selection mechanism, switching between speed following and positioning control based on trolley position relative to the target, using separate optimum control portions to manage trolley motion and swing stabilization.
This approach reduces swing motion and shortens settling time by prioritizing speed control when far from the target and switching to positioning control as the trolley approaches, enhancing safety and efficiency.
Abstract
Description
TITLE OF THE INVENTION·SUSPENDED LOAD STEADYING CONTROL DEVICEBACKGROUND OF THE INVENTIONThis invention relates to a suspended load steadying (i.e., swing stopping) control device for performing control for steadying of a suspended load in a crane.A conventional suspended load steadying control device will be described by reference to Fig. 5, a view showing an overall structure, Fig. 6, a block diagram of the control device, and Fig. 7 showing control characteristics.As shown in Fig. 5, a trolley 012 can travel on railsOil by the driving action of a trolley drive device 015. From the trolley Oil, a rope 013 hangs down, and the trolley Oil transports a suspended load 014 by attaching the suspended load 014 to the front end of the rope 013.The trolley 012 is further provided with a trolley displacement detector 021 for detecting a trolley position, xl, a trolley speed detector 022 for detecting a trolley speed, x2, and a swing motion detector 023 for detecting a swing displacement, x3, and a swing speed, x4.2θ The swing motion detector 023 is a detector of the type which photographs a marker attached to the suspended load 014 by means of a camera mounted on the trolley 012 vertically downwards, and image processes an image taken, thereby detecting the swing displacement x3 and swing speed x4.The trolley position xl, trolley speed x2, swing displacement x3 and swing speed x4 detected are sent to a control device 026. The control device 026 performs a positioning optimum control computation (to be described later on) by means of a built-in optimum control portion 032 (see Fig. 6), and produces a speed command, u. Under this speed command u, the trolley drive device 015 is driven to move the-2trolley 012.When an automatic run is to be performed in such a crane, it is necessary to incorporate control for positioning the suspended load 014 exactly at a target position as instructed.The crane can be modeled as a bogie-pendulum system, and it is known with such a model that the positioning of the suspended load can be realized by driving the trolley according to feedback control by an optimum regulator.With reference to Figs. 6 and 7, a method for optimum control of the crane will be described. This control is performed by an optimum control portion (optimum regulator) 032 of a control device 026 which calculates the amount of operation (speed command, u, for the trolley in this embodiment) in accordance with the following control rule (Numeric Expression (1)):z / = Kx ---------(1) where x represents a state amount vector to be described below, whose respective elements are, in order of arrangement from left to right, a trolley position xl, a trolley speed x2, a swing displacement x3 and a swing speed x4 of the suspended load. That is, the following Numeric Expression (2) holds.x = [xl xl x3 x4]T---------(2)Further, K represents a gain vector with 4 columns indicated in Numeric Expression (3).K = [Hkl k3 £4] (3)-3The above gain vector K is an optimum gain determined by the following procedure:(a) From motion equations formulated for the trolley-pendulum system motion model shown in Fig. 5, a state equation, Numeric Expression (4), is derived. This state equation is a linear differential equation expressing the vibrations of the suspended load 014 as a spring-mass system. An explanation for the state equation, including the way of deriving it, is omitted here.-^-x = Ax + Bu ----------(4) where u and x represent the aforementioned amount of operation and state amount vector, respectively,. A represents a transition matrix with 4 rows and 4 columns, and B represents a drive matrix with 4 rows and 1 column.(b) For the above state equation, NumericExpression (4), the optimum gain K of Numeric Expression (6) that minimizes an evaluation function J of Numeric Expression (5) below is sought.J = (xTQx+rz?(5) where Q is a weighting matrix with 4 rows and 4 columns, and r represents a weighting factor.u = Kx (6)-4By so minimizing the evaluation function J, the optimum gain K is found which rapidly reduces all elements of the state amount to zero with the smallest possible operation amount (speed command) u.Based on the optimum gain K obtained by the abovedescribed computation, the control arithmetic unit 026 determines the amount of optimum operation by the sum of the products of the motion state amounts by the detectors 021, 022, 023 and the optimum gain K. The control arithmetic unit 026 issues this amount of optimum operation as a control command signal (speed command u) for the trolley drive device 015. By driving this device according to the signal, optimum control is performed.At this time, position signal input (trolley position xl) on the trolley 012 is given as feedback as a position relative to a trolley target position, pset, whereby the trolley 012 can be positioned at the target position. Simultaneously, the suspended load 014 can be steadied. Thus, the suspended load 014 can be brought to the given target position.When such control is performed by the optimum regulator, the trolley is moved from a stop state with the target position being changed. On this occasion, at the initial stage of control, the trolley position is far away from the target position. Hence, the relative position xl of the trolley as a state amount takes a large value compared with other state amounts. The speed command u as the amount of operation also takes a large value immediately after initiation of control·. The speed command u immediately after start of control is depicted as a dotted line (from time 0 to T2) in Fig. 7.On the other hand, the trolley in the initial state is at zero speed. In the actual crane, the acceleration and-5speed of the trolley are also restricted. This necessitates acceleration at a maximum acceleration (from time 0 to Tl) and movement at maximum speed (from time Tl to T2) at the initial stage of control. The trolley speed x2 in this case is indicated by a solid line in Fig. 7.That state of the trolley speed is effective for making the trolley reach the target position promptly, but it is a state in which no feedback on the swing state of the suspended load works. As a result, the trolley approaches the target position while retaining swings occurring as the trolley is accelerated.This has posed the serious problems of not only diminishing safety during movement of the trolley, but also lengthening the settling time for positioning, thereby lowering the materials handling efficiency.SUMMARY OF THE INVENTIONThe present invention has been accomplished under these circumstances. The object of the invention is to provide a suspended load steadying control device which performs, in addition to conventional optimum control, optimum control for carrying out steadying control while causing a trolley to follow a given speed command, and which has a switching device for switching between these two manners of control in accordance with the state of run.The suspended load steadying control device of the present invention, a solution of the aforementioned problems, comprises:a trolley motion state amount detector for detecting the motion state amount of a trolley in a crane suspending a load by a rope member;a suspended load motion state amount detector for detecting the motion state amount of the load suspended by the-6trolley; and a control device for performing steadying control of the suspended load based on detection signals introduced from the respective detectors;the control device comprising:a speed following optimum control portion for driving the trolley with the amount of optimum operation based on an optimum gain adjusted to follow a certain set speed, thereby performing steadying control;a positioning optimum control portion for driving the trolley with the amount of optimum operation based on an optimum gain adjusted to position the trolley at a certain target position, thereby performing steadying control; and a run state-wise control selection portion for selecting the speed following optimum control portion or the positioning optimum control portion based on the run state amount of the trolley, to drive the trolley.The trolley motion state amount detector may comprise a trolley displacement detector for detecting a trolley position, and a trolley speed detector for detecting a trolley speed.The suspended load motion state amount detector may be a swing motion detector for detecting the swing displacement and swing speed of the suspended load.The run state-wise control selection portion may be constructed as follows: When the relative position of the trolley to the target position is larger than a set value, the run state-wise control selection portion selects the speed following optimum control portion to drive the trolley. When the relative position of the trolley to the target position is smaller than the set value, on the other hand, the run state-wise control selection portion selects the positioning optimum control portion to drive the trolley.-7According to the present invention, when the trolley is moved to a target position, control for performing steadying while causing the trolley to follow a set speed is carried out in the former half of control, whereby the swing of the suspended load can be kept small. When the trolley approaches the target position, this control is switched to conventional control for performing the positioning and steadying of the trolley. Thus, the swing of the suspended load at switching of control can be reduced, and the time to settlement of swing by the conventional control can be kept short.BRIEF DESCRIPTION OF THE DRAWINGSFig. 1 is an overall structural view of a suspended load steadying control device according to an embodiment of the present invention;Fig. 2 is a block diagram showing the suspended load steadying control device according to the embodiment of the present invention;Fig. 3 is a flow chart showing the processings performed in a control device;Fig. 4 is a characteristic view showing the control characteristics of the suspended load steadying control device according to the present invention;Fig. 5 is an overall structural view showing a conventional suspended load control device;Fig. 6 is a block diagram showing a conventional suspended load steadying control device; andFig. 7 is a characteristic view showing the control characteristics of a conventional suspended load steadying control device.DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTSEmbodiments of the present invention will be described-8with reference to the appended drawings, in which Fig. 1 is an overall structural view. Fig. 2 is a block diagram of a control device. Fig. 3 is a flow chart showing a control action, and Fig. 4 is a control characteristics view.As shown in Fig. 1, a trolley 12 can travel on rails 11 by the driving action of a trolley drive device 15. From the trolley 12, a rope 13 hangs down, and the trolley 12 transports a suspended load 14 by attaching the suspended load 14 to the front end of the rope 13.The trolley 12 is further provided with a trolley displacement detector 21 for io detecting a trolley position, x1, a trolley speed detector 22 for detecting a trolley speed, x2, and a swing motion detector 23 for detecting a swing displacement, x3, and a swing speed, x4.The swing motion detector 23 is a detector of the type which photographs a marker attached to the suspended load 14 by means of a camera mounted on the trolley 12 vertically downwards, and image processes an image taken, thereby detecting the swing displacement x3 and swing speed x4.The trolley position x1, trolley speed x2, swing displacement x3 and swing speed x4 detected are sent to a control device 26. The control device 26 performs, in the first half of control, control for steadying the trolley 12 while causing it to follow a set speed, as will be described later on. This type of control is done by means of built-in optimum control portions 31, 32 (see Fig. 2). Thereby, the swing of the suspended load 14 is kept small (control added by the present invention). When the trolley 12 approaches the target position, this control is switched to control for positioning and steadying the trolley 12 (conventionally performed control). Under this speed command u, the trolley drive device 15 is driven to move the trolley 012.In the control device 26, as shown in Fig. 2, there-9are disposed an acceieration / constant speed optimum control portion 31 for controlling the trolley 12 so as to follow a set speed, vset, and a positioning optimum control portion 32 for performing control aimed at positioning and steadying the trolley.The measured values detected by the detectors 21, 22, 23 are entered into these optimum control portions 31, 32. In regard to the trolley position, the relative position of the trolley to a target position, pset, is to serve as control input. Thus, a relative position xl' defined as xl'· = xl - pset is used as control input.In regard to input to the acceieration / constant speed optimum control portion 31, the trolley speed will be the relative speed of the trolley to the set speed vset. Thus, a relative speed x2' defined, as x2' = x2 - vset is used as an input signal for the optimum control portion 31.Also, a speed command, ul, output from the acceieration / constant speed optimum control portion 31 is also the relative speed from the set speed. Thus, ul' defined as ul' = ul + vset is used as the result of computation by the optimum control portion 31 (trolley speed command) .The processing performed by the acceieration / constant speed optimum control portion 31 is as follows: An optimum control gain is determined in the same way as for a conventional control gain. However, a gain to multiply the trolley position is unnecessary for control for causing following up to the set speed. Thus, a weighting matrix, Q', set such that the gain to multiply the trolley position will be zero is used, and an optimum gain, K', for minimizing the following evaluation function, J' , is found.-10(7) u - K'x + vse / -(8)The trolley speed command ul', the output signal, has the set speed vset added as stated above.The positioning optimum control portion 32 does the same computation as a conventional optimum control portion 032 as shown in Fig. 6, thereby to produce a trolley speed command u2 for positioning and steadying the trolley.A run state-wise control selection portion 33 receives inputs of the trolley speed command ul' from the acceleration / constant speed optimum control portion 31, the trolley speed command u2 calculated by the positioning optimumΛ control portion 32, and the relative position xl' to the target position pset for the trolley 12. The run state-wise control selection portion 33 performs switching so as to issue the results of the acceleration / constant speed optimum control portion 31 (trolley speed command) ul' as a speed command, u, if the relative position xl' to the target position pset for the trolley 12 is greater than a certain set value; or to issue the trolley speed command u2, the results of the positioning optimum control portion 32, as a speed command, u, if the relative position xl' is smaller than the certain set value.The speed command ul' or the speed command u2 selected by the run state-wise control selection portion 33 is issued to the trolley drive device 15 to drive the trolley 12.The processings in the control device 26 are-Ilsummarized below. That is, they are described below with reference to a flow chart shown in Fig. 3.[Step 1]The signals xl, x2, x3 and x4 from detectors 21, 22 5 and 23 are captured.[Step 2]The relative position xl' of the trolley to the target position is calculated by xl' = xl - psetThe relative speed. x2' of the trolley to the set speed is calculated by x2' = x2 - vset [Step 3]Tin acceleration / constant speed optimum control 15 computation is done based on Numeric Expression (9) . As shown in Numeric Expression (10), moreover, the set speed is added to the results of computation.2 / 1 = [^11kT kl' kF'} xl' x2' x3'.x4;--(9) ul' = ul + vset (10) [Step 4]Positioning optimum control computation is done based on Numeric Expression (11).xl' / / 2 = [^1 kl kl kF} x2 x3 x4 (11)-12[Step 5]It is determined whether the relative position of the trolley to the target position is greater than a certain set value.[Step 6]When the relative position of the trolley to the target position is greater than the certain set value, the result of acceleration / constant speed optimum control is made a trolley speed command. That is, u = ul' [Step 7]When the relative position of the trolley to the target position is smaller than the certain set value, the result of positioning optimum control is made a trolley speed command.That is, u = u2As described above, the present invention has two control gains, one for control taking up a trolley speed and a swing, and one for control taking up a trolley position and a swing, as control amounts. By switching between these two type of parameters, the invention performs control. Thus, it can constitute a suspended load steadying control device capable of keeping the swing of a suspended load minimal while the trolley is traveling.
Claims
CLAIMS1. A suspended load steadying control device for a crane with a trolley (12) suspending a load (14) by a rope member (13), said suspended load5 steadying control device comprising:a trolley motion state amount detector (21, 22) for detecting the motion state amount of a trolley (12);a suspended load motion state amount detector (23) for detecting the motion state amount of the load (14) suspended by the trolley (12); and io a control device (26) for performing steadying control of the suspended load based on detection signals introduced from the respective detectors; said control device (26) comprising:a positioning optimum control portion (32) for driving the trolley with the amount of optimum operation based on an optimum gain (k) adjusted to15 position the trolley at a certain target position (pset), thereby performing load steadying control;characterized by said control device further comprising a speed following optimum control portion (31) for driving the trolley with the amount of optimum operation based on an optimum gain (k’) adjusted to follow a20 certain set speed (vset), thereby performing load steadying control; and a run state-wise control selection portion (33) for selecting the speed following optimum control portion or the positioning optimum control portion based on the run state amount of the trolley, to drive the trolley.- 142. The suspended load steadying control device of claim 1, wherein the trolley motion state amount detector comprises a trolley displacement detector (21) for detecting a trolley position, and a trolley speed detector5 (22) for detecting a trolley speed, the suspended load motion state amount detector is a swing motion detector (23) for detecting the swing displacement and swing speed of the suspended load, and when the relative position of the trolley to the target position is larger than io a set value, the run state-wise control selection portion selects the speed following optimum control portion to drive the trolley, and when the relative position of the trolley to the target position is smaller than the set value, the run state-wise control selection portion selects the positioning optimum control portion to drive the trolley.
