WO2021065835A1 - Dispositif d'arrêt de giration destiné à une grue et grue ainsi équipée - Google Patents
Dispositif d'arrêt de giration destiné à une grue et grue ainsi équipée Download PDFInfo
- Publication number
- WO2021065835A1 WO2021065835A1 PCT/JP2020/036736 JP2020036736W WO2021065835A1 WO 2021065835 A1 WO2021065835 A1 WO 2021065835A1 JP 2020036736 W JP2020036736 W JP 2020036736W WO 2021065835 A1 WO2021065835 A1 WO 2021065835A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- undulating
- turning
- suspended load
- unit
- boom
- 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 swivel steady rest device and a crane provided 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 rotating 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 hanging 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 a swing of the suspended load (swing swing) occurs when the upper swing body stops swinging, 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.
- the undulating body When the crane turns, the undulating body may bend (elastic deformation) depending on the moment of inertia applied to the undulating body and the weight of the suspended load. Since the technique described in Patent Document 1 does not consider such elastic deformation of the undulating body, it is between the tip of the undulating body that is moved so as to follow the suspended load in a plan view and the suspended load. Misalignment is likely to occur. As a result, there is a problem that the runout of the suspended load is likely to be promoted due to the misalignment, and the runout of the suspended load is difficult to settle.
- An object of the present invention is to provide a crane swing steady rest device and a crane capable of stably converging the swing runout of a suspended load caused by the swinging motion of the crane.
- a swing steady rest device for a crane
- the swing steady rest device is a lower main body and an upper main body rotatably supported around a turning central axis extending in the vertical direction by the lower main body. And, it is supported so as to be rotatable in the undulating direction around the center axis of rotation horizontal to the upper body, and includes the undulating body base end portion and the undulating body tip portion opposite to the undulating body base end portion.
- a turning drive unit capable of turning and driving, and a turning operation unit that receives an operation for turning and driving the upper main body, and the upper main body is moved in the first turning direction and the second turning direction.
- the turning operation unit and the undulating body which can be switched between the turning position for turning and the neutral position for stopping the turning of the upper body, and the undulating body are rotated in the undulating direction around the rotation center axis.
- An undulating body driving unit capable of undulating, and an undulating operation unit that accepts an operation for undulating the undulating body, and stops the undulating position for undulating the undulating body and the undulation of the undulating body.
- An undulating operation unit that can be switched between the neutral position and the suspended load that can be raised and lowered relative to the ground by winding and feeding the suspended load rope.
- Between the drive unit and the elevating operation unit that accepts the operation for raising and lowering the suspended load between the elevating position for raising and lowering the suspended load and the neutral position for stopping the ascending and descending of the suspended load.
- the suspended load connected to the suspended load rope after the turning operation of the upper main body is stopped, which is mounted on a crane having an elevating and lowering operation unit which can be switched by, of the upper main body with the tip of the undulating body as a fulcrum.
- This is a crane swing steady rest device that can suppress the swing swing of a suspended load, which is a phenomenon of swinging along the swing direction.
- the swivel steady rest device acquires and outputs undulating body length information which is information corresponding to the length of the undulating body in the longitudinal direction of the undulating body, which is the direction connecting the base end portion of the undulating body and the tip end portion of the undulating body.
- the angle detection unit the undulating body displacement detection unit that 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 which is the speed of the undulating body tip portion in the turning direction.
- the undulating body speed detecting unit that detects and outputs the tip speed
- the suspended load displacement detecting unit that detects and outputs the suspended load displacement that is the displacement of the suspended load with respect to the undulating body tip, and the above-mentioned with respect to the undulating tip.
- a rope length information acquisition unit that acquires and outputs rope length information, which is information
- a suspension load amount information acquisition unit that acquires and outputs suspension load amount information, which is information on the weight of the suspended load, and the turning operation.
- the control start condition determination unit that determines whether or not the turning steady rest control start condition, which is established by setting all the operation units of the above to the neutral position, and the control start condition determination unit determine the turning.
- the suspension load displacement which is the displacement of the suspended load in the turning direction
- the hanging load speed which is the speed of the suspended load in the turning direction
- Target state amount setting for setting a target state amount for stopping the suspended load at least in the turning direction at a predetermined target position for a plurality of state amounts including the displacement, the tip speed of the undulating body, and the turning angle.
- the suspension speed detection The suspension speed output from the unit, the rope length information output from the rope length information acquisition unit, the suspension load information output from the suspension load information acquisition unit, and the target state.
- a state quantity calculation unit that calculates the current values of the plurality of state quantities based on the target state quantities of the plurality of state quantities set by the quantity setting unit, and at least a term corresponding to the elastic deformation of the undulating body.
- a plurality of control gains corresponding to each of the plurality of state quantities are set based on the state equation relating to the behavior of the suspended load, which is preset to include the state equation and the turning speed of the upper body is used as a variable.
- the turning target speed calculation unit that calculates the turning target speed, and the turning target speed with respect to the turning drive unit so that the turning speed of the upper body becomes the turning target speed calculated by the turning target speed calculation unit. It is provided with a command information output unit that outputs command information corresponding to.
- FIG. 1 is a side view of the crane 10 according to the present embodiment. Note that FIG. 1 shows the directions of “up”, “down”, “front” and “rear”, and the 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) rotatably supported by the traveling body 14 around a turning center axis extending in the vertical direction, a boom 16 (undulating body), and a mast. 20 and. Further, a counterweight 13 for adjusting the balance of the crane 10 is loaded on the rear portion of the swivel body 12.
- a cab 15 is provided at the front end 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 (base end of the undulating body), one or more 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 a 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 side of the lower boom 16A in that order.
- the upper boom 16E is detachably added to the tip 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 mast 20 has a base end and a rotating end, and the base end is rotatably connected to the swivel body 12.
- the rotation shaft of the mast 20 is parallel to the rotation shaft of the boom 16 and is located immediately behind the rotation shaft 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 standing posture shown in FIG. This contact regulates the boom 16 from being fanned backwards by strong winds 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 is further equipped with various winches.
- the crane 10 includes a boom undulating winch 30 for raising and lowering the boom 16, a main winding winch 34 and a auxiliary winding winch 36 for hoisting and lowering the suspended load.
- the crane 10 includes a boom undulating rope 38, a main winding rope 50 (suspended load rope) hanging from the upper boom 16E and connected to the suspended load, and a supplementary winding rope 60.
- the main winding winch 34 and the auxiliary winding winch 36 are installed near the base end of the boom 16.
- the boom undulating winch 30 is installed on the swivel body 12. The positions of these winches 30, 32, 34, 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 extends 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 main winding winch 34 winds up and lowers the suspended load with the main winding rope 50.
- the main winding rope 50 hangs from the upper boom 16E of the boom 16 and is connected to the suspended load.
- a main winding guide sheave 54 is arranged on the upper boom 16E, and a main winding sheave block in which a plurality of main winding point sheaves 56 are arranged in the width direction at a position adjacent to the main winding guide sheave 54 is provided. It is provided.
- the main winding rope 50 drawn out from the main winding winch 34 is hung on the idler sheave 34S and the main winding guide sheave 54 in this order, and the main winding point sheave 56 of the sheave block and the main hook 57 for suspension are used. It is hung between the sheave 58 and the sheave 58 of the sheave block provided in. 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 boom 16. The hook 57 is wound and unwound. As a result, the suspended load can be hoisted and unwound.
- the auxiliary winding winch 36 winds up and lowers the suspended load by the auxiliary winding rope 60.
- the auxiliary winding guide sheave 64 is rotatably provided coaxially with the main winding guide sheave 54, and the auxiliary winding point sheave (not shown) can rotate at a position adjacent to the auxiliary 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 and the auxiliary winding guide sheave 64 in this order, and is hung from the auxiliary winding point sheave. 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 swing 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, an undulating drive unit 702 (undulating body drive unit, boom drive unit), and a winch drive unit 703 (suspended load drive unit).
- the swivel drive unit 701 generates a driving force capable of swiveling the swivel body 12 around the swivel center axis in the first swivel direction and in the second swivel direction opposite to the first swivel direction.
- the swivel drive unit 701 includes a hydraulic motor that swivels the swivel body 12 by receiving the supply of hydraulic oil.
- the undulation drive unit 702 generates a driving force for rotating the boom undulation winch 30, and it is possible to rotate the boom 16 around the rotation center axis.
- the undulation drive unit 702 includes a hydraulic motor that rotates the boom undulation 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 winch 34 winds and unwinds the main winding rope 50 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 motor that rotates the winch 34 for main winding by receiving the supply of hydraulic oil.
- 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), an undulation operation unit 705 (undulation operation unit, boom undulation operation unit), and 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 undulation operation unit 705 receives an operation for undulating the boom 16 by the undulation drive unit 702.
- the undulation operation unit 705 is switchable between an undulating position for undulating the boom 16 and a neutral position for stopping the undulation of the boom 16.
- 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 switchable between an elevating position for raising and lowering the suspended load and a neutral position for stopping the ascending and descending 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 undulation operation unit 705, and the winch operation unit 706 to the swivel drive unit 701, the undulation drive unit 702, and the winch drive unit 703. Input each 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 the swivel direction (rotation direction) of the swivel body 12 with the main winding point sheave 56 of the upper boom 16E as a fulcrum. It is possible to suppress the swirling runout of the suspended load, which is a phenomenon of swinging along the line.
- the swivel 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 has a boom length information acquisition unit 708 (undulating body length information acquisition unit).
- the boom length information acquisition unit 708 acquires information (length information) regarding the length of the boom 16 used in the swivel steady rest control of the suspended load executed by the vibration damping control unit 700E. That is, the boom length information acquisition unit 708 is a boom in the boom longitudinal direction (undulating body longitudinal direction), which is a direction connecting the base end portion (undulating body base end portion) and the tip portion (undulating body tip portion) of the boom 16. Information corresponding to the length of 16 (undulating body length information) is acquired and output.
- the boom length information acquisition unit 708 has a storage unit (not shown), and acquires the length information of the boom 16 from the storage unit.
- the operation unit 700B has an input unit (not shown), the operator inputs the length information of the boom 16 through the input unit, and the boom length information acquisition unit 708 inputs the information. It may be the mode to acquire.
- the detection unit 700D includes a swivel angle detection unit 710, a boom undulation angle detection unit 711 (undulation angle detection unit), a boom top swivel direction displacement detection unit 713 (undulation body displacement detection unit), and a boom top swivel direction speed detection unit. 714 (undulating body velocity detection unit), rope swivel direction runout angle detection unit 715 (suspended load displacement detection unit, rope runout angle detection unit), and rope swivel direction runout angular velocity detection unit 716 (hanging load speed detection unit, rope runout). It has an angular velocity 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 (swivel body 12).
- the turning angle detection unit 710 includes a gyro 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 undulation angle detection unit 711 detects and outputs the undulation angle around the rotation center axis of the boom 16.
- the boom undulation 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 undulation angle detection unit 711 may detect the relative angle with respect to other objects.
- the boom top turning direction displacement detection unit 713 detects and outputs the displacement amount (displacement of the undulating body tip portion) of the tip portion (upper boom 16E) of the boom 16 in the turning direction.
- the boom top turning direction displacement detection unit 713 includes an acceleration sensor (not shown) attached to the upper boom 16E and a calculation unit.
- the acceleration sensor measures the acceleration of the upper boom 16E in the turning direction, and the calculation unit converts the measured acceleration into a displacement (displacement amount) by integrating the measured acceleration twice with respect to time, and outputs the displacement. To do.
- the boom top turning direction speed detection unit 714 detects and outputs the speed of the upper boom 16E in the turning direction (velocity at the tip of the undulating body).
- the boom top turning direction speed detecting unit 714 includes the acceleration sensor and the calculation unit shared with the boom top turning direction displacement detecting unit 713. The acceleration measured by the acceleration sensor attached to the upper boom 16E is converted into a speed by the calculation unit once integrating with time, and the speed is output.
- the rope turning direction runout angle detection unit 715 detects and outputs the runout angle of the main winding rope 50 with respect to the vertical direction when viewed along the radial direction in the turning operation of the turning body 12.
- the rope turning direction swing angle detecting unit 715 includes a jig (not shown) capable of swinging only in the turning direction on the upper boom 16E, and a tilt sensor mounted on the jig.
- the jig is locked to the main winding rope 50, and the inclination sensor detects and outputs the swing angle of the main winding rope 50 in the turning direction with respect to the boom 16 (vertical direction) as a swing angle.
- the rope turning direction runout angle detection unit 715 constitutes the suspended load displacement detection unit of the present invention.
- the rope turning direction runout angle detecting unit 715 detects and outputs the runout angle as a suspended load displacement which is a displacement of the suspended load with respect to the tip end portion (upper boom 16E) of the boom 16.
- the rope turning direction 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 per unit time.
- the rope turning direction runout angular velocity detection unit 716 includes a gyro sensor attached to the above jig, and the gyro sensor detects and outputs the runout angular velocity.
- the rope turning direction swing angular velocity detection unit 716 includes a camera attached to the upper boom 16E, acquires an image of the main hook 57 taken by the camera, and obtains an image of the main hook 57 (suspended load).
- the swing angle in the turning direction of the above may be detected and output as the swing angle, and the angular velocity may be output by differentiating the swing angle once.
- the rope turning direction swing angular velocity detection unit 716 constitutes the suspended load speed detection unit of the present invention.
- the rope turning direction runout angular velocity detection unit 716 detects and outputs the runout angular velocity as the suspension angular velocity, which is the amount of change in the suspension load displacement with respect to the tip end portion (upper boom 16E) of the boom 16.
- the rope length detection unit 717 acquires and outputs rope length information which is information corresponding to the length of the suspended load rope between the boom tip and the suspended load. In the present embodiment, the distance between the main winding point sheave 56 of the upper boom 16E and the main hook 57 (sheave 58) is detected as the rope length.
- the rope length detection unit 717 has a rotation amount detection 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 part.
- the rope length detection unit 717 is estimated from the winch diameter of the main winding winch 34, the winch rotation amount detected by the rotation amount detection unit, and the winding layer of the main winding rope 50 detected by the winding layer detection 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 applied 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 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 boom 16 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 damping control unit 700E is composed of a CPU (Central Processing Unit), a ROM for storing a control program (Read Only Memory), a RAM (Random Access Memory) used as a work area of the CPU, and the like.
- the vibration suppression control unit 700E controls the control determination unit 719 (control start condition determination unit), the control target amount setting unit 720 (target state amount setting unit), and the control by executing the control program stored in the ROM by the CPU. It functions to include a quantity calculation unit 700F, a control gain setting unit 726, a turning target speed calculation unit 727, and a turning operation target calculation unit 728.
- the vibration damping control unit 700E controls the rotation and vibration suppression of the suspended load when the crane 10 stops the rotation operation, 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. Execute automatically.
- Rotational steady rest control corresponds to the satisfaction of the turning steady rest control start condition that is established when all the operating units of the 705 and winch operation unit 706 are set to the neutral positions. Is determined to start, 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, in such a state, the operation of the crane 10 is stopped after the turning operation of the turning body 12, and the suspended load connected to the main hook 57 is vertically below the upper boom 16E (main winding point sheave 56). It is desirable to be located in. 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 it is (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 includes at least five (plurality) including the suspended load turning direction displacement X1, the suspended load turning direction speed X2, the boom tip turning direction displacement X3, the boom tip turning direction speed X4, and the turning angle X5. ) Is set as a target amount for stopping the suspended load at least in the turning direction at a predetermined target position.
- 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 boom tip turning direction displacement X3 is the displacement of the upper boom 16E (main winding point sheave 56) in the turning direction
- the boom tip turning direction speed X4 is the speed of the upper boom 16E in the turning direction
- the turning angle X5 is the turning angle of the boom 16 (swivel body 12).
- FIG. 3 is a schematic plan view for explaining the swing steady rest control of the crane 10 according to the present embodiment.
- the rotation center axis of the rotation body 12 is set to the zero point.
- the xy coordinate system is shown with the direction in which the virtual center line of the boom 16 extends is the y direction and the direction orthogonal to the center line is the x direction.
- the xy coordinate system is set based on the virtual center line of the boom 16 assuming that the boom 16 is not elastically deformed. The boom 16 is bent to the upstream side in the turning direction in the turning operation of the turning body 12 stopped before the state shown in FIG.
- main winding rope 50 connected to the tip end portion of the boom 16 extends further toward the upstream side in the turning direction than the tip end portion of the boom 16.
- 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 boom 16 as the target boom tip position, and sets the position vertically below the target boom tip position as the target suspension. Set as the load position. Therefore, through the swivel steady rest control, the swivel speed and the swivel direction of the swivel body 12 are automatically controlled so that the displacement of the suspended load at least in the swivel direction becomes zero at the target suspended load position.
- the target turning angle in the XY coordinate system for arranging the tip of the boom 16 and the suspended load at the target boom tip position and the target suspended load position, respectively, is defined as ⁇ ref.
- control target amount setting unit 720 can calculate the target boom tip position and the target suspended load position from the target turning angle ⁇ ref, the undulation angle of the boom 16, and the length of the boom 16. Further, the control target amount setting unit 720 sets the target amount to zero for the speed control amount among the above-mentioned control amounts because the purpose is to keep the suspended load stationary.
- the turning speed is defined as a positive (positive) value in the left turning direction and a negative (negative) value in the right turning direction.
- the control amount calculation unit 700F detects each of the control amounts of the suspended load turning direction displacement X1, the suspended load turning direction speed X2, the boom tip turning direction displacement X3, the boom tip turning direction 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 information acquisition unit 708, the turning angle output from the turning angle detecting unit 710, and the boom undulation angle detecting unit 711.
- the current values of the five state quantities are calculated based on the target state quantities of the five state quantities set by the setting unit 720.
- the suspended load turning direction displacement X1 is the displacement in the turning direction of the suspended load relative to the tip position of the boom 16 plus the boom tip turning direction displacement X3. 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 value obtained by adding the boom tip turning direction speed X4 to the relative speed of the suspended load with respect to the tip position of the boom 16. 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 turn direction, and is detected by the rope turn direction runout angular velocity detection unit 716.
- boom tip turning direction displacement X3 and the boom tip turning direction speed X4 are detected by the boom top turning direction displacement detecting unit 713 and the boom top turning direction 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 a control model that considers the influence of elastic deformation (deflection) of the boom 16.
- Set the control gain of each control amount 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.
- 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.
- the control gain setting unit 726 sets the control gains based on a predetermined control model so as to minimize the time integration of the weighted sum of each of the above control quantities and input amounts (turning speeds). ..
- the influence of elastic deformation generated on the boom 16 is taken into consideration by the inertial force generated by the moment of inertia of the boom 16 and the external force in the turning direction generated by the swing of the suspended load.
- 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.
- a state space expression in consideration of the elasticity of the boom 16 can be obtained by combining the equations expressing the elasticity of the boom 16.
- the control model according to this embodiment will be described in detail later.
- the turning target speed calculation unit 727 turns 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 the body 12 is calculated.
- the turning operation target calculation unit 728 is 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 turning target speed calculation unit 727. Is calculated. Specifically, the turning operation target calculation unit 728 calculates the turning operation target amount based on the turning target speed Vref calculated by the turning 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.
- FIG. 4 is a flowchart of the swing steady rest control of the crane 10 according to the present embodiment.
- known parameters are set and stored in advance in a storage unit (not shown) in the vibration damping control unit 700E (step S01).
- the known parameters include the length of the boom 16, the elastic modulus of the boom 16, the moment of inertia of the boom 16, and the like.
- the length of the boom 16 is acquired and referred to by the boom length information acquisition unit 708 of the information acquisition unit 700C.
- the elastic modulus of the boom 16 and the moment of inertia of the boom 16 are included as I and k ⁇ , respectively, by replacing the jib with a boom in the formula 17 described later.
- the control determination unit 719 determines whether or not the switch (input unit) for starting the swivel steady rest control arranged in the cab 15 is pressed (ON) (step S02).
- the switch is turned on (YES in step S02)
- the control determination unit 719 is in the flow immediately before the case where the flowchart shown in FIG. 4 is repeated (repetition from steps S10 to S02 in FIG. 4).
- the detection unit 700D updates the detection parameters (step S04).
- the boom undulation angle detection unit 711, the rope length detection unit 717, and the suspension load amount detection unit 718 detect the undulation angle of the boom 16, the extension amount of the main winding rope 50, and the suspension load amount (load), respectively. ,Update.
- control target amount setting unit 720 sets the parameters of the control model (step S05). Specifically, the control target amount setting unit 720 sets the target amount of each control amount as described above.
- control gain setting unit 726 determines the control gain (feedback gain) (step S06). Specifically, the control gain setting unit 726 determines the above-mentioned G1, G2, G3, G4 and G5, respectively, and proceeds to step S08.
- step S03 when the switch is ON in the previous flow (YES in step S03), the values acquired in the previous flow are maintained for each parameter and gain in steps S04 to S06 (step S07). The process proceeds to step S08.
- step S08 the control amount calculation unit 700F updates the state parameter. Specifically, the control amount calculation unit 700F calculates the suspended load turning direction displacement X1, the suspended load turning direction speed X2, the boom tip turning direction displacement X3, the boom tip turning direction speed X4, and the turning angle X5, respectively.
- the turning target speed calculation unit 727 calculates the turning target speed Vref (step S09).
- the turning operation target 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 turning operation target 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 turning target speed calculation unit 727. The turning operation target command value for is calculated.
- step S02 when the switch (input unit) for starting the turning steady rest control is not pressed (NO in step S02), the vibration damping control unit 700E automatically moves the crane 10 for the purpose of turning steady rest control. Prohibit control.
- FIG. 5 is a side view of the crane 10 according to the second embodiment of the present invention.
- FIG. 6 is a block diagram of the swing steady rest device 70 of the crane 10 according to the present embodiment.
- the differences from the first embodiment will be mainly described, and the common points will be omitted.
- the crane 10 further includes a jib 18 (undulating body) as compared with the crane 10 of FIG.
- 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 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 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 standing 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 includes a plurality of sheaves arranged at the rotating end of the rear strut 21 and arranged in the width direction.
- the rear strut idler sheaves 52 and 62 are arranged in a portion of the rear strut 21 located closer to the base end portion than the central portion in the longitudinal direction, and include a plurality of sheaves arranged in the width direction, respectively.
- 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.
- the rear strut 21 described above is arranged on the rear side of the front strut 22 as shown in FIG. 1, 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 includes a plurality of sheaves arranged at the rotating end of the front strut 22 and 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, respectively.
- the crane 10 further includes a jib undulating winch 32 for rotating the jib 18 in the undulating direction, and a jib undulating rope 44.
- the jib undulating winch 32 winds and unwinds the jib undulating rope 44 that is 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 between the sheave blocks 47 and 48 a plurality of times.
- the operation unit 700B further has a jib undulation operation unit 705A (undulation operation unit, jib undulation operation unit) as compared with FIG.
- the drive unit 700A further includes a jib undulating drive unit 702A (undulation body drive unit, jib drive unit).
- the information acquisition unit 700C of the swivel steady rest device 70 further has a jib length information acquisition unit 709 (undulation body length information acquisition unit), and the detection unit 700D is a jib undulation angle detection unit 712 (undulation angle detection unit). Further has.
- the detection unit 700D replaces the boom top turning direction displacement detecting unit 713 and the boom top turning direction speed detecting unit 714 in FIG. 2 with the jib top turning direction displacement detecting unit 713A (undulating body displacement detecting unit) and the jib top turning direction speed. It has a detection unit 714A (undulating body velocity detection unit).
- the jib undulation operation unit 705A is capable of switching between a jib undulation position for undulating the jib 18 and a neutral position for stopping the undulation of the jib 18.
- the jib undulation drive unit 702A is capable of rotating the jib 18 around the second rotation center axis in the undulation direction.
- the jib length information acquisition unit 709 acquires and outputs jib length information which is information corresponding to the length of the jib 18 in the jib longitudinal direction which is the direction connecting the jib base end portion and the jib tip end portion.
- the jib undulation angle detection unit 712 detects and outputs the undulation angle of the jib 18 around the second rotation center axis.
- the jib top turning direction displacement detection unit 713A detects and outputs the displacement of the jib tip in the turning direction (jib tip displacement) as the undulating body tip displacement.
- the jib top turning direction speed detection unit 714A detects and outputs the speed of the jib tip in the turning direction (jib tip speed) as the undulating body tip speed.
- control amount calculation unit 700F calculates the jib tip turning direction displacement X3A and the jib tip turning direction speed X4A instead of the boom tip turning direction displacement X3 and the boom tip turning direction speed X4.
- the jib tip turning direction displacement X3A is the displacement of the tip of the jib 18 in the turning direction as described above
- the jib tip turning direction speed X4A is the speed of the tip of the jib 18 in the turning direction.
- step S01 the length information of the jib 18, the elastic modulus of the jib 18, and the moment of inertia of the jib are stored in storage units (not shown). Further, in step S04, the undulation angle of the jib 18 is further detected by the jib undulation angle detection unit 712. Further, in step S05, when the control determination unit 719 determines that the turning steady rest control start condition is satisfied and the control start signal is output, the control target amount setting unit 720 receives the suspended load turning direction displacement X1.
- the target state quantities are set for at least five (plurality) control amounts (state amounts) of the suspended load turning direction speed X2, the jib tip turning direction displacement X3A, the jib tip turning direction speed X4A, and the turning angle X5, respectively.
- the control gain setting unit 726 sets the control gains G1 to G5, and in step S08, the control amount calculation unit 700F from the boom length information acquisition unit 708 and the jib length information acquisition unit 709.
- the boom length information and the jib length information output, respectively, the turning angle output from the turning angle detection unit 710, the boom undulation angle output from the boom undulation angle detection unit 711, and the jib undulation angle.
- the jib tip turning direction displacement X3A and the jib tip turning direction are calculated.
- the boom 16 as the undulating body is replaced with the jib 18, so that the boom 16 is connected to the main winding rope 50 hanging from the tip of the jib 18.
- the swivel steady rest control of the suspended load (main hook 57) is realized.
- FIG. 7 is a block diagram of the swivel steady rest device 70 of the crane 10 according to the third embodiment of the present invention.
- FIG. 8 is an enlarged side view of the tip of the boom 16 of the crane 10 according to the third embodiment of the present invention.
- FIG. 9 is a block diagram of a suspended load displacement detecting unit 715A and a suspended load speed detecting unit 716A of the crane 10 according to the third embodiment of the present invention.
- the differences from the first embodiment will be mainly described, and the common points will be omitted.
- the structure of the crane 10 according to the present embodiment is the same as that of the crane 10 shown in FIG.
- the structure for acquiring the suspended load displacement and the suspended load speed is different from that in the first embodiment.
- the swivel steady rest device 70 (FIG. 7) according to the present embodiment has a suspended load displacement detection unit 715A instead of the rope swivel direction swing angle detection unit 715 of FIG. 2, and the rope swivel direction of FIG. It has a suspended load speed detecting unit 716A instead of the swing angular velocity detecting unit 716.
- the swivel steady rest device 70 has a camera 80 (photographing device), a camera jig 80S, and a recognition marker 57S (target object).
- the camera 80 is supported by a camera jig 80S attached to the tip end portion (upper boom 16E) of the boom 16.
- the camera jig 80S is fastened to the lattice (frame) of the boom 16 with bolts or the like, and the posture of the camera 80 is adjusted so that the shooting direction of the camera 80 faces downward even if the undulation angle of the boom 16 changes. It has a function to adjust.
- the adjustment function may be possessed by the camera 80 itself.
- the recognition marker 57S is attached to a part of the hook 57. As a result, the recognition marker 57S moves integrally with the suspended load.
- the camera 80 captures the recognition marker 57S (target object) associated with the suspended load and outputs the captured image information.
- the suspended load displacement detecting unit 715A and the suspended load speed detecting unit 716A include an image processing unit 81 and a detection amount calculation unit 82 (both are calculation units) in addition to the above camera 80.
- the image processing unit 81 and the detection amount calculation unit 82 acquire the image information input from the camera 80 as position information by image processing, and input the image information to the control amount calculation unit 700F via a wired cable (not shown) or wireless communication. To do. More specifically, the image processing unit 81 performs image processing such as known template matching, edge detection, and corner detection on the image information captured and output by the camera 80, and detects the information after the image processing. Input to the quantity calculation unit 82. The detection amount calculation unit 82 acquires the coordinates of the marker 57S based on the size of the recognition marker 57S included in the received information in pixel units and the distance information from the camera 80 to the marker 57S acquired in advance.
- the detection amount calculation unit 82 calculates the speed of the suspended load, particularly the swing angle velocity of the suspended load in the turning direction, by numerically differentiating the displacement (swing angle) of the suspended load.
- the control amount calculation unit 700F has each of the suspended load turning direction displacement X1, the suspended load turning direction speed X2, the boom tip turning direction displacement X3, the boom tip turning direction speed X4, and the turning angle X5, as in the first embodiment.
- the control amount the deviation between the detection value detected by each detection unit of the detection unit 700D 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 information acquisition unit 708, the rotation angle output from the rotation angle detection unit 710, and the boom undulation angle detection unit 711.
- the current values of the five control amounts (state amounts) are calculated.
- the suspended load turning direction displacement X1 is obtained by adding the boom tip turning direction displacement X3 to the suspended load turning direction displacement X1'when viewed from the tip end portion (upper boom 16E) of the boom 16. It is calculated by the following equation 5.
- X1' is the suspended load displacement seen from the tip of the boom 16 acquired by the suspended load displacement detection unit 715A.
- the suspended load turning direction speed X2 is obtained by adding the boom tip turning direction speed X4 to the speed X2'in the suspended load turning direction when viewed from the tip of the boom 16, and is calculated by the following equation 6. Will be done.
- the boom tip turning direction displacement X3, the boom tip turning direction speed X4, and the turning angle X5 are detected or calculated in the same manner as in the first embodiment. Further, the calculation process by the control gain setting unit 726, the turning target speed calculation unit 727, and the turning operation target calculation unit 728 is the same.
- the suspended load turning direction displacement X1 and the suspended load turning direction speed X2 can be acquired based on the image information of the camera 80 attached to the tip end portion of the boom 16. Therefore, as compared with the first embodiment, the position of the recognition marker 57S associated with the suspended load is directly detected even when the main winding rope 50 (suspended load rope) is bent. Therefore, it is possible to accurately acquire the suspended load turning direction displacement X1 and the suspended load turning direction speed X2.
- x is called a state quantity, and corresponds to each of the above-mentioned control quantities (suspended load turning direction displacement X1, suspended load turning direction speed X2, turning angle X5, etc.).
- u corresponds to the control input (turning speed).
- a and B of Equation 5 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.
- a dot is added above the characters in the following formulas, such as x included in formula 7, which means time derivative. For example, if one dot is attached above x, x is first-order time-differentiated, and if two dots are attached above x, x is second-order time-differentiated. Furthermore, in texts other than mathematical formulas, apostrophes are added instead of the above dots due to the restrictions of the description. The same applies to other mathematical formulas and descriptions in the text thereafter.
- an optimum control method in which the target (crane 10) is controlled so as to minimize the evaluation function.
- the evaluation function is first defined as shown in Equation 8 below.
- Equation 8 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 algebra equation shown in Equation 9 below. Note that ⁇ 'm and Gx are equivalent to the above-mentioned turning target speed Vref. Further, Gx corresponds to the right side of Equation 4.
- the feedback gain G can be expressed by the following equation 10.
- control gain setting unit 726 can calculate the gains G1 to G5 based on the above calculation.
- FIGS. 10 and 11 are model diagrams for explaining the swing steady rest control 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 second embodiment, but in the crane 10 according to the first embodiment, FIGS. 10 and 11
- the equation of state can be derived in the same manner.
- the control model of the crane 10 is derived using the equation of motion. As shown in FIGS. 10 and 11, it is assumed that the crane 10 turns around the Z axis. Further, the position of the suspended load is represented using the suspended load position coordinates xt, yt, and zt.
- the suspended load position coordinates xt, yt, and zt are the suspended load positions when the vibration of the jib 18 and the swing of the suspended load are stopped with reference to the initial turning angle at the moment (initial state) when the control start signal is output.
- the yy axis is set to extend in the radial direction so as to share the XYZ coordinates and the XY plane of the global coordinate system with the origin directly below, the xt axis is set to extend in the turning direction, and the zt axis is the Z axis. Is set in the same direction as.
- the turning angle which is the angle at which the turning body 12 turns from the initial state, is defined as ⁇ .
- the angle at which the swivel body 12 turns from the position where the swivel body 12 starts turning until the control start signal is output is defined as ⁇ t.
- the kinetic energy T and the potential energy U of the suspended load are represented by the following equation 11.
- g is the gravitational acceleration.
- the suspended load can be regarded as being restricted on a spherical surface of radius L M (rope length) as viewed from being restrained their behavior by the main hoisting rope 50, the tip of the jib 18. Therefore, the following equation 12 holds. Note that h means the height of the tip of the jib 18.
- ⁇ is defined as in Equation 13.
- Equation 14 ⁇ is an undetermined multiplier. Using this equation 14, assuming the following equation 15, the following equation 16 can be obtained for xt.
- FIG. 12 is a model diagram for further explaining the swivel steady rest control of the crane 10 according to the present embodiment.
- the inertia of the jib 18 acts as a mass (difficult to move, difficulty to rotate) in linear motion with respect to the rotational motion, and the force contributing to the deformation of the jib 18 is the forced displacement by the hydraulic motor and the jib 18. Since it is the tension of the main winding rope 50, the twist deformation of the jib 18 is dominant. Therefore, when considering the elasticity of the jib 18, the equation of motion can be obtained by the analogy of the spring-mass system as shown in FIG.
- the motion is driven by the following equation 17 derived from the equation of motion of Lagrange in equation 14.
- the equation 17 includes a term considering the elastic deformation of the undulating body. Based on the above, in order to show the equation of state, the state x is defined as the following equation 18.
- control gain setting unit 726 can calculate the control gains G1 to G5 (feedback gain) based on the equations of state represented by the equations 19 and 20.
- FIG. 13 is a graph showing the transition of the displacement of the suspended load in the turning direction in other turning steady rest control compared with the turning steady rest control of the crane 10 according to the present embodiment.
- the broken line in FIG. 13 shows the displacement of the suspended load in the turning direction when the turning steady rest control is not performed immediately after the turning operation of the crane 10 is stopped, and it can be seen that the periodic swing continues. ..
- the solid line in FIG. 13 is the result when the control gains G1 to G5 are calculated by the control model which does not consider the elastic deformation of the undulating body (boom 16) unlike each embodiment of the present invention. As shown in FIG. 13, in such an operation, the feedback control is diverged, and the result is that the suspended load swings more than the result of the broken line where the control is not performed.
- FIG. 14 is a graph showing the transition of the displacement in the turning direction of the suspended load in the turning steady rest control of the crane 10 according to each embodiment of the present invention.
- the broken line is the same as in FIG.
- the control gains G1 to G5 are calculated by the control model considering the elastic deformation of the undulating body (boom 16) as in each embodiment of the present invention, the runout of the suspended load converges at an early stage. It is confirmed that
- the control gain setting unit 726 swivels the swivel body 12 and suspends the load.
- each control amount (state amount) (suspended load swivel direction displacement X1, suspended load swivel direction velocity X2, boom tip swivel direction displacement X3, boom tip
- the control gains G1 to G5 are determined so as to minimize the time integration of the weighted sum of the turning direction speed X4 and the turning angle X5) and the input amount (turning speed).
- the turning target speed calculation unit 727 calculates the turning target speed based on the control amount and the control gain, and the turning operation target calculation unit 728 drives the turning drive unit 701 so as to reach the above target speed. Therefore, it is possible to perform stable steady rest of the suspended load.
- the suspension is preset so that the control gain setting unit 726 includes at least a term corresponding to elastic deformation of the undulating body (boom 16, jib 18).
- Five control gains G1 to G5 corresponding to the five state quantities are set based on the equation of state relating to the behavior of the load and the turning speed of the swivel body 12 (undulating body) as a variable.
- the turning target speed calculation unit 727 includes 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 quantity calculation unit 700F (state quantity calculation unit). Therefore, the turning target speed, which is the target value of the turning speed of the turning body 12, is calculated.
- the turning operation target calculation unit 728 and the drive control unit 700 both are command information output units
- the turning target speed the magnitude of the speed, which is calculated by the turning target speed calculation unit 727) for which the turning speed of the turning body 12 is calculated.
- the command information corresponding to the turning target speed is output to the turning drive unit 701 so as to be (including the direction).
- 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 turning 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. Set. Since the above state quantity includes 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 swirling runout of the suspended load while taking into account the relative position with the tip portion.
- 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 control target amount setting unit 720 determines that the turning steady rest control start condition is satisfied by the control determination unit 719, and outputs the control start signal. Then, assuming that the undulating body is not elastically deformed in the plan view of the crane 10, the turning angle, the displacement of the undulating body tip, and the suspension are set with the position vertically below the tip of the undulating body as the target position. The target state amount of the load displacement is set, and the 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 swirling 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. Therefore, like other swivel steady rest devices that control the swivel operation of the upper body so as to always move the tip of the undulating body to a position above the suspended load without considering the elastic deformation of the undulating body, the undulating body.
- the tip portion follows the movement of the suspended load and the turning direction is not frequently 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 swirling 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 pole arrangement method or a method based on the H-infinity control may be adopted.
- the method of setting the control gain according to each embodiment of the present invention 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 inertia imparted to the jib 18 by the turning motion Even when the jib 18 is elastically deformed such as bending due to the moment or the load of the suspended load, it is possible to stably converge the runout of the suspended load in the turning direction.
- the moment of inertia of the body and the weight of the suspended load (suspended load) are detection parameters for determining the feedback gain.
- the suspended load turning direction displacement X1, the suspended load turning direction speed X2, the boom tip turning direction displacement X3, the boom tip turning direction speed X4, and the turning angle X5 correspond to the control amount (state amount).
- 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.
- the present invention is not limited to these forms.
- the present invention can take, for example, the following modified embodiments.
- FIG. 15 is a model diagram for explaining the swing steady rest control of the crane according to the modified embodiment of the present invention.
- the state quantities the suspended load turning direction displacement X1, the suspended load turning direction speed X2, the boom tip turning direction displacement X3, the boom tip turning direction speed X4, and the turning angle X5 have been described.
- the state quantity of is calculated from the detection result of another detection unit.
- the suspended load turning direction displacement X1 the suspended load turning direction speed X2, the suspended load turning direction relative displacement X3, and the suspended load turning direction relative speed X4. May be measured respectively.
- the structure of the crane to which the swivel steady rest device 70 according to each of the above-described embodiments is applied is not limited to the crane 10 shown in FIGS. 1 and 5. It may be a crane having another structure. Further, the number of the control amount (state amount) and the corresponding control gain is not limited to 5, and at least 5 control amounts and control gains may be detected or calculated.
- the suspended load turning direction displacement X1 and the suspended load turning direction speed X2 are acquired based on the image information of the camera 80 mounted on the tip of the boom 16.
- the suspended load position in the global coordinate system may be detected by the hook 57 or GPS attached to the suspended load, and the suspended load turning direction displacement X1 and the suspended load turning direction speed X2 may be acquired, respectively.
- the swivel steady rest device 70 may have a gyro sensor (IMU: Inertial Measurement Unit) connected to the tip of the main winding rope 50 (suspended rope) hanging from the tip of the boom 16.
- IMU Inertial Measurement Unit
- the suspended load displacement detecting unit 715A and the suspended load speed detecting unit 716A detect and output the suspended load displacement and the suspended load speed, respectively, based on the output of the gyro sensor. Further, the suspended load displacement detecting unit 715A and the suspended load speed detecting unit 716A according to the third embodiment may be applied to the second embodiment.
- a swing steady rest device for a crane
- the swing steady rest device is a lower main body and an upper main body rotatably supported around a turning central axis extending in the vertical direction by the lower main body. And, it is supported so as to be rotatable in the undulating direction around the center axis of rotation horizontal to the upper body, and includes the undulating body base end portion and the undulating body tip portion opposite to the undulating body base end portion.
- a turning drive unit capable of turning and driving, and a turning operation unit that receives an operation for turning and driving the upper main body, and the upper main body is moved in the first turning direction and the second turning direction.
- the turning operation unit and the undulating body which can be switched between the turning position for turning and the neutral position for stopping the turning of the upper body, and the undulating body are rotated in the undulating direction around the rotation center axis.
- An undulating body driving unit capable of undulating, and an undulating operation unit that accepts an operation for undulating the undulating body, and stops the undulating position for undulating the undulating body and the undulation of the undulating body.
- An undulating operation unit that can be switched between the neutral position and the suspended load that can be raised and lowered relative to the ground by winding and feeding the suspended load rope.
- Between the drive unit and the elevating operation unit that accepts the operation for raising and lowering the suspended load between the elevating position for raising and lowering the suspended load and the neutral position for stopping the ascending and descending of the suspended load.
- the suspended load connected to the suspended load rope after the turning operation of the upper main body is stopped, which is mounted on a crane having an elevating and lowering operation unit which can be switched by, of the upper main body with the tip of the undulating body as a fulcrum.
- This is a crane swing steady rest device that can suppress the swing swing of a suspended load, which is a phenomenon of swinging along the swing direction.
- the swivel steady rest device acquires and outputs undulating body length information which is information corresponding to the length of the undulating body in the longitudinal direction of the undulating body, which is the direction connecting the base end portion of the undulating body and the tip end portion of the undulating body.
- the angle detection unit the undulating body displacement detection unit that 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 which is the speed of the undulating body tip portion in the turning direction.
- the undulating body speed detecting unit that detects and outputs the tip speed
- the suspended load displacement detecting unit that detects and outputs the suspended load displacement that is the displacement of the suspended load with respect to the undulating body tip, and the above-mentioned with respect to the undulating tip.
- a rope length information acquisition unit that acquires and outputs rope length information, which is information
- a suspension load amount information acquisition unit that acquires and outputs suspension load amount information, which is information on the weight of the suspended load, and the turning operation.
- the control start condition determination unit that determines whether or not the turning steady rest control start condition, which is established by setting all the operation units of the above to the neutral position, and the control start condition determination unit determine the turning.
- the suspension load displacement which is the displacement of the suspended load in the turning direction
- the hanging load speed which is the speed of the suspended load in the turning direction
- Target state amount setting for setting a target state amount for stopping the suspended load at least in the turning direction at a predetermined target position for a plurality of state amounts including the displacement, the tip speed of the undulating body, and the turning angle.
- the suspension speed detection The suspension speed output from the unit, the rope length information output from the rope length information acquisition unit, the suspension load information output from the suspension load information acquisition unit, and the target state.
- a state quantity calculation unit that calculates the current values of the plurality of state quantities based on the target state quantities of the plurality of state quantities set by the quantity setting unit, and at least a term corresponding to the elastic deformation of the undulating body.
- a plurality of control gains corresponding to each of the plurality of state quantities are set based on the state equation relating to the behavior of the suspended load, which is preset to include the state equation and the turning speed of the upper body is used as a variable.
- the turning target speed calculation unit that calculates the turning target speed, and the turning target speed with respect to the turning drive unit so that the turning speed of the upper body becomes the turning target speed calculated by the turning target speed calculation unit. It is provided with a command information output unit that outputs command information corresponding to.
- the control gain setting unit sets the control gain of each state quantity based on the equation of state considering the elastic deformation of the undulating body.
- the turning target speed calculation unit sets the turning target speed of the turning body based on each state quantity calculated by the state quantity calculation unit and each control gain set by the control gain setting unit. Since the above state quantity includes 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 swirling runout of the suspended load while taking into account the relative position with the tip portion.
- 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 suspended load displacement detecting unit detects and outputs the deflection angle of the suspended load rope with respect to the vertical direction when viewed along the radial direction in the turning operation of the upper body as the suspended load displacement.
- the suspension angular velocity detection unit includes a detection unit, and the suspension angular velocity detection unit includes a rope deflection angular velocity detection unit that detects and outputs a deflection angular velocity, which is a change amount of the deflection angle of the suspension rope per unit time, as the suspension velocity. But it may be.
- the suspension is attached to the tip of the undulating body, the target object associated with the suspended load is photographed, and the photographed image information is output, and the suspension is based on the image information output from the imaging device.
- the imaging device and the calculation unit further include a calculation unit for calculating the load displacement and the suspension load speed, respectively, and the photographing device and the calculation unit detect and output the suspension load displacement as the suspension load displacement detection unit, and detect the suspension load speed. As a unit, the suspension speed may be detected and output.
- a gyro sensor connected to the tip of the suspension rope hanging from the tip of the undulating body is further provided, and the suspension displacement detection unit and the suspension speed detection unit are based on the output of the gyro sensor.
- the suspended load displacement and the suspended load speed may be detected and output, respectively.
- the target state amount setting unit elastically deforms the undulating body in the plan view of the crane.
- the turning angle, the displacement of the tip of the undulating body, and the target state amount of the suspended load are set with the position vertically below the tip of the undulating body as the target position when it is assumed that the undulating body does not exist. It is desirable to set the target state quantities of the suspended load speed and the undulating body tip speed to zero, respectively.
- a target position for converging the swirling 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. Therefore, like other swivel steady rest devices that control the swivel operation of the upper body so as to always move the tip of the undulating body to a position above the suspended load without considering the elastic deformation of the undulating body, the undulating body.
- the tip portion follows the movement of the suspended load and the turning direction is not frequently 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 sets the plurality of control gains so that the integrated value with respect to the time of the weighted sum including the plurality of state quantities and the turning speed is the smallest.
- control gain for quickly converging the swirling runout of the suspended load can be set in a short time.
- the crane has a boom base end portion supported as the undulating body so as to be rotatable in the undulating direction around the first rotation center axis horizontal to the upper body, and the boom base end portion.
- the boom and the jib base end supported by the boom tip so as to be rotatable in the undulating direction around the second rotation center axis parallel to the first rotation center axis, including the boom tip opposite to the above.
- the jib comprises a portion and a jib tip that is opposite to the jib base and allows the suspended rope to hang from the jib tip.
- the boom driving unit capable of rotating the boom around the first rotation center axis in the undulating direction and the jib rotating in the undulating direction around the second rotation center axis. It has a jib drive unit capable of undulating, and as the undulating operation unit, it is a boom undulating operation unit that accepts an operation for undulating the boom, and has a boom undulating position for undulating the boom.
- a boom undulation operation unit that can be switched between a neutral position for stopping the undulation of the boom and a jib undulation operation unit that accepts an operation for undulating the jib, and undulates the jib.
- the undulating body length information acquisition unit acquires and outputs boom length information which is information corresponding to the length of the boom in the boom longitudinal direction which is the direction connecting the boom base end and the boom tip.
- a jib that acquires and outputs jib length information that is information corresponding to the length of the jib in the jib longitudinal direction, which is the direction connecting the boom length information acquisition unit and the jib base end portion and the jib tip portion.
- the undulating body displacement detecting unit has a length information acquisition unit, and the undulating body displacement detecting unit detects and outputs the displacement of the jib tip portion in the turning direction as the undulating body tip portion displacement.
- the speed of the tip of the jib in the turning direction is detected and output as the speed of the tip of the undulation body, and the undulation angle detection unit detects and outputs the undulation angle of the boom around the first rotation center axis. It has an angle detection unit and a jib undulation angle detection unit that detects and outputs the undulation angle of the jib around the second rotation center axis, and the target state amount setting unit is said by the control start condition determination unit.
- the suspended load displacement, the suspended load speed, the displacement of the jib tip in the turning direction, the displacement of the undulating body tip, and the jib tip are set for each of the undulating body tip speed and the plurality of state amounts of the turning angle, which are the speeds in the turning direction, and the state amount calculation unit is the boom length information acquisition unit and the boom length information acquisition unit.
- the jib in a configuration in which a suspended load rope is hung from the tip of a jib that is undulatingly supported at the tip of the boom, the jib is subjected to the moment of inertia applied to the jib by the turning motion and the load of the suspended load. Even when elastic deformation such as bending occurs, it is possible to stably converge the runout of the suspended load in the turning direction.
- a crane which is provided on a lower main body, an upper main body rotatably supported around a turning central axis extending in the vertical direction on the lower main body, and the upper main body.
- An undulating body including a undulating body base end portion supported so as to be rotatable in the undulating direction around a horizontal center axis of rotation, and a undulating body tip portion opposite to the undulating body base end portion, and the undulating body.
- the crane that hangs down from the tip and is connected to the suspended load and the upper body are swiveled around the center axis of the swivel in the first swivel direction and in the second swivel direction opposite to the first swivel direction.
- It is a turning drive unit capable of turning and a turning operation unit that accepts an operation for turning and driving the upper main body, and is a turning for turning the upper main body in the first turning direction and the second turning direction, respectively.
- An undulating operation unit that can be switched between a working position and a neutral position for stopping the turning of the upper body, and an undulation that can rotate the undulating body around the center axis of rotation in the undulating direction.
- a body driving unit and an undulating operation unit that accepts an operation for undulating the undulating body, and a undulating position for undulating the undulating body and a neutral position for stopping the undulation of the undulating body.
- An undulating operation unit that can be switched between, a crane drive unit that can raise and lower the crane relative to the ground by winding and feeding the crane rope, and the crane.
- An elevating operation unit that accepts operations for raising and lowering a load, and can be switched between an elevating position for raising and lowering the suspended load and a neutral position for stopping the ascending and descending of the suspended load.
- a crane turning steady rest device and a crane capable of stably converging the turning runout of a suspended load caused by the turning operation of the crane.
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Control And Safety Of Cranes (AREA)
- Jib Cranes (AREA)
Abstract
L'invention concerne un dispositif d'arrêt de giration destiné à une grue, et une grue, le dispositif étant apte à faire converger de manière stable la giration d'une charge suspendue provoquée par le mouvement de rotation de la grue. Ce dispositif d'arrêt de giration (70) comprend une unité de calcul de quantité d'état (700F), une unité de paramétrage de gain de réglage (726) et une unité de calcul de vitesse cible de rotation (727). Lorsque la manœuvre de rotation est arrêtée, l'unité de calcul de quantité de réglage (700F) calcule cinq quantités d'état d'un déplacement de charge suspendue, d'une vitesse de charge suspendue, d'un déplacement rotatif de la pointe du corps d'ondulation (16), d'une vitesse de rotation de la pointe du corps d'ondulation (16) et d'un angle de rotation d'un corps supérieur (12). L'unité de paramétrage de gain de réglage (726) définit cinq gains de réglage correspondant aux quantités d'état respectives à partir d'une équation d'état comprenant un terme correspondant à la déformation élastique du corps d'ondulation (16). L'unité de calcul de vitesse cible de rotation (727) calcule la vitesse de rotation pour supprimer la giration de la charge suspendue, sur la base des cinq quantités d'état et des cinq gains de réglage.
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019179384 | 2019-09-30 | ||
JP2019-179384 | 2019-09-30 | ||
JP2020-147475 | 2020-09-02 | ||
JP2020147475A JP2021054655A (ja) | 2019-09-30 | 2020-09-02 | クレーンの旋回振れ止め装置およびこれを備えたクレーン |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2021065835A1 true WO2021065835A1 (fr) | 2021-04-08 |
Family
ID=75269700
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2020/036736 WO2021065835A1 (fr) | 2019-09-30 | 2020-09-28 | Dispositif d'arrêt de giration destiné à une grue et grue ainsi équipée |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP2021054655A (fr) |
WO (1) | WO2021065835A1 (fr) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05254784A (ja) * | 1992-03-16 | 1993-10-05 | Kobe Steel Ltd | クレーンの旋回停止制御方法および装置 |
JPH0769584A (ja) * | 1993-08-31 | 1995-03-14 | Tadano Ltd | 旋回式クレーンの旋回自動制動装置 |
JP2008074579A (ja) * | 2006-09-22 | 2008-04-03 | Tadano Ltd | クレーンの荷振れ止め装置 |
WO2019007541A1 (fr) * | 2017-07-03 | 2019-01-10 | Liebherr-Components Biberach Gmbh | Grue et procédé pour commander ladite grue |
-
2020
- 2020-09-02 JP JP2020147475A patent/JP2021054655A/ja active Pending
- 2020-09-28 WO PCT/JP2020/036736 patent/WO2021065835A1/fr active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05254784A (ja) * | 1992-03-16 | 1993-10-05 | Kobe Steel Ltd | クレーンの旋回停止制御方法および装置 |
JPH0769584A (ja) * | 1993-08-31 | 1995-03-14 | Tadano Ltd | 旋回式クレーンの旋回自動制動装置 |
JP2008074579A (ja) * | 2006-09-22 | 2008-04-03 | Tadano Ltd | クレーンの荷振れ止め装置 |
WO2019007541A1 (fr) * | 2017-07-03 | 2019-01-10 | Liebherr-Components Biberach Gmbh | Grue et procédé pour commander ladite grue |
Also Published As
Publication number | Publication date |
---|---|
JP2021054655A (ja) | 2021-04-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11919749B2 (en) | Crane, and method for controlling such a crane | |
JP7069888B2 (ja) | クレーンおよびクレーンの制御方法 | |
JP6834887B2 (ja) | クレーン | |
CN114341046A (zh) | 起重机和用于控制该起重机的方法 | |
WO2021060463A1 (fr) | Système de commande et machine de travail | |
WO2021065835A1 (fr) | Dispositif d'arrêt de giration destiné à une grue et grue ainsi équipée | |
JP7299123B2 (ja) | 吊り荷の水平移動補助装置およびこれを備えたクレーン、吊り荷の水平移動方法 | |
JP2017137164A (ja) | クレーンのジブ取付方法 | |
WO2020166721A1 (fr) | Dispositif de commande de levage dynamique et grue | |
JP6729842B2 (ja) | クレーン | |
JP7172256B2 (ja) | クレーン | |
JP7151223B2 (ja) | クレーンおよびクレーンの制御方法 | |
JP7414672B2 (ja) | クレーンの旋回振れ止め装置およびこれを備えたクレーン | |
JP2021050083A (ja) | 吊り荷ロープの振れ角度検出装置およびこれを備えたクレーン | |
JP7031315B2 (ja) | 高さ調節補助装置、これを備えたクレーン及び高さ調節方法 | |
JP7396495B2 (ja) | 地切り制御装置、及び、移動式クレーン | |
JP2022190556A (ja) | クレーン | |
WO2020166688A1 (fr) | Dispositif de détermination de levage dynamique, dispositif de commande de levage dynamique, grue mobile et procédé de détermination de levage dynamique | |
WO2023085388A1 (fr) | Dispositif anti-balancement de grue et grue équipée de celui-ci | |
JP2021038086A (ja) | 移動式クレーンおよび遠隔端末装置 | |
WO2019167893A1 (fr) | Grue et procédé d'acquisition d'une longueur d'un outil d'élingage | |
WO2023176675A1 (fr) | Dispositif de calcul de position de crochet | |
JP2024131790A (ja) | クレーンの制御装置およびこれを備えたクレーン | |
JP2011219213A (ja) | クレーン | |
WO2020166690A1 (fr) | Dispositif de commande de levage et grue mobile |
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: 20871419 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: 20871419 Country of ref document: EP Kind code of ref document: A1 |