WO2022050023A1 - Dispositif d'arrêt de giration destiné à une grue et grue équipée de celui-ci - Google Patents
Dispositif d'arrêt de giration destiné à une grue et grue équipée de celui-ci Download PDFInfo
- Publication number
- WO2022050023A1 WO2022050023A1 PCT/JP2021/029762 JP2021029762W WO2022050023A1 WO 2022050023 A1 WO2022050023 A1 WO 2022050023A1 JP 2021029762 W JP2021029762 W JP 2021029762W WO 2022050023 A1 WO2022050023 A1 WO 2022050023A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- turning
- undulating
- suspended load
- unit
- displacement
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C13/00—Other constructional features or details
- B66C13/18—Control systems or devices
- B66C13/22—Control systems or devices for electric drives
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C23/00—Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes
Definitions
- the present invention relates to a crane turning steady rest device and a crane equipped with the device.
- a lower traveling body As a mobile crane, a lower traveling body, an upper rotating body supported by the lower traveling body so as to be able to turn around a turning center axis extending in the vertical direction, and an undulating body such as a boom or a jib are provided. Things are known.
- the undulating body is attached to the front portion of the upper sloping body so as to be rotatable in the undulating direction around a horizontal rotation center axis.
- a hook is attached to the suspended load rope suspended from the tip of the undulating body, and the suspended load is lifted by connecting the suspended load to the hook.
- Patent Document 1 in a crane having a telescopic boom, when the suspended load swings (swing swing) when the upper swing body stops turning, the tip of the boom is positioned vertically above the suspended load.
- a technique for controlling the turning motion of the upper swing body so as to move it is disclosed. As the tip of the boom moves to follow the suspended load, the runout of the suspended load eventually converges.
- An object of the present invention is to provide a crane turning steady rest device and a crane capable of stably converging the turning vibration of a suspended load caused by the turning operation of a crane while suppressing the influence of the string vibration of the suspended load. It is in.
- the crane includes a lower main body, an upper main body, an undulating body, a suspended load rope, a swivel drive unit, a swivel operation unit, an undulating body drive unit, an undulating operation unit, and a suspended load drive unit. It has an elevating operation unit and.
- the upper main body is rotatably supported by the lower main body around a turning center axis extending in the vertical direction.
- the undulating body is supported so as to be rotatable in the undulating direction around the rotation center axis horizontal to the upper body.
- the undulating body includes a undulating body base end portion and a undulating body tip portion opposite to the undulating body base end portion.
- the suspended load rope is hung from the tip of the undulating body and connected to the suspended load.
- the swivel drive unit can swivel drive the upper main body around the swivel center axis in the first swivel direction and in the second swivel direction opposite to the first swivel direction, respectively.
- the turning operation unit receives an operation for turning and driving the upper main body.
- the turning operation unit can switch between a turning position for turning the upper body in the first turning direction and the second turning direction, and a neutral position for stopping the turning of the upper body. Is.
- the undulating body driving unit can rotate the undulating body around the rotation center axis in the undulating direction.
- the undulating operation unit receives an operation for undulating the undulating body.
- the undulating operation unit can be switched between an undulating position for undulating the undulating body and a neutral position for stopping the undulating of the undulating body.
- the suspended load drive unit can raise and lower the suspended load relative to the ground by winding and feeding the suspended load rope.
- the elevating operation unit receives an operation for elevating and lowering the suspended load.
- the elevating operation unit can be switched between an elevating position for elevating and lowering the suspended load and a neutral position for stopping the elevating and lowering of the suspended load.
- the swivel steady rest device includes an undulating body length information acquisition unit, a swivel angle detecting unit, an undulating angle detecting unit, an undulating body displacement detecting unit, an undulating body speed detecting unit, a suspended load displacement detecting unit, and a suspended load.
- Velocity detection unit rope length information acquisition unit, suspension load amount information acquisition unit, control start condition determination unit, target state quantity setting unit, control gain setting unit, filter characteristic setting unit, and filter processing unit.
- the undulating body length information acquisition unit acquires undulating body length information which is information corresponding to the length of the undulating body in the undulating body longitudinal direction which is the direction connecting the undulating body base end portion and the undulating body tip portion. And output.
- the turning angle detecting unit detects and outputs a turning angle around the turning center axis of the upper body.
- the undulation angle detecting unit detects and outputs the undulation angle of the undulating body around the rotation center axis.
- the undulating body displacement detecting unit detects and outputs the displacement of the undulating body tip portion, which is the displacement of the undulating body tip portion in the turning direction.
- the undulating body speed detecting unit detects and outputs the undulating body tip speed, which is the speed of the undulating body tip in the turning direction.
- the suspended load displacement detecting unit detects the suspended load displacement, which is the displacement of the suspended load with respect to the tip of the undulating body, and outputs a signal corresponding to the suspended load displacement.
- the suspended load speed detecting unit detects the suspended load speed, which is the amount of change in the suspended load displacement with respect to the tip of the undulating body per unit time, and outputs a signal corresponding to the suspended load speed.
- the rope length information acquisition unit acquires and outputs rope length information which is information corresponding to the length of the suspended load rope between the tip of the undulating body and the suspended load.
- the suspension load amount information acquisition unit acquires and outputs suspension load amount information which is information regarding the weight of the suspension load.
- the control start condition determining unit is the turning operation unit after the turning drive unit turns the upper main body in a predetermined turning direction in response to the turning operation unit being set to the turning position. It is determined whether or not the turning steady rest control start condition satisfied by setting all the operating units of the undulating operation unit and the elevating operation unit to the neutral position is satisfied.
- the target state amount setting unit determines that the suspension load turning direction displacement, which is the displacement of the suspended load in the turning direction, A plurality of first state quantities including the suspended load turning direction speed, the displacement of the undulating body tip portion, the undulating body tip portion speed, and the turning angle, which are the speeds of the suspended load in the turning direction, are described at predetermined target positions. A first target state amount for stopping the suspended load in the turning direction is set.
- the control gain setting unit is a state equation relating to the behavior of the suspended load, and is a plurality of first controls corresponding to the plurality of first state quantities, based on the state equation in which the turning speed of the upper body is a variable. Set the gain.
- the filter characteristic setting unit sets the filter characteristics based on the natural frequency of the string vibration of the suspended load rope generated between the tip of the undulating body and the suspended load.
- the filter processing unit receives signals of the signal corresponding to the suspended load displacement output from the suspended load displacement detecting unit and the signal corresponding to the suspended load speed output from the suspended load speed detecting unit. , Perform filtering.
- the filter process is a process of removing a frequency component corresponding to the natural frequency of the string vibration of the suspended load based on the filter characteristic set by the filter characteristic setting unit.
- the filter processing unit is a subject composed of a signal corresponding to the suspended load displacement subjected to the filtering process and a signal corresponding to the suspended load displacement subjected to the filtering process.
- the processing suspension speed is output respectively.
- the state quantity calculation unit includes the undulating body length information output from the undulating body length information acquisition unit, the turning angle output from the turning angle detecting unit, and the undulating angle output from the undulating angle detecting unit.
- the current values of the plurality of first state quantities are calculated respectively. ..
- the target speed calculation unit is based on the plurality of first control gains set by the control gain setting unit and the current values of the plurality of first state quantities calculated by the state quantity calculation unit. Calculate the turning target speed, which is the target value of.
- the command information output unit outputs command information corresponding to the turning target speed to the turning drive unit so that the turning speed of the upper body becomes the turning target speed calculated by the target speed calculation unit. do.
- the crane includes the lower body, the upper body, the undulating body, the suspended rope, the swivel drive unit, the swivel operation unit, the undulation body drive unit, and the undulation operation unit. , The suspension drive unit, the elevating operation unit, and the swivel steady rest device.
- FIG. 1 is a side view of the crane according to the first embodiment of the present invention.
- FIG. 2 is a block diagram of a swing steady rest device for a crane according to the first embodiment of the present invention.
- FIG. 3 is a schematic plan view for explaining the swing steady rest control of the crane according to the first embodiment of the present invention.
- FIG. 4 is a flowchart of a crane turning steady rest control according to the first embodiment of the present invention.
- FIG. 5 is a side view of the crane according to the second embodiment of the present invention.
- FIG. 6 is a model diagram for explaining steady rest control in the turning direction of the suspended load in the crane according to each embodiment of the present invention.
- FIG. 7 is a model diagram for explaining steady rest control in the turning direction of the suspended load in the crane according to each embodiment of the present invention.
- FIG. 8 is a model diagram for explaining radial steady rest control of a suspended load in a crane according to each embodiment of the present invention.
- FIG. 9 is a graph showing the filter characteristics of the steady rest control of the crane according to each embodiment of the present invention.
- FIG. 10 is a graph showing the filter characteristics of the steady rest control of the crane according to each embodiment of the present invention.
- FIG. 1 is a side view of the crane 10 according to the present embodiment. It should be noted that FIG. 1 shows the directions of "up”, “down”, “front” and “rear”, and these directions will explain the structure and assembly method of the crane 10 according to the present embodiment. Therefore, it is shown for convenience, and does not limit the moving direction and usage mode of the crane according to the present invention.
- the crane 10 includes a traveling body 14 (lower body), a rotating body 12 (upper body) supported by the traveling body 14 so as to be able to turn around a turning center axis extending in the vertical direction, a boom 16 (undulating body), and a jib. It includes 18 (undulating body) and a mast 20. Further, a counterweight 13 for adjusting the balance of the crane 10 is loaded on the rear portion of the swivel body 12. Further, a cab 15 is provided at the front end portion of the swivel body 12. The cab 15 corresponds to the driver's seat of the crane 10.
- the boom 16 shown in FIG. 1 is a so-called lattice type, and has a lower boom 16A (the base end of the undulating body), one or more (three in the example) intermediate booms 16B, 16C, 16D, and an upper boom 16E. (The tip of the undulating body opposite to the base end of the undulating body).
- the lower boom 16A is supported so as to be rotatable in the undulating direction around the rotation center axis (first rotation center axis) horizontal to the front portion of the swivel body 12.
- the intermediate booms 16B, 16C, and 16D are detachably added to the tip end side of the lower boom 16A in that order.
- the upper boom 16E is detachably added to the tip end side of the intermediate boom 16D.
- the lower boom 16A is rotatably supported by the swivel body 12 by a boom foot pin 16S provided at the lower end thereof.
- the boom 16 has idler sheaves 34S and 36S.
- the idler sheaves 34S and 36S are rotatably supported on the rear side surface of the base end portion of the lower boom 16A, respectively.
- the specific structure of the boom is not limited in the present invention.
- the boom may have no intermediate member, or may have a different number of intermediate members from the above.
- the boom may be composed of a single member.
- the jib 18 is rotatably supported by the tip of the boom 16 (boom tip, upper boom 16E) around a rotation center axis (second rotation center axis) parallel to the rotation center axis of the boom 16. It has a jib base end and a jib tip opposite to the jib base end.
- the main winding rope 50 described later is hung from the tip of the jib and connected to the suspended load.
- the specific structure of the jib 18 is not limited as in the boom 16.
- the mast 20 has a base end and a rotating end, and the base end is rotatably connected to the swivel body 12.
- the rotation axis of the mast 20 is parallel to the rotation axis of the boom 16 and is located immediately behind the rotation axis of the boom 16. That is, the mast 20 can rotate in the same direction as the undulating direction of the boom 16.
- the crane 10 includes a pair of left and right boom backstops 23 and a pair of left and right boom guy lines 24.
- a pair of left and right boom backstops 23 are provided on both left and right sides of the lower boom 16A of the boom 16. These boom backstops 23 come into contact with the central portion of the swivel body 12 in the front-rear direction when the boom 16 reaches the upright posture shown in FIG. By this contact, it is regulated that the boom 16 is fanned backward by a strong wind or the like.
- the pair of left and right boom guy lines 24 connect the rotating end of the mast 20 to the tip of the boom 16. This connection links the rotation of the mast 20 with the rotation of the boom 16.
- the crane 10 includes a rear strut 21, a front strut 22, a pair of left and right strut backstops 25, a pair of left and right guy lines 26, and a pair of left and right jib guy lines 28.
- the rear strut 21 is rotatably supported by the tip of the boom 16.
- the rear strut 21 is held in a posture of projecting from the tip of the upper boom 16E to the boom upright side (left side in FIG. 1).
- a pair of left and right strut backstops 25 and a pair of left and right guy lines 26 are interposed between the rear struts 21 and the boom 16.
- the strut backstop 25 is interposed between the intermediate boom 16D and the intermediate portion of the rear strut 21, and supports the rear strut 21 from below.
- the guy line 26 is stretched so as to connect the tip end portion of the rear strut 21 and the lower boom 16A of the boom 16, and the position of the rear strut 21 is regulated by the tension thereof.
- the rear strut 21 has a sheave block 47 and rear strut idler sheaves 52 and 62.
- the sheave block 47 is arranged at the rotating end of the rear strut 21 and includes a plurality of sheaves arranged in the width direction.
- the rear strut idler sheaves 52 and 62 are arranged in a portion located on the proximal end side of the central portion of the rear strut 21 in the longitudinal direction, and include a plurality of sheaves arranged in the width direction.
- the front strut 22 is arranged behind the jib 18 and is rotatably supported at the tip of the boom 16 (upper boom 16E) so as to rotate in conjunction with the jib 18. Specifically, a pair of left and right jib guy lines 28 are stretched so as to connect the tip of the front strut 22 and the tip of the jib 18. Therefore, by the rotational drive of the front strut 22, the jib 18 is also rotationally driven integrally with the front strut 22. As shown in FIG. 1, the above-mentioned rear strut 21 is arranged on the rear side of the front strut 22 and forms a substantially isosceles triangular shape with the front strut 22.
- the front strut 22 has a sheave block 48 and front strut idler sheaves 53 and 63.
- the sheave block 48 is located at the rotating end of the front strut 22 and includes a plurality of sheaves arranged in the width direction.
- the front strut idler sheaves 53 and 63 are arranged in a portion of the front strut 22 located closer to the proximal end side than the central portion in the longitudinal direction, and include a plurality of sheaves arranged in the width direction.
- the crane 10 is further equipped with various winches.
- the crane 10 includes a boom undulating winch 30 for undulating the boom 16, a jib undulating winch 32 for undulating the jib 18, and a main winding for hoisting and unwinding the suspended load.
- a winch 34 for use and a winch 36 for auxiliary winding are provided.
- the crane 10 includes a boom undulating rope 38, a jib undulating rope 44, a main winding rope 50 (suspended rope) hanging from the tip of the jib 18 and connected to the suspended load, and an auxiliary winding rope 60. , Equipped with.
- the jib undulating winch 32, the main winding winch 34, and the auxiliary winding winch 36 are installed near the base end of the boom 16. Further, the boom undulating winch 30 is installed on the swivel body 12. The positions of these winches 30, 32, 34 and 36 are not limited to the above.
- the boom undulating winch 30 winds up and unwinds the boom undulating rope 38. Then, the boom undulating rope 38 is arranged so that the mast 20 rotates by this winding and unwinding.
- sheave blocks 40 and 42 in which a plurality of sheaves are arranged in the width direction are provided at the rotating end of the mast 20 and the rear end of the rotating body 12, respectively, and are pulled out from the boom undulating winch 30.
- the boom undulating rope 38 is hung between the sheave blocks 40 and 42. Therefore, when the boom undulating winch 30 winds up and unwinds the boom undulating rope 38, the distance between the two sheave blocks 40 and 42 changes, whereby the mast 20 and the boom 16 interlocking with the mast 20 undulate. Rotate in the direction.
- the jib undulating winch 32 winds up and unwinds the jib undulating rope 44 hung between the rear strut 21 and the front strut 22. Then, the jib undulating rope 44 is arranged so that the front strut 22 rotates by this winding and unwinding. Specifically, the jib undulating rope 44 pulled out from the jib undulating winch 32 is hung on the idler sheave 32S and the intermediate boom sheave 46, and is further hung a plurality of times between the sheave blocks 47 and 48.
- the jib undulating winch 32 changes the distance between both sheave blocks 47 and 48 by winding and unwinding the jib undulating rope 44, and rotates the front strut 22 relative to the rear strut 21. Move. As a result, the jib undulating winch 32 undulates the jib 18 interlocking with the front strut 22.
- the main winding winch 34 winds up and unwinds the suspended load with the main winding rope 50.
- the main winding rope 50 hangs from the tip of the jib 18 and is connected to the suspended load.
- a main winding guide sheave 54 is arranged at the tip of the jib 18, and a plurality of main winding point sheaves 56 are arranged in the width direction at positions adjacent to the main winding guide sheave 54.
- a block is provided.
- the main winding rope 50 pulled out from the main winding winch 34 is hung on the idler sheave 34S, the rear strut idler sheave 52, the front strut idler sheave 53, and the main winding guide sheave 54 in this order, and is used for the main winding of the sheave block. It is hung between the point sheave 56 and the sheave 58 of the sheave block provided on the main hook 57 for suspension. Therefore, when the main winding winch 34 winds up or unwinds the main winding rope 50, the distance between the sheaves 56 and 58 changes, and the main winding rope 50 is connected to the main winding rope 50 hanging from the tip of the jib 18. The hook 57 is wound and unwound. As a result, the suspended load can be hoisted and unwound.
- auxiliary winding winch 36 winds up and unwinds the suspended load by the auxiliary winding rope 60.
- a supplementary winding guide sheave 64 is rotatably provided coaxially with the main winding guide sheave 54, and a supplementary winding point sheave (not shown) can rotate at a position adjacent to the supplementary winding guide sheave 64. It is provided in.
- the auxiliary winding rope 60 pulled out from the auxiliary winding winch 36 is hung on the idler sheave 36S, the rear strut idler sheave 62, the front strut idler sheave 63, and the auxiliary winding guide sheave 64 in this order, and is hung from the auxiliary winding point sheave. It hangs down. Therefore, when the auxiliary winding winch 36 winds up or unwinds the auxiliary winding rope 60, the auxiliary hook for hanging load connected to the end of the auxiliary winding rope 60 is wound up or unwound.
- the crane 10 further includes a drive control unit 700, a drive unit 700A, an operation unit 700B, and a swivel steady rest device 70.
- FIG. 2 is a block diagram of the swivel steady rest device 70 of the crane 10 according to the present embodiment.
- the drive unit 700A drives each member of the crane 10.
- the drive unit 700A includes a swivel drive unit 701, a boom drive unit 702A (boom undulating drive unit, undulating body drive unit), a jib drive unit 702B (jib undulation drive unit, undulating body drive unit), and a winch drive unit 703 ( It has a suspended load drive unit).
- the turning drive unit 701 generates a driving force capable of turning the turning body 12 around the turning center axis in the first turning direction and in the second turning direction opposite to the first turning direction.
- the swivel drive unit 701 includes a hydraulic swivel motor that swivels the swivel body 12 by receiving the supply of hydraulic oil.
- the boom drive unit 702A generates a driving force for rotating the boom undulating winch 30, and is capable of rotating the boom 16 around the rotation center axis.
- the boom drive unit 702A includes a hydraulic undulation motor that rotates the boom undulation winch 30 by receiving the supply of hydraulic oil.
- the jib drive unit 702B generates a driving force for rotating the jib undulating winch 32, and it is possible to rotate the jib 18 around the rotation center axis.
- the jib drive unit 702B includes a hydraulic undulating motor that rotates the boom undulating winch 30 by receiving the supply of hydraulic oil.
- the winch drive unit 703 generates a driving force for rotating the main winding winch 34, and the main winding rope 50 is wound and unwound by the main winding winch 34 so that the suspended load is relative to the ground. It is possible to raise and lower the rope.
- the winch drive unit 703 includes a hydraulic suspension motor that rotates the main winding winch 34 by receiving the supply of hydraulic oil.
- a winch drive unit (not shown) for rotating the auxiliary winding winch 36 is also provided in the same manner.
- the operation unit 700B is arranged in the cab 15 and receives an operation for driving each member of the crane 10 by an operator.
- the operation unit 700B includes a swivel operation unit 704 (swivel operation unit), a boom operation unit 705A (boom undulation operation unit, undulation operation unit), and a jib operation unit 705B (jib undulation operation unit, undulation operation unit). It has a winch operation unit 706 (elevation operation unit).
- the swivel operation unit 704 receives an operation for swiveling and driving the swivel body 12 by the swivel drive unit 701.
- the turning operation unit 704 can switch between a turning position for turning the turning body 12 in the first turning direction and the second turning direction, and a neutral position for stopping the turning of the turning body 12. Has been done.
- the boom operation unit 705A accepts an operation for raising and lowering the boom 16 by the boom drive unit 702A.
- the boom operation unit 705A is capable of switching between an undulating position for raising and lowering the boom 16 and a neutral position for stopping the ups and downs of the boom 16.
- the jib operation unit 705B accepts an operation for undulating the jib 18 by the jib drive unit 702B.
- the jib operation unit 705B is capable of switching between an undulating position for undulating the jib 18 and a neutral position for stopping the undulation of the jib 18.
- the winch operation unit 706 receives an operation for raising and lowering the suspended load by the winch drive unit 703.
- the winch operation unit 706 is capable of switching between an elevating position for raising and lowering the suspended load and a neutral position for stopping the raising and lowering of the suspended load.
- the drive control unit 700 sends a command signal according to the operation direction and operation amount of the operation received by the swivel operation unit 704, the boom operation unit 705A, the jib operation unit 705B and the winch operation unit 706 to the swivel drive unit 701, the boom drive unit 702A, Inputs are made to the jib drive unit 702B and the winch drive unit 703, respectively, to drive each drive unit.
- the suspended load connected to the main winding rope 50 after the swivel operation of the swivel body 12 is stopped is in the swivel direction (swivel) of the swivel body 12 with the main winding point sheave 56 at the tip of the jib 18 as a fulcrum. It is possible to suppress the runout (swing direction runout and radial runout) of the suspended load, which is a phenomenon of swinging along the radial direction of the swivel body 12 (horizontal direction of the body 12) and the radial direction of the swivel body 12 (front-back direction of the swivel body 12). There is.
- the swivel steady rest device 70 converges the swivel direction swing of the suspended load by controlling the swivel motion (swivel speed, swivel direction) of the swivel body 12, while the undulating motion of the jib 18 (undulating angular velocity, undulating direction).
- the radial runout of the suspended load is converged.
- the turning steady rest device 70 has an information acquisition unit 700C, a detection unit 700D, and a vibration damping control unit 700E.
- the information acquisition unit 700C includes a boom length acquisition unit 708 (boom length information acquisition unit, undulating body length information acquisition unit) and a jib length acquisition unit 709 (jib length information acquisition unit, undulating body length information acquisition unit). Have.
- the boom length acquisition unit 708 acquires information (length information) regarding the length of the boom 16 used in the steady rest control of the suspended load executed by the vibration damping control unit 700E. That is, the boom length acquisition portion 708 is the boom 16 in the boom longitudinal direction (undulating body longitudinal direction), which is the direction connecting the base end portion (undulating body base end portion) and the tip portion (undulating body tip portion) of the boom 16. Acquires and outputs information (undulating body length information) corresponding to the length of. Similarly, the jib length acquisition unit 709 acquires information (length information) regarding the length of the jib 18 used in the steady rest control of the suspended load executed by the vibration damping control unit 700E.
- the jib length acquisition portion 709 is the jib 18 in the jib longitudinal direction (undulating body longitudinal direction), which is the direction connecting the base end portion (undulating body base end portion) and the tip portion (undulating body tip portion) of the jib 18. Acquires and outputs information (undulating body length information) corresponding to the length of.
- the information acquisition unit 700C has a storage unit (not shown), and the boom length acquisition unit 708 and the jib length acquisition unit 709 acquire the length information of the boom 16 and the jib 18 from the storage unit, respectively.
- the operation unit 700B has an input unit (not shown), the operator inputs the length information of the boom 16 and the jib 18 through the input unit, and the information is input to the boom length acquisition unit. It may be an embodiment acquired by the 708 and the jib length acquisition unit 709.
- the detection unit 700D includes a turning angle detection unit 710, a boom angle detection unit 711 (boom undulation angle detection unit, undulation angle detection unit), and a jib angle detection unit 712 (jib undulation angle detection unit, undulation angle detection unit).
- Jib top displacement detection unit 713 (undulating body displacement detection unit), jib top speed detection unit 714 (undulating body speed detection unit), rope runout angle detection unit 715 (suspended load displacement detection unit), and rope runout angle speed detection unit 716 ( It has a suspension load speed detection unit), a rope length detection unit 717 (rope length information acquisition unit), and a suspension load amount detection unit 718 (suspension load amount information acquisition unit).
- the turning angle detection unit 710 detects and outputs the turning angle around the turning center axis of the boom 16 (turning body 12).
- the turning angle detection unit 710 includes a gyro sensor (IMU sensor) (not shown) and a calculation unit.
- the turning angle detection unit 710 measures the angular velocity around the turning center axis of the turning body 12 with the gyro sensor, and the calculation unit converts the measured angular velocity into an angle by integrating the measured angular velocity once with respect to time. , The angle is output as a turning angle.
- the boom angle detection unit 711 detects and outputs the undulation angle of the boom 16 around the rotation center axis.
- the boom angle detection unit 711 includes an inclination sensor and detects the relative angle (ground angle) of the boom 16 with respect to the ground.
- the boom angle detection unit 711 may detect the relative angle with respect to other objects.
- the jib angle detection unit 712 detects and outputs the undulation angle of the jib 18 around the rotation center axis.
- the jib angle detection unit 712 also includes an inclination sensor and detects the relative angle (ground angle) of the jib 18 with respect to the ground.
- the jib angle detection unit 712 may also detect the relative angle with respect to other objects.
- the jib top displacement detection unit 713 detects and outputs the amount of displacement (displacement of the tip of the undulating body) of the tip of the jib 18 in the turning direction and the radial direction, respectively.
- the jib top displacement detection unit 713 includes an acceleration sensor (not shown) and a calculation unit attached to the tip of the jib 18.
- the acceleration sensor measures the acceleration of the tip of the jib 18 in the turning direction and the radial direction, respectively, and the calculation unit integrates the measured acceleration twice with respect to time to obtain a displacement (displacement amount). It is converted and the displacements in the turning direction and the radial direction are output respectively.
- the jib top speed detection unit 714 detects and outputs the speed (velocity tip speed) of the tip of the jib 18 in the turning direction and the radial direction.
- the jib top velocity detection unit 714 includes the acceleration sensor and the calculation unit shared with the jib top displacement detection unit 713.
- the acceleration measured by the acceleration sensor attached to the tip of the jib 18 is converted into a speed by the calculation unit once integrating with time, and the speeds in the turning direction and the radial direction are obtained, respectively.
- Output The sensor shared by the jib top displacement detection unit 713 and the jib top speed detection unit 714 may include a known IMU sensor.
- the rope runout angle detection unit 715 looks along the swing angle of the main winding rope 50 with respect to the vertical direction when viewed along the radial direction in the turning motion of the swivel body 12, and along the turning direction in the swivel motion of the swivel body 12. In this case, the runout angle of the main winding rope 50 with respect to the vertical direction is detected and output, respectively.
- the rope runout angle detection unit 715 includes a jig (not shown) attached to the tip of the jib 18 that can swing only in the turning direction, and an inclination sensor attached to the jig.
- the rope runout angle detection unit 715 includes a jig (not shown) attached to the tip of the jib 18 that can swing only in the radial direction, and an inclination sensor attached to the jig. Both of the jigs are locked to the main winding rope 50, and the two tilt sensors detect and detect the swing angle in the turning direction and the radial direction of the main winding rope 50 with respect to the jib 18 (vertical direction) as the swing angle, respectively. Can be output.
- the rope runout angular velocity detection unit 716 detects and outputs the runout angular velocity, which is the amount of change in the runout angle of the main winding rope 50 in the turning direction and the radial direction per unit time, respectively.
- the rope runout angular velocity detection unit 716 includes a gyro sensor attached to each of the above jigs, and the gyro sensor detects and outputs the runout angular velocity.
- the rope runout angular velocity detection unit 716 includes a camera attached to the tip of the jib 18 and acquires an image of the main hook 57 taken by the camera, and obtains an image of the main hook 57, and the main hook 57 (suspended load).
- the swing angle in the turning direction and the radial direction may be detected and output as the swing angle, respectively, and the angular velocity in the turning direction and the radial direction may be output by differentiating the swing angle once.
- the rope length detecting unit 717 acquires and outputs rope length information which is information corresponding to the length of the main winding rope 50 between the tip end portion of the jib 18 and the suspended load. In the present embodiment, the distance between the main winding point sheave 56 and the main hook 57 (sheave 58) at the tip of the jib 18 is detected as the rope length.
- the rope length detecting unit 717 has a rotation amount detecting unit capable of detecting the rotation amount of the main winding winch 34 and a winding layer detection unit for detecting the number of winding layers of the main winding rope 50 on the outer peripheral surface of the main winding winch 34. Including the part.
- the rope length detecting unit 717 is estimated from the winch diameter of the main winding winch 34, the winch rotation amount detected by the rotation amount detecting unit, and the winding layer of the main winding rope 50 detected by the winding layer detecting unit.
- the distance is calculated from the amount of the main winding rope 50 unwound from the main winding winch 34 and the number of times the main winding rope 50 is multiplied between the sheave blocks of the main winding point sheave 56 and the sheave 58. Output.
- the suspension load amount detection unit 718 acquires and outputs information (suspension load amount information) regarding the weight of the suspended load connected to the main hook 57.
- the suspension load amount detection unit 718 includes a load detector (load cell) (not shown) connected to the main winding rope 50, and the suspension load is based on a change in tension strain of the main winding rope 50. Detect weight.
- the pressure in the hydraulic circuit that raises and lowers the jib 18 may be detected by a pressure gauge (not shown), and the load of the suspended load may be estimated based on the pressure.
- the vibration control control unit 700E is composed of a CPU (Central Processing Unit), a ROM (Read Only Memory) for storing a control program, a RAM (Random Access Memory) used as a work area of the CPU, and the like.
- the vibration damping control unit 700E has a control determination unit 719 (control start condition determination unit), a control target amount setting unit 720, a control amount calculation unit 700F, and a filter setting when the CPU executes a control program stored in the ROM. It functions to include a unit 700G, a filter processing unit 700H, a control gain setting unit 726, a target speed calculation unit 727, and a command information calculation unit 728.
- the vibration damping control unit 700E automatically controls the vibration damping of the suspended load when the turning operation of the crane 10 is stopped, based on the operation received by the operation unit 700B, the information acquired by the information acquisition unit 700C, and the information detected by the detection unit 700D. Run with.
- ⁇ Judgment to start steady rest control> In the control determination unit 719, after the turning drive unit 701 turns the turning body 12 in a predetermined turning direction in response to the turning operation unit 704 being set to the turning position, the turning operation unit 704 and the boom operation unit The turning steady rest control (control) corresponding to the satisfaction of the turning steady rest control start condition established by setting all the operating parts of the 705A, the jib operation unit 705B and the winch operation unit 706 to the neutral position respectively. It is determined to start vibration control), and when it is determined that the turning steady rest control start condition is satisfied, a predetermined control start signal is output.
- each operation unit is set to the neutral position when the operation amount received by each operation unit is smaller than the preset threshold value. .. That is, such a state is a state in which the operation of the crane 10 is stopped after the turning operation of the swivel body 12, and the suspended load connected to the main hook 57 is the tip end portion of the jib 18 (main winding point sheave 56). It is desirable to be located vertically below. As described above, the operation of the crane 10 is stopped after the turning operation, and the switch (input unit) for starting the turning steady rest control, which is arranged in the cab 15 in advance as described later, is pressed by the operator. When (turned on), the steady rest control described later may be started.
- the control target amount setting unit 720 sets each control target amount (state target amount) at the time when the control determination unit 719 determines the execution of the turning steady rest control and outputs the control start signal.
- the control target amount setting unit 720 has a suspension load swivel direction displacement X1, a suspended load swivel direction speed X2, and an undulating body tip displacement X3 with respect to the swing direction steady rest control which is a steady rest control in the swivel direction of the suspended load.
- a target amount for stopping the suspended load in the turning direction at a predetermined target position is set for at least five (plural) control amounts (first state amount) including the undulating body tip speed X4 and the turning angle X5. do. Further, the control target amount setting unit 720 sets the suspended load radial displacement X6, the suspended load radial velocity X7, and the undulation angle X8 with respect to the radial steady rest control which is the steady rest control in the radial direction (front-back direction) of the suspended load. For at least three (plural) control amounts (second state amount) including, a target amount for stopping the suspended load in the radial direction at a predetermined target position is set.
- the suspended load turning direction displacement X1 is the displacement of the suspended load (main hook 57) in the turning direction
- the suspended load turning direction speed X2 is the speed of the suspended load in the turning direction
- the undulating body tip displacement X3 is the displacement of the tip of the jib 18 (main winding point sheave 56) in the turning direction
- the undulating body tip speed X4 is the displacement of the tip of the jib 18 in the turning direction.
- the turning angle X5 is a turning angle of the undulating body (swivel body 12) including the boom 16 and the jib 18.
- the suspended load radial displacement X6 is the radial displacement of the suspended load (main hook 57), and the suspended radial velocity X7 is the radial velocity of the suspended load.
- the undulation angle X8 is the undulation angle of the jib 18. The undulation angle of the boom 16 is constant during the above-mentioned turning steady rest control.
- FIG. 3 is a schematic plan view for explaining the steady rest control of the crane 10 according to the present embodiment.
- the XY coordinate system with the swivel center axis of the swivel body 12 as the zero point.
- the xy coordinate system is shown with the direction in which the virtual center line of the undulating body including the boom 16 and the jib 18 extends as the y direction and the direction orthogonal to the center line as the x direction.
- the xy coordinate system is set based on the virtual center line of the undulating body assuming that the undulating body is not elastically deformed.
- the undulating body is bent to the upstream side in the turning direction in the turning operation of the turning body 12 stopped before the state of FIG. Further, the main winding rope 50 connected to the tip of the jib 18 of the undulating body extends further toward the upstream side in the turning direction from the position of the tip of the undulating body (the tip of the jib 18).
- the steady rest control according to the present embodiment is not executed, the bending of the undulating body is eliminated from the state of FIG. 3, and the swing of the suspended load connected to the main winding rope 50 (main hook 57) (swing direction runout, Radial runout) occurs.
- the control target amount setting unit 720 sets the zero point position in the xy coordinate system, that is, the tip portion of the virtual undulating body as the target undulating body tip position, and targets the position vertically below the zero point position. Set as a suspended load position. Therefore, the turning speed and the turning direction of the swivel body 12 are automatically controlled so that the displacement of the suspended load in the turning direction becomes zero at the target suspended load position through the above-mentioned turning direction steady rest control.
- the undulating angular velocity and the undulating direction of the jib 18 are automatically controlled so that the displacement of the suspended load in the radial direction becomes zero at the target suspended load position through the above-mentioned radial steady rest control.
- the target suspension positions in the steady rest control in the turning direction and the steady rest control in the radial direction may be independent of each other. That is, there may be a mode in which the runout of the suspended load in the radial direction converges before the runout of the suspended load in the turning direction converges.
- the target turning angle in the XY coordinate system for arranging the tip of the undulating body and the suspended load at the above-mentioned target undulating body tip position and the target suspended load position, respectively, is defined as ⁇ ref.
- the control target amount setting unit 720 is based on the target turning angle ⁇ ref, the undulation angle of the boom 16 and the length of the boom 16, the undulation angle of the jib 18 and the length of the jib 18, and the tip of the target undulating body.
- the position and the target suspended load position can be calculated respectively.
- control target amount setting unit 720 aims to keep the suspended load stationary for the control amount of the speed (angular velocity) among the above-mentioned control amounts (first state amount and second state amount). Set the target amount to zero respectively.
- the case of the left turning direction is defined as a positive (positive) value
- the case of the right turning direction is defined as a negative (negative) value.
- the undulation angular velocity of the jib 18 the case of the upright direction is defined as a positive (positive) value
- the case of the undulating direction is defined as a negative (negative) value.
- the control amount calculation unit 700F detects each of the detection units 700D for each control amount of the suspended load turning direction displacement X1, the suspended load turning direction speed X2, the undulating body tip displacement X3, the undulating body tip speed X4, and the turning angle X5. The deviation between the detected value detected by the unit and the target amount set by the control target amount setting unit 720 is calculated. More specifically, the control amount calculation unit 700F outputs the boom length information output from the boom length acquisition unit 708, the jib length information output from the jib length acquisition unit 709, and the turning angle detection unit 710.
- the current values of the five state quantities are calculated based on the target state quantities of the five first state quantities (X1, X2, X3, X4, X5) set by the unit 720.
- the target state quantities of the five first state quantities (X1, X2, X3, X4, X5) set by the unit 720.
- the suspended load turning direction displacement X1 is the displacement in the relative turning direction of the suspended load with respect to the position of the tip of the undulating body, and the displacement X3 at the tip of the undulating body (the turning direction of the tip of the jib 18). Displacement in) is added. Therefore, the suspended load turning direction displacement X1 can be calculated by the following equation 1.
- the suspended load turning direction speed X2 is the relative speed of the suspended load with respect to the position of the tip of the undulating body, plus the speed of the tip of the undulating body X4 (the speed of the tip of the jib 18 in the turning direction). Therefore, the suspended load turning direction speed X2 can be calculated by the following equation 2.
- Equation 2 ⁇ l'is the runout angular velocity of the main winding rope 50 in the turning direction, and after being detected by the rope runout angular velocity detection unit 716, it is filtered by the filter processing unit 700H.
- the undulating body tip displacement X3 and the undulating body tip velocity X4 are detected by the above-mentioned jib top displacement detecting unit 713 and jib top speed detecting unit 714, respectively.
- the turning angle X5 corresponds to the deviation between the turning angle of the turning body 12 (boom 16) that changes every moment and the above-mentioned target turning angle ⁇ ref, and is calculated by the following equation 3.
- integral ( ⁇ ') is a value obtained by integrating the turning angle detected by the turning angle detecting unit 710 with respect to time. Further, the target turning angle ⁇ ref is set by the control target amount setting unit 720 as described above.
- the control gain setting unit 726 minimizes the time integration of the weighted sum of each control amount and input amount (turning speed) based on the control model considering the influence of the elastic deformation (deflection) of the undulating body.
- the control gain of each control amount (first state amount) is set. Specifically, the control gain setting unit 726 sets the control gains G1, G2, G3, G4 and G5 for each of the above-mentioned control quantities X1, X2, X3, X4 and X5 calculated by the control amount calculation unit 700F, respectively. Set.
- each control gain is set so that the above-mentioned control quantities X1, X2, X3, X4 and X5 calculated by the control amount calculation unit 700F and the turning speed corresponding to the input amount quickly converge to zero. Will be done.
- the control gain determines how the suspended load sways in the turning direction, and is calculated with reference to the length of the main winding rope 50, the working radius of the crane 10, the suspended load load, etc., which do not change during control. Will be done.
- the influence of elastic deformation generated on the undulating body is taken into consideration by the inertial force generated by the moment of inertia of the undulating body and the external force in the turning direction generated by the suspended load swing.
- the control model is a differential equation that expresses the behavior of an object, such as an equation of motion, transformed into a standard form that makes it easy to evaluate the stability of the control system. It is possible to design a stable control system.
- the control model can obtain a state-space representation in consideration of the elasticity of the undulating body by combining the equations expressing the elasticity of the undulating body as described above.
- the control model according to this embodiment will be described in detail later.
- the target speed calculation unit 727 is a swivel body from the following equation 4 based on the control amounts X1 to X5 calculated by the control gain setting unit 726 and the control gains G1 to G5 set by the control gain setting unit 726.
- the turning target speed Vref of 12 is calculated.
- the command information calculation unit 728 calculates a turning operation target command value to be input to the drive control unit 700 so that the turning speed of the turning body 12 becomes the turning target speed Vref calculated by the target speed calculation unit 727. do. Specifically, the command information calculation unit 728 calculates the turning operation target amount based on the turning target speed Vref calculated by the target speed calculation unit 727 and the hydraulic characteristics in the turning drive unit 701. Then, the calculated turning operation target amount is input to the drive control unit 700, and the turning drive unit 701 sets the turning speed and turning direction of the turning body 12.
- the control amount calculation unit 700F further sets the detection values detected by each detection unit of the detection unit 700D and the control target amount for each control amount of the suspension radial displacement X6, the suspended load radial velocity X7, and the undulation angle X8.
- the deviation from the target amount set by the unit 720 is calculated. More specifically, the control amount calculation unit 700F outputs the boom length information output from the boom length acquisition unit 708, the jib length information output from the jib length acquisition unit 709, and the boom angle detection unit 711.
- the rope length information output from the displacement detection unit 717, the suspension load amount information output from the suspension load amount detection unit 718, and the three second state quantities set by the control target amount setting unit 720 ( Based on the target state quantities of X6, X7, X8), the current values of the three state quantities are calculated.
- the runout angle of the main winding rope 50 output from the rope runout angle detection unit 715 in the radial direction and the runout angle velocity of the main winding rope 50 output from the rope runout angular velocity detection unit 716 in the radial direction? Subject to a predetermined filter process before being used for the above calculation.
- the jib top displacement detecting unit 713 attached to the tip of the jib 18 is the same as the above-mentioned suspended load turning direction displacement X1 and suspended load turning direction velocity X2. It is calculated based on the detection values detected by the jib top velocity detection unit 714, the rope displacement angle detection unit 715, and the rope displacement angular velocity detection unit 716. Specifically, the runout angle ( ⁇ r) in the radial direction of the main winding rope 50 and the radial direction of the main winding rope 50 are used by the jig in which the rope runout angle detection unit 715 swings following the runout of the main winding rope 50.
- the swing angular velocity ( ⁇ 'r) in each is measured, and the control amount calculation unit 700F adds the change amount of the turning radius calculated from the angle of the tip of the undulating body (the tip of the jib 18 and the jib top) to the suspended load radius.
- the directional displacement X6 can be calculated.
- the displacement X6 in the suspended load radial direction is calculated using the following equation 5.
- Equation 5 LM is the length of the main winding rope 50, and LJ is the length of the jib 18.
- the first term on the right side of the equation 5 means the displacement of the suspended load as seen from the tip of the jib 18, and the second term means the displacement of the tip of the jib 18 when the undulation angle of the jib 18 is ⁇ .
- the control amount calculation unit 700F can calculate the suspended load radial velocity X7 by differentiating the equation 5. Specifically, the suspended load radial velocity X7 is calculated using the following equation 6.
- control amount calculation unit 700F can calculate the undulation angle X8 by integrating the undulation target angular velocity ⁇ 'ref calculated later. Specifically, the undulation angle X8 is calculated using the following equation 7.
- the undulation angle X8 may use the undulation angle detected by the jib angle detection unit 712 as it is, but the jib angle detection unit 712 may detect the vibration of the entire undulating body due to the undulation operation of the jib 18. In order to prevent the vibration from being amplified during the steady rest control, it is desirable that the undulation angle X8 is further calculated based on the undulation target angular velocity calculated as described above. As for the undulation angle X8 used first at the start of steady rest control, the detection result of the jib angle detection unit 712 may be used as it is.
- the control gain setting unit 726 uses each control amount (second state quantity) so as to minimize the time integral of the weighted sum of each control amount and the input amount (the undulation angular velocity of the jib 18) based on a predetermined control model. ) Control gains are set respectively. Specifically, the control gain setting unit 726 sets the control gains G6, G7 and G8 for each of the above-mentioned control quantities X6, X7 and X8 calculated by the control amount calculation unit 700F, respectively.
- each control gain is set so that the above-mentioned control quantities X6, X7 and X8 calculated by the control amount calculation unit 700F and the undulation angle ⁇ of the jib 18 corresponding to the input amount quickly converge to zero. Will be done.
- the control gain determines how the suspended load sways in the radial direction, and is calculated with reference to the length of the main winding rope 50, the working radius of the crane 10, the suspended load, etc., which do not change during control. Will be done.
- the target speed calculation unit 727 has jib 18 from the following equation 8 based on the control amounts X6 to X8 calculated by the control gain setting unit 726 and the control gains G6 to G8 set by the control gain setting unit 726.
- the undulation target angular velocity ⁇ 'ref of is calculated.
- the command information calculation unit 728 is a jib undulation operation target command value for inputting to the drive control unit 700 so that the undulation angle velocity of the jib 18 becomes the undulation target angular velocity ⁇ 'ref calculated by the target speed calculation unit 727. Is calculated. Specifically, the command information calculation unit 728 calculates the jib undulation operation target amount based on the undulation target angular velocity ⁇ 'ref calculated by the target speed calculation unit 727 and the hydraulic characteristics in the jib drive unit 702B. Then, the calculated jib undulation operation target amount is input to the drive control unit 700, and the undulation angular velocity and undulation direction of the jib 18 are set by the jib drive unit 702B.
- FIG. 4 is a flowchart of the steady rest control of the crane 10 according to the present embodiment. Since both the turning direction steady rest control and the radial steady rest control described above are the same, the following flow describes the turning direction steady rest control.
- known parameters include the length of the boom 16, the elastic modulus of the boom 16, the length of the jib 18, the elastic modulus of the jib, the turning moment of inertia of the jib 18.
- the control determination unit 719 determines whether or not the steady rest control start switch (input unit) arranged in the cab 15 is pressed (ON) (step S02).
- the switch is turned on (YES in step S02)
- the information acquisition process by the information acquisition unit 700C and the detection process by the detection unit 700D are executed (step S03).
- the length of the boom 16 and the length of the jib 18 are acquired by the boom length acquisition unit 708 and the jib length acquisition unit 709 of the information acquisition unit 700C, respectively.
- the detection unit 718 has the undulation angle of the boom 16, the undulation angle of the jib 18, the displacement of the tip of the undulating body, the speed of the tip of the undulating body, the swing angle of the main winding rope 50, and the feeding amount of the main winding rope 50 (main winding rope). (Length of 50) and suspension load (load) are detected and stored.
- step S02 if the steady rest control start switch (input unit) arranged in the cab 15 is not pressed (turned off), automatic suspension steady rest control is performed in step S11. Is prohibited and the flow ends.
- step S02 instead of the determination condition of whether or not the steady rest control start switch arranged in the cab 15 is turned on as described above, each operation of the operation unit 700B is performed as described above.
- the determination condition may be that the portion is arranged in the neutral position.
- control gain setting unit 726 When the information acquisition process by the information acquisition unit 700C and the detection process by the detection unit 700D are executed in step S03, the control gain setting unit 726 next sets the control gain (feedback gain) (step S04). Specifically, the control gain setting unit 726 determines the above-mentioned G1, G2, G3, G4 and G5 (G6, G7 and G8 in the case of radial steady rest control), respectively, and proceeds to step S05.
- G1, G2, G3, G4 and G5 G6, G7 and G8 in the case of radial steady rest control
- the filter setting unit 700G is unique to the string vibration of the main winding rope 50 generated between the tip of the jib 18 (the tip of the undulating body, the main winding point sheave 56) and the suspended load (sheave 58).
- the filter processing unit 700H outputs a signal corresponding to the runout angle (suspended load displacement) of the main winding rope 50 output from the rope runout angle detection unit 715 and the main winding rope 50 output from the rope runout angular velocity detection unit 716.
- the frequency component corresponding to the natural frequency of the chord vibration of the suspended load is set based on the filter characteristic set by the filter setting unit 700G.
- the filtering process to be removed is executed (step S06).
- the filter processing unit 700H has a post-processed suspended load displacement (processed suspended load displacement) composed of a signal corresponding to the filtered load displacement and the filtered load speed.
- the post-processing suspension speed (processed suspension speed) composed of the signals corresponding to the above is output (input to the control amount calculation unit 700F).
- control target amount setting unit 720 sets the target amount (target state amount) of each control amount as described above (step S07).
- the control amount calculation unit 700F calculates the current value of each control amount (step S08). Specifically, the control amount calculation unit 700F has a suspended load turning direction displacement X1, a suspended load turning direction speed X2, an undulating body tip displacement X3, an undulating body tip speed X4, and a turning angle X5 (for steady rest control in the radial direction). In this case, the suspended load radial displacement X6, the suspended load radial velocity X7, and the undulation angle X8) are calculated, respectively.
- the target speed calculation unit 727 calculates the turning target speed Vref (step S09).
- the command information calculation unit 728 calculates the command current value for inputting the command signal to the turning drive unit 701 (step S10). Specifically, as described above, the command information calculation unit 728 inputs to the drive control unit 700 so that the turning speed of the turning body 12 becomes the turning target speed Vref calculated by the target speed calculation unit 727. Turn operation Target command value (proportional valve current command value) is calculated.
- FIG. 5 is a side view of the crane 10 according to the second embodiment of the present invention.
- the differences from the first embodiment will be mainly described, and the common points will be omitted.
- the jib 18 is not attached to the tip of the boom 16 as compared with the crane 10 shown in FIG. Further, the main winding rope 50 is hung from the tip end portion of the boom 16.
- the same control can be performed by setting the length of the jib 18 to zero.
- the jib top displacement detection unit 713 and the jib top speed detection unit 714 detect the displacement and speed of the boom top instead of the jib top, respectively. As described above, the same effect as that of the first embodiment can be obtained in this embodiment as well.
- x is called a state quantity and corresponds to each of the above-mentioned control quantities (suspended load swiveling direction displacement X1, suspended load swiveling direction speed X2, undulating body tip displacement X3, undulating body tip speed X4, and swivel angle X5).
- the displacement in the radial direction of the suspended load X6 the velocity in the radial direction of the suspended load X7, and the undulation angle X8
- u corresponds to the control input (turning speed) (in the case of radial steady rest control, the undulation angular velocity).
- a and B of the equation 9 are system matrices, and in the matrix, turning runout control is performed such as the rope length of the main winding rope 50 and the working radius of the crane 10 (the radius of the boom 16 in a plan view). It does not change, but contains parameters that affect the behavior of the suspended load.
- Equation 10 x and u correspond to a vector or scalar, and the superscript T attached to x and u means transpose. Also, Q and R correspond to matrices or scalars.
- the matrix X can be obtained by solving a known Riccati algebraic equation shown in Equation 11 below. Note that ⁇ 'm and Gx are equivalent to the above-mentioned turning target speed Vref. Further, Gx corresponds to the right side of the equation 4.
- control gain G feedback gain
- step S04 of FIG. 4 the control gain setting unit 726 can calculate the gains G1 to G5 based on the above calculation. The same applies to the gains G6 to G8 in the steady rest control in the radial direction.
- FIGS. 6 and 7 are model diagrams for explaining steady rest control in the turning direction of the suspended load of the crane 10 according to the present embodiment.
- the jib 18 is supported by the boom 16 assuming the crane 10 according to the first embodiment, but in the crane 10 according to the second embodiment, FIGS. 6 and 7
- Table 1 is a list of specifications and symbols used in the description of the present invention
- Table 2 is a list of variables and symbols.
- the runout control of the suspended load in each of the above embodiments can be regarded as a problem of setting a coordinate system for the elastic vibration of the suspended load and the crane mechanism system and making the state quantity defined by the coordinate system zero. First, this coordinate system will be described in detail.
- the swivel body 12 of the crane 10 swivels around the Z axis extending in the vertical direction.
- the position of the suspended load is expressed using the suspended load position coordinates (x t , y t , z t ).
- the origin of the suspended load position coordinates (x t , y t , z t ) is set with reference to the moment when the operator presses the steady rest control start switch.
- the origin is defined as the stop position of the suspended load when the operator does not operate the operation unit 700B from the moment when the switch is pressed and an infinite time elapses.
- the origin is the position where the elastic vibration and the suspended load sway of the jib 18 and the boom 16 are stationary without operating any of the undulating motors of the slewing drive unit 701, the boom drive unit 702A, and the jib drive unit 702B. It is said that.
- the origin position is set as the target position for converging the suspended load runout.
- the coordinate axes of the suspended load position are such that the yt axis is the radial direction in the turning motion of the crane 10 and the xt axis is the turning motion so as to share the XY plane with the XYZ coordinates of the global coordinate system.
- the turning direction is set, and the zt axis is set to the same direction as the Z coordinate axis.
- the suspended load position coordinates (x t , y t , z t ) become a coordinate system fixed to the global coordinate system XYZ with the target position of the suspended load runout as the origin.
- the same coordinate system is used as the suspended load position coordinates in the suspended load runout control in the turning direction (left-right direction) and the radial direction (left-right direction).
- the turning angle (turning angle) will be described.
- the expression jib or jib top is used in consideration of the tower-specification crane 10 shown in FIG. 1, but when the crane specification crane 10 shown in FIG. 5 is targeted, the above description is used. Can be replaced with a boom or boom top instead.
- the angle formed by the straight line connecting the turning center and the jib top in the plan view and the straight line connecting the turning center and the origin of the suspended load position coordinates (xt, yt, zt) is defined as the turning angle ⁇ .
- the turning angle ⁇ changes depending on the drive of the jib 18 by the turning motor, but it also changes depending on the bending (elastic deformation) of the jib 18 (undulating body), and does not necessarily match the turning angle ⁇ m of the turning motor. .. From the above definition, if ⁇ and ⁇ m are 0 and the swing of the suspended load when viewed from the jib top is stationary, it can be said that the suspended load position x t in the turning direction is also 0. As a result, the suspension swing control in the turning direction can be regarded as a problem of determining the turning angular velocity ⁇ 'm so that the state x represented by the following equation 13 becomes zero.
- the problem of the suspension swing control in the coordinate system and the turning direction can be set as the problem of making the state x shown in the equation 13 zero.
- a method of determining the turning angular velocity ⁇ 'm will be described. Specifically, the equation of motion of Lagrange is formulated based on the above coordinate system, and the equation of state for the state x is constructed. By determining ⁇ 'm based on this equation of state, it is possible to derive ⁇ 'm that makes the state x zero, and it is possible to stop the runout of the suspended load in the turning direction.
- the turning radius r 0 of the tip of the jib 18 is It can be expressed by the following equation 14.
- the second term of the equation 14 becomes zero.
- the height hz of the tip portion (jib top) of the jib 18 can be expressed by the following equation 15. Also in this case, in the case of the crane specification (FIG. 5), the second term of the equation 15 becomes zero.
- the load of the suspended load (suspended load) including the load of the hook and the weight of the main winding rope 50 can be combined and regarded as one rigid body R.
- the combined load M l of the suspension load M l and the weight of the main winding rope 50 uses the rope length LM of the main winding rope 50, the rope density ⁇ of the main winding rope 50, and the rope cross-sectional area SW of the main winding rope 50. It can be expressed as the following equation 16.
- the position of the center of gravity of the suspended load and the main winding rope 50 can be determined by using ⁇ defined by the following equation 17 as being at a position of a distance ⁇ ⁇ LM from the tip end portion (jib top) of the jib 18. ..
- the kinetic energy TM and the potential energy UM of the suspended load and the main winding rope 50 can be expressed by the following equations 21 and 22, respectively.
- Equation 24 g is the gravitational acceleration.
- the kinetic energy T which is the sum of the kinetic energies TM and TJ
- the potential energy U which is the sum of the potential energies UM and UJ
- the dissipation function D at this time can be expressed by the following equation 28.
- Equation 29 a linear equation of motion can be obtained by eliminating or approximating the quadratic minute term.
- equation 30 the equation of state represented by the following equation 30 can be obtained.
- Equation 58 the parameters included in the equation 30 are shown below.
- ax1 to a x10 , b x1 and b x2 included in the formula 30 are obtained from the formula 47 using these ax11 to ax28.
- Equation 58 Each can be expressed as shown in Equation 58.
- the suspended load turning direction displacement x t the suspended load turning direction speed x't , the turning angle ⁇ , the turning angular velocity ⁇ ', and the motor turning angle ⁇ m are set, respectively.
- the solution of the variable u 1 here, the turning speed
- FIG. 8 is a model diagram for explaining steady rest control in the radial direction of the suspended load of the crane 10 according to the present embodiment.
- the definition of the coordinate system of the suspended load position is the same as the above-mentioned suspension load runout control in the turning direction.
- the origin of the suspended load position coordinates is defined as the stopped position of the suspended load when the operator does not operate the operation unit 700B and an infinite time elapses from the moment when the switch for starting the swivel steady rest control is pressed.
- the origin is the position where the elastic vibration and the suspended load sway of the jib 18 and the boom 16 are stationary without operating any of the undulating motors of the slewing drive unit 701, the boom drive unit 702A, and the jib drive unit 702B. It is said that.
- the elastic vibrations of the jib 18 and the boom 16 are sufficiently smaller than the period of the suspended load, and the elastic deformation in the radial direction has less influence on the behavior of the suspended load than the elastic vibration in the turning direction. Therefore, in the modeling of the suspension control in the radial direction, the influence of elastic deformation is ignored, and the suspension control is performed by the undulating operation of the jib 18.
- the undulation angle at the start of control is defined as ⁇ J0
- the undulation angle that changes by performing control is defined as ⁇ J.
- the angular velocity (undulation angle velocity ⁇ 'J ) in the undulation of the jib 18 is input to control, but the measured value of the undulation angle velocity using the undulation angle detected by the jib angle detection unit 712 is at a high frequency. Since it is easily affected by the elastic deformation of the mechanical system that deforms, the undulation angle is obtained by integrating the undulation target angular velocity ⁇ 'ref calculated as described above, and feedback control is performed.
- the length of the boom 16 is LB
- the length of the jib 18 is LJ
- the angle of the boom 16 (undulation angle) is ⁇ B0
- the angle of the jib 18 (undulation angle) is ⁇ .
- the height hz of the tip portion (jib top) of the jib 18 can be expressed by the following formula 61.
- the position vector of the tip of the jib 18 is represented by the following equation 62.
- the kinetic energy for the rotation of the main winding rope 50 in the radial direction can be expressed by the following equation 63.
- the kinetic energy TM and the potential energy UM of the suspended load and the main winding rope 50 are represented by the following equations 64 and 65, respectively.
- the kinetic energy TJ and the potential energy UJ of the boom 16 and the jib 18 can be expressed by the above equations 23 and 24.
- the coordinates of the center of gravity of the boom 16 (y coordinate: y t , z coordinate: z t ) are as follows. It can be expressed by the formula 66 and the formula 67.
- the kinetic energy T which is the sum of the kinetic energies TM and TJ
- the potential energy U which is the sum of the potential energies UM and UJ
- the linear equation of motion represented by the following equation 74 can be obtained by eliminating or approximating the quadratic minute term.
- Equations 87 to 90 the parameters included in the equation 74 are shown below.
- y3 and by1 can be expressed as shown in Equations 87 to 90, respectively.
- the displacement y t in the radial direction of the suspended load, the velocity y't in the radial direction of the suspended load, and the undulation angle ⁇ J of the jib 18 are input, and the variable u 2 (
- the solution of the undulation angular velocity, the undulation target angular velocity) can be derived.
- the filter setting unit 700G has the tip portion of the jib 18 (the tip portion of the undulating body, the point sheave 56 for main winding) and the suspended load (sheave 58). ), A predetermined filter characteristic is set based on the natural frequency of the string vibration of the main winding rope 50 (in the case of FIG. 5, the string vibration generated between the tip of the boom 16 and the suspended load). ).
- the filter characteristics set by the filter setting unit 700G will be described in detail below. 9 and 10 are graphs showing the filter characteristics of the steady rest control of the crane 10 according to each embodiment of the present invention.
- the transfer function G (s) can be expressed by the following equation 92.
- ⁇ a is the frequency of the band to be removed
- ⁇ is the bandwidth
- ⁇ is the bandwidth
- ⁇ is the bandwidth
- Ts in equation 93 is the sampling period under control.
- FIG. 9 shows the gain characteristic with respect to the frequency f (Hz)
- FIG. 10 shows the phase characteristic with respect to the frequency f (Hz).
- 0.9 (Hz) which is the natural frequency of the string vibration of the main winding rope 50 described in detail later, the gain of the transfer function G (s) shows a very small value, and that component is removed. You can see that it has been done.
- a notch filter is used as an example of the design of the filter characteristics, but like the notch filter, a low-pass filter that can remove the natural frequency component of the string vibration of the main winding rope 50 is used. You may set the filter.
- the filter processing executed by the filter processing unit 700H in step S06 of FIG. 4 will be described.
- the output y in the current control step can be expressed by the following equation 94.
- x corresponds to the input in the current control step
- xold1 and xold2 correspond to the inputs in the control step one cycle before and two cycles before, respectively.
- y old1 and y old2 correspond to the outputs in the control steps one cycle before and two cycles before, respectively.
- a1 to a5 correspond to the above equation 93.
- the input x in the current control step corresponds to the runout angle of the main winding rope 50 and the runout angular velocity of the main winding rope 50.
- the output y calculated by the formula 94 is input to the swing angle ⁇ l and the swing angular velocity ⁇ l'in the turning direction of the main winding rope 50 in the formulas 1 and 2, respectively, in the steady rest control of the suspended load in the turning direction.
- the runout angle ⁇ r and the runout angular velocity ⁇ 'r in the radial direction of the main winding rope 50 in the formulas 5 and 6 are input, respectively.
- the nth-order natural frequency f n of the string vibration of the main winding rope 50 is expressed by the following equation 95.
- l in the formula 95 is the length of the main winding rope 50, and is detected by the rope length detecting unit 717.
- T is the tension applied to the main winding rope 50, and is calculated by dividing the detection value of the suspension load amount detecting unit 718 by the number of times the main winding rope 50 is multiplied.
- ⁇ is the linear density of the main winding rope 50 and is a value determined by the characteristics of the suspended load rope. The linear density is stored in a storage unit (not shown) included in the swivel steady rest device 70.
- a storage unit not shown
- the natural frequency of the string vibration of the main winding rope 50 in the higher order mode may also be removed by a low-pass filter or the like.
- the filter setting unit 700G calculates the natural frequency of the string vibration from the tension of the main winding rope 50 calculated from the length of the main winding rope 50, the suspended load, and the number of ropes hung.
- the turning target speed obtained from the feedback control amount of the suspended load position contains the component of the string vibration (string vibration), and the string vibration of the main winding rope 50. Is easy to promote, and there is a problem that the vibration of the suspended load is difficult to settle. More specifically, the swing angle of the main winding rope 50 detected by the occurrence of the string vibration as described above contains a large frequency component of the string vibration. As described above, since the suspended load position and the turning target speed are calculated from the swing angle of the main winding rope 50, as a result, the string vibration component of the main winding rope 50 is included in the turning target speed.
- the control gain setting unit 726 controls each control amount based on the control model.
- (First state amount) (suspended load turning direction displacement X1, suspended load turning direction speed X2, undulating body tip displacement X3, undulating body tip speed X4 and turning angle X5) and input amount (swing speed) weighted sum
- the control gains G1 to G5 are determined so that the time integration of the above is minimized.
- the target speed calculation unit 727 calculates the turning target speed based on the control amount and the control gain, and the command information calculation unit 728 drives the turning drive unit 701 so as to reach the turning target speed. Therefore, it is possible to stably hold the suspended load in the turning direction.
- the filter setting unit 700G determines the filter characteristics based on the natural frequency of the string vibration of the main winding rope 50 generated between the tip portion (undulating body tip portion) of the jib 18 and the suspended load.
- the signal and rope runout corresponding to the runout angle (suspended load displacement) of the main winding rope 50 output from the rope runout angle detection unit 715 (suspended load displacement detection unit) by the filter processing unit 700H based on the filter characteristics are set.
- the suspended load displacement detected and the suspended load speed are used.
- control amount calculation unit 700F calculates a plurality of first state quantities based on the suspended load displacement and the suspended load speed from which the influence of the chord vibration is removed, and the target speed calculation unit 727 calculates the plurality of calculated first states.
- the turning target speed of the turning body 12 can be set based on one state quantity and a plurality of first control gains set by the control gain setting unit 726. As a result, it is possible to stably converge the runout of the suspended load in the turning direction by the turning operation of the swivel body 12 while suppressing the influence of the string vibration of the suspended load.
- the control gain setting unit 726 is an equation of state relating to the behavior of the suspended load, which is preset so as to include a term corresponding to at least the elastic deformation of the undulating body (boom 16, jib 18). Therefore, five control gains G1 to G5 corresponding to the five first state quantities are set from the equation of state in which the turning speed of the swivel body 12 (undulating body) is used as a variable. Then, the target speed calculation unit 727 turns the swivel body 12 from the five control gains set by the control gain setting unit 726 and the current values of the five state quantities calculated by the control amount calculation unit 700F. The turning target speed, which is the target value of the speed, is calculated.
- the command information calculation unit 728 and the drive control unit 700 turn so that the turning speed of the turning body 12 becomes the turning target speed (including the magnitude and direction of the speed) calculated by the target speed calculation unit 727.
- the command information corresponding to the turning target speed is output to the drive unit 701.
- the control gain setting unit 726 sets the control gains G1 to G5 of each state quantity based on the equation of state considering the elastic deformation of the undulating body. Further, the target speed calculation unit 727 sets the turning target speed Vref of the turning body 12 based on each state quantity calculated by the control amount calculation unit 700F and each control gain set by the control gain setting unit 726. do. Since the above state quantities include the displacement and velocity of the tip of the undulating body in addition to the displacement and velocity of the suspended load, the suspension and undulating body can be combined with the rope length information of the suspended load rope. It is possible to control the turning runout of the suspended load while taking into account the relative position with the tip.
- the undulating body is elastically deformed such as bending due to the moment of inertia applied to the undulating body by the turning motion or the load of the suspended load, the swing in the turning direction of the suspended load can be stably converged. It will be possible.
- the plane of the crane 10 is formed.
- the first target state amount) is set, and the target state amount (first target state amount) of the suspended load speed and the tip speed of the undulating body is set to zero, respectively.
- a target position for converging the turning runout of the suspended load is set with reference to the position of the tip of the undulating body at the time when the control start signal is output. For this reason, like other swivel steady rest devices that control the swivel movement of the upper body so that the tip of the hoist is always moved to a position above the suspended load without considering the elastic deformation of the hoist. The tip portion does not frequently follow the movement of the suspended load and the turning direction is switched, and the swing of the suspended load can be quickly converged by controlling the turning operation according to the final target position.
- control gain setting unit 726 sets the five control gains G1 to G5 so that the integrated value with respect to the time of the weighted sum including the five state quantities and the turning speed of the turning body 12 is the smallest. Therefore, the control gain for quickly converging the turning runout of the suspended load can be set in a short time.
- a method for setting the control gain a method based on the so-called full-state method or a method based on the H infinity control may be adopted.
- the method of setting the control gain according to the present embodiment follows the so-called LQ optimum control (Linear Quadratic Optimal Control) (linear quadratic optimum control).
- the LQ optimum control has a feature that it is easy to design the control system to be robust against disturbance as compared with the above-mentioned pole arrangement method. Further, the LQ optimum control is characterized in that the design of the control system is easier than that of the H infinity control, and the effect is easily exhibited even under the influence of disturbance.
- the steady rest control of the suspended load in the radial direction (front-back direction) is realized in addition to the turning direction.
- the control target amount setting unit 720 is a displacement of the suspended load in the radial direction of the turning operation of the turning body 12.
- Target state quantity for further stopping the suspended load in the radial direction for a plurality of second state quantities including the radial displacement of the suspended load, the radial velocity of the suspended load, and the undulating angle of the undulating body. (Second target state amount) is set respectively.
- the control gain setting unit 726 is a state equation relating to the behavior of the suspended load, and is a plurality of second controls corresponding to the plurality of second state quantities, based on the second state equation in which the undulating angular velocity of the undulating body is a variable. Set the gain. Further, the control amount calculation unit 700F includes the undulating body length information output from the boom length acquisition unit 708 and the jib length acquisition unit 709, and the undulation angle output from the boom angle detection unit 711 and the jib angle detection unit 712.
- the target speed calculation unit 727 jib from the plurality of second control gains set by the control gain setting unit 726 and the current values of the plurality of second state quantities calculated by the control amount calculation unit 700F.
- the undulation target angular velocity which is the target value of the angular velocity in the undulation of 18, is calculated, and the command information calculation unit 728 jib so that the angular velocity in the undulation of the jib 18 becomes the undulation target angular velocity calculated by the target speed calculation unit 727.
- the command information corresponding to the undulation target angular velocity is output to the drive unit 702B.
- the runout in the radial direction of the suspended load is caused by the undulating motion of the undulating body (jib 18) while suppressing the influence of the string vibration of the suspended load. Can be stably converged.
- the swivel steady rest device 70 and the crane 10 provided with the swivel steady rest device 70 according to each embodiment of the present invention have been described above. According to such a configuration, in the crane 10, it is possible to stably converge the runout of the suspended load in the turning direction by the turning operation of the swivel body 12 while suppressing the influence of the string vibration of the suspended load. Further, it is possible to stably converge the runout in the radial direction of the suspended load by the undulating operation of the jib 18 while suppressing the influence of the string vibration of the suspended load.
- the present invention is not limited to these forms. The present invention can take, for example, the following modified embodiments.
- the steady rest control of the suspended load in the radial direction is executed in addition to the turning direction, but the present invention is not limited thereto. It may be an embodiment in which only the steady rest control in the turning direction of the suspended load is executed.
- the structure of the crane to which the swivel steady rest device 70 according to each of the above embodiments is applied is not limited to the crane 10 shown in FIGS. 1 and 5. It may be a crane having another structure.
- the control amount (state amount) and the number of corresponding control gains are not limited to the above, and at least five control amounts and control gains may be set for steady rest control in the turning direction, and the radius. In the steady rest control in the direction, at least three control amounts and control gains may be set.
- the crane includes a lower main body, an upper main body, an undulating body, a suspended load rope, a swivel drive unit, a swivel operation unit, an undulating body drive unit, an undulating operation unit, and a suspended load drive unit. It has an elevating operation unit and.
- the upper main body is rotatably supported by the lower main body around a turning center axis extending in the vertical direction.
- the undulating body is supported so as to be rotatable in the undulating direction around the rotation center axis horizontal to the upper body.
- the undulating body includes a undulating body base end portion and a undulating body tip portion opposite to the undulating body base end portion.
- the suspended load rope is hung from the tip of the undulating body and connected to the suspended load.
- the swivel drive unit can swivel drive the upper main body around the swivel center axis in the first swivel direction and in the second swivel direction opposite to the first swivel direction, respectively.
- the turning operation unit receives an operation for turning and driving the upper main body. In the turning operation unit, it is possible to switch between a turning position for turning the upper main body in the first turning direction and the second turning direction, and a neutral position for stopping the turning of the upper main body. Is.
- the undulating body driving unit can rotate the undulating body around the rotation center axis in the undulating direction.
- the undulating operation unit receives an operation for undulating the undulating body.
- the undulating operation unit can be switched between an undulating position for undulating the undulating body and a neutral position for stopping the undulating of the undulating body.
- the suspended load drive unit can raise and lower the suspended load relative to the ground by winding and feeding the suspended load rope.
- the elevating operation unit receives an operation for elevating and lowering the suspended load.
- the elevating operation unit can be switched between an elevating position for elevating and lowering the suspended load and a neutral position for stopping the elevating and lowering of the suspended load.
- the swivel steady rest device includes an undulating body length information acquisition unit, a swivel angle detecting unit, an undulating angle detecting unit, an undulating body displacement detecting unit, an undulating body speed detecting unit, a suspended load displacement detecting unit, and a suspended load.
- Velocity detection unit rope length information acquisition unit, suspension load amount information acquisition unit, control start condition determination unit, target state quantity setting unit, control gain setting unit, filter characteristic setting unit, and filter processing unit.
- the undulating body length information acquisition unit acquires undulating body length information which is information corresponding to the length of the undulating body in the undulating body longitudinal direction which is the direction connecting the undulating body base end portion and the undulating body tip portion. And output.
- the turning angle detecting unit detects and outputs a turning angle around the turning center axis of the upper body.
- the undulation angle detecting unit detects and outputs the undulation angle of the undulating body around the rotation center axis.
- the undulating body displacement detecting unit detects and outputs the displacement of the undulating body tip portion, which is the displacement of the undulating body tip portion in the turning direction.
- the undulating body speed detecting unit detects and outputs the undulating body tip speed, which is the speed of the undulating body tip in the turning direction.
- the suspended load displacement detecting unit detects the suspended load displacement, which is the displacement of the suspended load with respect to the tip of the undulating body, and outputs a signal corresponding to the suspended load displacement.
- the suspended load speed detecting unit detects the suspended load speed, which is the amount of change in the suspended load displacement with respect to the tip of the undulating body per unit time, and outputs a signal corresponding to the suspended load speed.
- the rope length information acquisition unit acquires and outputs rope length information which is information corresponding to the length of the suspended load rope between the tip of the undulating body and the suspended load.
- the suspension load amount information acquisition unit acquires and outputs suspension load amount information which is information regarding the weight of the suspension load.
- the control start condition determining unit is the turning operation unit after the turning drive unit turns the upper main body in a predetermined turning direction in response to the turning operation unit being set to the turning position. It is determined whether or not the turning steady rest control start condition satisfied by setting all the operating units of the undulating operation unit and the elevating operation unit to the neutral position is satisfied.
- the target state amount setting unit determines that the suspension load turning direction displacement, which is the displacement of the suspended load in the turning direction, A plurality of first state quantities including the suspended load turning direction speed, the displacement of the undulating body tip portion, the undulating body tip portion speed, and the turning angle, which are the speeds of the suspended load in the turning direction, are described at predetermined target positions. A first target state amount for stopping the suspended load in the turning direction is set.
- the control gain setting unit is a state equation relating to the behavior of the suspended load, and is a plurality of first controls corresponding to the plurality of first state quantities, based on the state equation in which the turning speed of the upper body is a variable. Set the gain.
- the filter characteristic setting unit sets the filter characteristics based on the natural frequency of the string vibration of the suspended load rope generated between the tip of the undulating body and the suspended load.
- the filter processing unit receives signals of the signal corresponding to the suspended load displacement output from the suspended load displacement detecting unit and the signal corresponding to the suspended load speed output from the suspended load speed detection unit. , The filter process for removing the frequency component corresponding to the natural frequency of the chord vibration of the suspended load is executed based on the filter characteristic set by the filter characteristic setting unit.
- the filter processing unit is a subject composed of a signal corresponding to the suspended load displacement subjected to the filtering process and a signal corresponding to the suspended load displacement subjected to the filtering process.
- the processing suspension speed is output respectively.
- the state quantity calculation unit includes the undulating body length information output from the undulating body length information acquisition unit, the turning angle output from the turning angle detecting unit, and the undulating angle output from the undulating angle detecting unit.
- the current values of the plurality of first state quantities are calculated respectively. ..
- the target speed calculation unit is based on the plurality of first control gains set by the control gain setting unit and the current values of the plurality of first state quantities calculated by the state quantity calculation unit. Calculate the turning target speed, which is the target value of.
- the command information output unit outputs command information corresponding to the turning target speed to the turning drive unit so that the turning speed of the upper body becomes the turning target speed calculated by the target speed calculation unit. do.
- the filter characteristic setting unit sets the filter characteristics based on the natural frequency of the chord vibration of the suspended load rope generated between the tip of the undulating body and the suspended load, and the filter processing unit detects the suspended load displacement. It is detected because each signal of the signal corresponding to the suspended load displacement output from the unit and the signal corresponding to the suspended load speed output from the suspended load speed detection unit is filtered based on the filter characteristics. The influence of the chord vibration of the suspended load can be removed from the suspended load displacement and the suspended load speed. Then, the state quantity calculation unit calculates a plurality of first state quantities based on the suspended load displacement and the suspended load speed after the filter processing, and the turning target speed calculation unit controls the calculated plurality of first state quantities.
- the turning target speed of the turning body can be set based on the plurality of first control gains set by the gain setting unit. As a result, it is possible to stably converge the vibration of the suspended load in the turning direction by the turning operation of the upper main body while suppressing the influence of the string vibration of the suspended load.
- the equation of state for the control gain setting unit to set the plurality of first control gains is set to include a term corresponding to the elastic deformation of the undulating body.
- the target state amount setting unit determines that the control start condition determination unit satisfies the turning steady rest control start condition.
- the target state amount setting unit determines that the plane of the crane is satisfied.
- the undulating body is not elastically deformed in view
- the turning angle, the displacement of the undulating body tip, and the displacement of the suspended load in the turning direction are described with the position vertically below the tip of the undulating body as the target position. It is desirable to set each of the first target state quantities, and further set the first target state quantities of the suspended load turning direction speed and the undulating body tip speed to zero, respectively.
- the target position for converging the turning swing of the suspended load is set based on the position of the tip of the undulating body when the turning steady rest control start condition is satisfied, so that the undulating body is always set.
- the tip of the undulating body follows the movement of the suspended load and frequently switches the swivel direction.
- the swing of the suspended load can be converged at an early stage by controlling the turning motion according to the final target position without being performed.
- control gain setting unit sets the plurality of first control gains so that the integrated value with respect to the time of the weighted sum including the plurality of first state quantities and the turning speed is the smallest. Is desirable.
- the target state amount setting unit suspends the upper body in the radial direction of the turning operation. For a plurality of second state quantities including the displacement of the load in the radial direction of the suspended load, the velocity in the radial direction of the suspended load, and the undulation angle, the suspended load is further placed in the radial direction.
- the second target state amount for stationary is set respectively, and the control gain setting unit is based on the second state equation relating to the behavior of the suspended load and using the undulation angle of the undulating body as a variable.
- a plurality of second control gains corresponding to the plurality of second state quantities are set, and the state quantity calculation unit uses the undulating body length information output from the undulating body length information acquisition unit and the undulating angle.
- the undulation angle output from the detection unit, the undulation tip displacement output from the undulation displacement detection unit, the undulation tip speed output from the undulation speed detection unit, and the filter processing.
- the plurality of second states are based on the suspension load amount information output from the amount information acquisition unit and the second target state amount of the plurality of second state amounts set by the target state amount setting unit.
- the target speed calculation unit has the plurality of second control gains set by the control gain setting unit and the plurality of second state quantities calculated by the state quantity calculation unit.
- the undulation target angular velocity which is the target value of the angular velocity in the undulation of the undulating body, is calculated from the current value, and the command information output unit calculates the undulating target in which the angular velocity in the undulation of the undulating body is calculated by the target speed calculation unit. It is desirable to output command information corresponding to the undulation target angular velocity to the undulating body driving unit so as to have an angular velocity.
- the runout in the radial direction of the suspended load is stably converged by the undulating motion of the undulating body while suppressing the influence of the string vibration of the suspended load. It becomes possible.
- the crane includes a lower main body, an upper main body, an undulating body, a suspended load rope, a swivel drive unit, a swivel operation unit, an undulating body drive unit, an undulating operation unit, and a suspended load drive unit. It is provided with an elevating operation unit and the above-mentioned turning steady rest device.
- a crane turning steady rest device and a crane capable of stably converging the turning vibration of a suspended load caused by the turning operation of a crane while suppressing the influence of the string vibration of the suspended load. ..
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Jib Cranes (AREA)
- Control And Safety Of Cranes (AREA)
Abstract
L'invention concerne un dispositif d'arrêt de giration (70) comprenant une unité de calcul de quantité de commande (700F), une unité de paramétrage de gain de commande (726) et une unité de calcul de vitesse cible (727). Lorsque la manœuvre de rotation est arrêtée, l'unité de calcul de quantité de commande (700F) calcule cinq valeurs d'état, qui sont le déplacement de la charge suspendue, la vitesse de la charge suspendue, le déplacement rotatif de la pointe d'un corps de montée/descente (18), la vitesse de rotation de la pointe du corps de montée/descente (18), et l'angle de rotation d'un corps de rotation (12). L'unité de paramétrage de gain de commande (726) définit cinq gains de commande correspondant aux valeurs d'état respectives sur la base d'une équation d'état prédéterminée. L'unité de processus de filtrage (700H) effectue, par rapport au déplacement de la charge suspendue et à la vitesse de charge suspendue, un processus de filtrage afin d'éliminer l'influence de la vibration de chaîne d'un câble de suspension de charge (50). L'unité de calcul de vitesse cible (727) calcule la vitesse de rotation afin de supprimer la giration de la charge suspendue, sur la base des cinq valeurs d'état et des cinq gains de commande.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020149622A JP7414672B2 (ja) | 2020-09-07 | 2020-09-07 | クレーンの旋回振れ止め装置およびこれを備えたクレーン |
JP2020-149622 | 2020-09-07 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2022050023A1 true WO2022050023A1 (fr) | 2022-03-10 |
Family
ID=80491694
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2021/029762 WO2022050023A1 (fr) | 2020-09-07 | 2021-08-12 | Dispositif d'arrêt de giration destiné à une grue et grue équipée de celui-ci |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP7414672B2 (fr) |
WO (1) | WO2022050023A1 (fr) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11116182A (ja) * | 1997-10-13 | 1999-04-27 | Mitsubishi Electric Engineering Co Ltd | クレーンの振れ止め装置 |
JP2009083977A (ja) * | 2007-09-28 | 2009-04-23 | Daito Denki Kk | クレーンの振れ止め制御方法および振れ止め制御システム |
WO2010079801A1 (fr) * | 2009-01-07 | 2010-07-15 | 学校法人慶応義塾 | Dispositif et procédé de commande de grue à flèche |
JP2011111242A (ja) * | 2009-11-24 | 2011-06-09 | Fuji It Co Ltd | 旋回クレーンの振れ止め制御方法及び制御装置 |
-
2020
- 2020-09-07 JP JP2020149622A patent/JP7414672B2/ja active Active
-
2021
- 2021-08-12 WO PCT/JP2021/029762 patent/WO2022050023A1/fr active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11116182A (ja) * | 1997-10-13 | 1999-04-27 | Mitsubishi Electric Engineering Co Ltd | クレーンの振れ止め装置 |
JP2009083977A (ja) * | 2007-09-28 | 2009-04-23 | Daito Denki Kk | クレーンの振れ止め制御方法および振れ止め制御システム |
WO2010079801A1 (fr) * | 2009-01-07 | 2010-07-15 | 学校法人慶応義塾 | Dispositif et procédé de commande de grue à flèche |
JP2011111242A (ja) * | 2009-11-24 | 2011-06-09 | Fuji It Co Ltd | 旋回クレーンの振れ止め制御方法及び制御装置 |
Also Published As
Publication number | Publication date |
---|---|
JP2022044142A (ja) | 2022-03-17 |
JP7414672B2 (ja) | 2024-01-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11919749B2 (en) | Crane, and method for controlling such a crane | |
JP6834887B2 (ja) | クレーン | |
WO2019177021A1 (fr) | Grue et procédé de commande de grue | |
WO2014076935A1 (fr) | Dispositif d'arrêt progressif pour engins de chantier | |
WO2018230601A1 (fr) | Grue | |
WO2022050023A1 (fr) | Dispositif d'arrêt de giration destiné à une grue et grue équipée de celui-ci | |
CN111108059A (zh) | 起重机 | |
JP7299123B2 (ja) | 吊り荷の水平移動補助装置およびこれを備えたクレーン、吊り荷の水平移動方法 | |
JP6729842B2 (ja) | クレーン | |
JP7151223B2 (ja) | クレーンおよびクレーンの制御方法 | |
WO2019177164A1 (fr) | Grue | |
JP2021050083A (ja) | 吊り荷ロープの振れ角度検出装置およびこれを備えたクレーン | |
WO2021065835A1 (fr) | Dispositif d'arrêt de giration destiné à une grue et grue ainsi équipée | |
CN113135512B (zh) | 起重机臂架监控方法、装置、系统及起重机 | |
WO2021246490A1 (fr) | Dispositif de commande de levage dynamique, et grue | |
WO2019167893A1 (fr) | Grue et procédé d'acquisition d'une longueur d'un outil d'élingage | |
JP2022190556A (ja) | クレーン | |
WO2023085388A1 (fr) | Dispositif anti-balancement de grue et grue équipée de celui-ci | |
JP2024131790A (ja) | クレーンの制御装置およびこれを備えたクレーン | |
JP2011219213A (ja) | クレーン | |
JP6555457B1 (ja) | クレーン及び玉掛け具の長さ取得方法 | |
WO2020166690A1 (fr) | Dispositif de commande de levage et grue mobile | |
JP7513999B2 (ja) | 制御装置、クレーン、及びクレーンの制御方法 | |
WO2023176675A1 (fr) | Dispositif de calcul de position de crochet | |
CN111836774B (zh) | 起重机及起重机的控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 21864081 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 21864081 Country of ref document: EP Kind code of ref document: A1 |