Crane sway prevention device and crane equipped with the same

The swing steady rest device for cranes addresses the issue of elastic deformation in undulating bodies by using a control system that stabilizes suspended load swinging through sensor feedback and control gains, ensuring precise and rapid convergence to a stationary position.

JP7593759B2Active Publication Date: 2024-12-03KOBE STEEL LTD +1
View PDF 5 Cites 0 Cited by

Patent Information

Application Number
JP2020147475
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Priority Date
2019-09-30
Filing Date
2020-09-02
Publication Date
2024-12-03
Estimated Expiration
2040-09-02

AI Technical Summary

Technical Problem

Existing crane systems fail to account for elastic deformation of the undulating body, leading to misalignment and increased swinging of suspended loads, making it difficult to control the swinging motion effectively.

Method used

A swing steady rest device for cranes that includes a control system to stabilize the swinging of suspended loads by considering the elastic deformation of the undulating body, using sensors and a control model to adjust the swinging operation based on detected parameters such as length, angle, and displacement, and applying control gains to minimize the swing speed.

Benefits of technology

The system effectively stabilizes the swinging of suspended loads by accounting for elastic deformation, ensuring precise control and rapid convergence to a stationary position, even when the undulating body deflects due to inertia or load weight.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007593759000021
    Figure 0007593759000021
  • Figure 0007593759000022
    Figure 0007593759000022
  • Figure 0007593759000023
    Figure 0007593759000023
Patent Text Reader

Abstract

To provide a slewing swing prevention control device for a crane and a crane capable of stably converging the slewing swing of a suspended load caused by the slewing motion of the crane.SOLUTION: A slewing swing prevention control device 70 comprises a control amount calculation unit 700F, a control gain setting unit 726, and a slewing target speed calculation unit 727. When the slewing operation is stopped, the control amount calculation unit 700F calculates five state quantities: suspended load displacement, suspended load speed, slewing displacement of the tip of the boom 16, slewing speed of the tip of the boom 16, and slewing angle of the slewing body 12. The control gain setting unit 726 sets five control gains corresponding to each state quantity from the equation of state including the item corresponding to the elastic deformation of the boom 16. The slewing target speed calculation unit 727 calculates the slewing speed for suppressing the swing of the suspended load from the five state quantities and the five control gains.SELECTED DRAWING: Figure 2
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a crane sway prevention device and a crane equipped with the same. [Background technology]

[0002] Conventionally, a mobile crane is known that includes a lower traveling body, an upper rotating body supported on the lower traveling body so as to be rotatable about a vertically extending central axis of rotation, and a hoisting body such as a boom or a jib. The hoisting body is attached to the front of the upper rotating body so as to be rotatable in the hoisting direction about a horizontal central axis of rotation. A hook is attached to a hoisting rope hanging from the tip of the hoisting body, and a load is connected to the hook to hoist the load. When the upper rotating body rotates with the load hoisted in this manner, the load can be moved in the hoisting direction.

[0003] Patent Document 1 discloses a technology for controlling the rotation of an upper rotating body of a crane having a telescopic boom so that, when the upper rotating body stops rotating and the load sways (swing during rotation), the tip of the boom is moved to a position vertically above the load. By moving the tip of the boom to follow the load, the swing of the load eventually converges. [Prior art documents] [Patent documents]

[0004] [Patent Document 1] Patent No. 5087251 Summary of the Invention [Problem to be solved by the invention]

[0005] When a crane rotates, the hoist may bend (elastically deform) depending on the moment of inertia applied to the hoist and the weight of the load. The technology described in Patent Document 1 does not take such elastic deformation of the hoist into consideration, so misalignment is likely to occur between the load and the tip of the hoist, which moves to follow the load in a plan view. As a result, the misalignment tends to exacerbate the swing of the load, causing a problem that the swing of the load is difficult to stop.

[0006] The present invention has been made in consideration of the above-mentioned problems, and has an object to provide a crane and a rotation anti-sway device that can stably converge the rotational sway of a suspended load caused by the rotation operation of the crane. [Means for solving the problem]

[0007] A crane slewing anti-sway device according to one aspect of the present invention includes a lower body, an upper body supported on the lower body so as to be rotatable around a rotation center axis extending in a vertical direction, a hoisting body supported on the upper body so as to be rotatable in a hoisting direction around a horizontal rotation center axis and including a hoisting body base end and a hoisting body tip end opposite the hoisting body base end, a load rope suspended from the hoisting body tip end and connected to a suspended load, a slewing drive unit capable of slewing the upper body around the rotation center axis in a first slewing direction and a second slewing direction opposite the first slewing direction, respectively, and a slewing operation unit that receives operations for slewing the upper body, the slewing operation unit being switchable between a slewing position for slewing the upper body in the first slewing direction and the second slewing direction, respectively, and a neutral position for stopping the slewing of the upper body, The present invention relates to a crane that is equipped with a load drive unit that can rotate in a lowering direction, a lifting operation unit that accepts operations for raising and lowering the load, the lifting operation unit being switchable between a lifting position for raising and lowering the load and a neutral position for stopping the raising and lowering of the load, a load drive unit that can raise and lower the load relative to the ground by winding and letting out the load rope, and a lifting operation unit that accepts operations for raising and lowering the load, the lifting operation unit being switchable between a lifting position for raising and lowering the load and a neutral position for stopping the raising and lowering of the load, and the device is capable of suppressing load swing, which is a phenomenon in which the load connected to the load rope swings in the rotation direction of the upper body after the rotation of the upper body stops, with the tip of the load as a fulcrum. The slewing anti-sway device includes an undulating body length information acquisition unit that acquires and outputs undulating body length information, which is information corresponding to the length of the undulating body in the undulating body longitudinal direction, which is the direction connecting the base end of the undulating body and the tip end of the undulating body, a rotation angle detection unit that detects and outputs the rotation angle of the upper body about the rotation center axis, an undulating angle detection unit that detects and outputs the undulating body angle of the undulating body about the rotation center axis, and an undulating body displacement detection unit that detects and outputs undulating body tip displacement, which is the displacement of the tip end of the undulating body in the rotation direction.a load speed detection unit that detects and outputs a load speed, which is the amount of change per unit time of the load displacement relative to the load tip, a rope length information acquisition unit that acquires and outputs rope length information, which is information corresponding to the length of the load rope between the load tip and the load; and a load weight information acquisition unit that acquires and outputs load weight information, which is information related to the weight of the load. a quantity information acquisition unit, a control start condition determination unit that determines whether or not a swing anti-sway control start condition is satisfied, which is established when the swing drive unit swings the upper body in a predetermined swing direction in response to the swing operation unit being set to the swing position, and then all operation units of the swing operation unit, the hoisting operation unit, and the lifting operation unit are set to the neutral position, respectively, and when it is determined by the control start condition determination unit that the swing anti-sway control start condition is satisfied, a target state quantity setting unit which sets target state quantities for stopping the load at least in the rotation direction at a predetermined target position for a plurality of state quantities including a load speed, which is a speed at which the load is moved, a displacement of the tip of the hoisting body, a speed at which the load is moved, and a rotation angle; a state quantity calculation unit that calculates current values ​​of the plurality of state quantities based on the load displacement output from the load displacement detection unit, the load speed output from the load speed detection unit, the rope length information output from the rope length information acquisition unit, the lifting load weight information output from the lifting load weight information acquisition unit, and target state quantities of the plurality of state quantities set by the target state quantity setting unit; and a state equation related to the behavior of the load that is preset to include at least a term corresponding to the elastic deformation of the undulating body, the state equation having the rotation speed of the upper body as a variable,a control gain setting unit that sets a plurality of control gains respectively corresponding to the plurality of state quantities, a turning target speed calculation unit that calculates a turning target speed, which is a target value of the turning speed, from the plurality of control gains set by the control gain setting unit and current values ​​of the plurality of state quantities calculated by the state quantity calculation unit, and a command information output unit that outputs command information corresponding to the turning target speed to the turning drive unit so that the turning speed of the upper body becomes the turning target speed calculated by the turning target speed calculation unit.

[0008] According to this configuration, the control gain setting unit sets the control gains of each state quantity based on a state equation that takes into account the elastic deformation of the hoisting body. The rotation target speed calculation unit sets the rotation target speed of the hoisting body based on each state quantity calculated by the state quantity calculation unit and each control gain set by the control gain setting unit. The above state quantities include the displacement and speed of the load as well as the displacement and speed of the tip of the hoisting body. Therefore, by combining this with rope length information of the load rope, the swing of the load can be controlled while taking into account the relative position between the load and the tip of the hoisting body. Therefore, even if the hoisting body is elastically deformed, such as deflected, by the moment of inertia applied to the hoisting body due to the hoisting operation or the load of the load, the swing of the load in the rotation direction can be stably converged.

[0009] In the above, the load displacement detection unit may include a rope sway angle detection unit that detects and outputs the sway angle of the load rope with respect to the vertical direction when viewed along the radial direction during the rotational movement of the upper body as the load displacement, and the load speed detection unit may include a rope sway angular velocity detection unit that detects and outputs the sway angular velocity, which is the amount of change per unit time in the sway angle of the load rope, as the load speed.

[0010] The system may further include an imaging device attached to the tip of the undulating body, imaging a target associated with the load and outputting the image information captured, and a calculation unit that calculates the load displacement and the load speed based on the image information output from the imaging device, and the imaging device and the calculation unit may function as the load displacement detection unit to detect and output the load displacement, and as the load speed detection unit to detect and output the load speed.

[0011] The device may further include a gyro sensor connected to the tip of the suspension rope hanging down from the tip of the hoisting body, and the load displacement detection unit and the load speed detection unit may detect and output the load displacement and the load speed, respectively, based on the output of the gyro sensor.

[0012] In the above configuration, when the control start condition judgment unit judges that the rotation anti-sway control start condition is satisfied, the target state quantity setting unit sets the target state quantities of the rotation angle, the tip displacement of the hoisting body and the displacement of the load as the target position, which is the position vertically below the tip of the hoisting body when viewed in a plan view of the crane, assuming that the hoisting body is not elastically deformed, and further, it is desirable to set the target state quantities of the load speed and the tip speed of the hoisting body to zero, respectively.

[0013] According to this configuration, the target position for converging the swing of the load is set based on the position of the tip of the hoisting body at the time the control start signal is output. Therefore, unlike other anti-sway devices that control the swing of the upper body to always move the tip of the hoisting body to a position above the load without considering the elastic deformation of the hoisting body, the tip of the hoisting body does not follow the movement of the load and the swing direction is not frequently changed, and the swing of the load can be converged early by controlling the swing operation according to the final target position.

[0014] In the above configuration, it is preferable that the control gain setting unit sets the plurality of control gains so that an integral value with respect to time of a weighted sum including the plurality of state quantities and the turning speed is minimized.

[0015] According to this configuration, the control gain for quickly converging the rotational swing of the suspended load can be set in a short period of time.

[0016] In the above configuration, the crane has, as the hoisting body, a boom including a boom base end supported on the upper body so as to be rotatable in the hoisting direction around a first rotation central axis horizontal to the upper body, and a boom tip end opposite the boom base end, and a jib including a jib base end supported on the boom tip end so as to be rotatable in the hoisting direction around a second rotation central axis parallel to the first rotation central axis, and a jib tip end opposite the jib base end and allowing the hoisting rope to be hung from the jib tip end, and the hoisting body drive unit is configured to rotate the boom in the hoisting direction around the first rotation central axis. The jib hoisting operation unit has a boom drive unit capable of rotating the jib in the hoisting direction around the second rotation center axis, and as the hoisting operation unit, a boom hoisting operation unit that accepts operations to hoist the boom, which is switchable between a boom hoisting position for raising and lowering the boom and a neutral position for stopping the raising and lowering of the boom, and a jib hoisting operation unit that accepts operations to raise and lower the jib, which is switchable between a jib hoisting position for raising and lowering the jib and a neutral position for stopping the raising and lowering of the jib.The hoisting body length information acquisition unit includes a boom length information acquisition unit that acquires and outputs boom length information, which is information corresponding to the length of the boom in a boom longitudinal direction that is a direction connecting the boom base end and the boom tip end, and a jib length information acquisition unit that acquires and outputs jib length information, which is information corresponding to the length of the jib in a jib longitudinal direction that is a direction connecting the jib base end and the jib tip end, and the hoisting body displacement detection unit detects and outputs the displacement of the jib tip in the rotation direction as the hoisting body tip displacement. the hoisting body speed detection unit detects and outputs a speed of the jib tip in the rotation direction as the hoisting body tip speed, the hoisting angle detection unit has a boom hoisting angle detection unit which detects and outputs a hoisting angle of the boom about the first rotation central axis, and a jib hoisting angle detection unit which detects and outputs a hoisting angle of the jib about the second rotation central axis, and the target state quantity setting unit, when it is determined by the control start condition determination unit that the swing anti-sway control start condition is satisfied, sets the hoisting body speed detection unit to detect and output a hoisting angle of the load displacement, the hoisting speed, the forward movement of the jib tip, and The target state quantities are set for a plurality of state quantities, namely, the displacement of the tip of the hoisting structure, which is the displacement in the slewing direction, the speed of the tip of the jib, which is the speed of the tip of the jib in the slewing direction, and the slewing angle, and the state quantity calculation unit calculates the boom length information and the jib length information output from the boom length information acquisition unit and the jib length information acquisition unit, respectively, the slewing angle output from the slewing angle detection unit, the boom hoisting angle output from the boom hoisting angle detection unit, and the jib hoisting angle output from the jib hoisting angle detection unit. The current values ​​of the multiple state quantities may be calculated based on the elevation angle, the elevation body tip displacement output from the elevation body displacement detection unit, the elevation body tip speed output from the elevation body speed detection unit, the load displacement output from the load displacement detection unit, the load speed output from the load speed detection unit, the rope length information output from the rope length information acquisition unit, the hanging load weight information output from the hanging load weight information acquisition unit, and target state quantities of the multiple state quantities set by the target state quantity setting unit.

[0017] According to this configuration, in a configuration in which a load rope is hung from the tip of a jib that is supported at the tip of a boom so that it can be raised and lowered, even if the jib undergoes elastic deformation such as bending due to the moment of inertia applied to the jib by the rotation operation or the load of the suspended load, it is possible to stably converge the swing of the load in the rotation direction.

[0018] A crane according to another aspect of the present invention includes a lower body, an upper body supported on the lower body so as to be rotatable around a central axis of rotation extending in a vertical direction, a hoisting body including a base end of the hoisting body supported on the upper body so as to be rotatable in a hoisting direction around a horizontal central axis of rotation, and a tip end of the hoisting body opposite the base end of the hoisting body, a load rope suspended from the tip end of the hoisting body and connected to a suspended load, a slewing drive unit capable of slewing the upper body around the central axis of rotation in a first slewing direction and in a second slewing direction opposite to the first slewing direction, and a slewing operation unit that receives an operation for slewing the upper body, the slewing position being set to a slewing position for slewing the upper body in the first slewing direction and in the second slewing direction, a hoisting operation unit that receives operations for raising and lowering the hoisting body, the hoisting operation unit being switchable between a hoisting position for raising and lowering the hoisting body and a neutral position for stopping the raising and lowering of the hoisting body; a load drive unit that is capable of raising and lowering the load relative to the ground by winding and unwinding the load rope; a lifting operation unit that receives operations for raising and lowering the load, the lifting operation unit being switchable between a lifting position for raising and lowering the load and a neutral position for stopping the raising and lowering of the load; and a sway prevention device for a crane described in any one of the above.

[0019] With this configuration, even if the moment of inertia applied to the hoisting body by the crane's rotation operation or the load of the suspended load causes elastic deformation such as bending of the hoisting body, it is possible to stably converge the swing of the load in the rotation direction. Effect of the Invention

[0020] According to the present invention, there is provided a crane sway prevention device and a crane that can stably converge the sway of a suspended load caused by the slewing operation of the crane. [Brief description of the drawings]

[0021] [Figure 1] FIG. 1 is a side view of a crane according to a first embodiment of the present invention. [Diagram 2] 1 is a block diagram of a sway prevention device for a crane according to a first embodiment of the present invention. FIG. [Diagram 3] FIG. 2 is a schematic plan view for explaining swing prevention control of the crane according to the first embodiment of the present invention. [Figure 4] 4 is a flowchart of swing prevention control for a crane according to the first embodiment of the present invention. [Diagram 5] FIG. 6 is a side view of a crane according to a second embodiment of the present invention. [Figure 6] FIG. 6 is a block diagram of a crane sway prevention device according to a second embodiment of the present invention. [Figure 7] FIG. 11 is a block diagram of a sway prevention device for a crane according to a third embodiment of the present invention. [Figure 8] FIG. 11 is an enlarged side view of the tip of a boom of a crane according to a third embodiment of the present invention. [Figure 9] FIG. 11 is a block diagram of a suspended load displacement detection unit and a suspended load speed detection unit of a crane according to a third embodiment of the present invention. [Figure 10] FIG. 2 is a model diagram for explaining swing prevention control of a crane according to each embodiment of the present invention. [Figure 11] FIG. 2 is a model diagram for explaining swing prevention control of a crane according to each embodiment of the present invention. [Figure 12] FIG. 2 is a model diagram for explaining swing prevention control of a crane according to each embodiment of the present invention. [Figure 13]11 is a graph showing the progress of the displacement in the rotation direction of a suspended load in another anti-sway control for comparison with the anti-sway control for a crane according to one embodiment of the present invention. [Figure 14] 1 is a graph showing the progress of the displacement of a suspended load in the rotation direction in the rotation anti-sway control of a crane according to an embodiment of the present invention. [Figure 15] FIG. 13 is a model diagram for explaining swing prevention control of a crane according to a modified embodiment of the present invention. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0022] First Embodiment Hereinafter, a first embodiment of the present invention will be described with reference to the drawings. Fig. 1 is a side view of a crane 10 according to this embodiment. Note that Fig. 1 shows the directions of "up", "down", "front" and "rear", but these directions are shown for the sake of convenience in explaining the structure and assembly method of the crane 10 according to this embodiment, and do not limit the direction of movement or the manner of use of the crane according to the present invention.

[0023] The crane 10 comprises a running body 14 (lower body), a rotating body 12 (upper body) supported on the running body 14 so as to be rotatable about a central axis of rotation extending in the vertical direction, a boom 16 (hoisting body), and a mast 20. A counterweight 13 for adjusting the balance of the crane 10 is loaded on the rear of the rotating body 12. A cab 15 is provided on the front end of the rotating body 12. The cab 15 corresponds to the driver's seat of the crane 10.

[0024] The boom 16 shown in FIG. 1 is a so-called lattice type, and is composed of a lower boom 16A (base end of the hoisting body), one or more (three in the illustrated example) intermediate booms 16B, 16C, 16D, and an upper boom 16E (tip end of the hoisting body opposite to the base end of the hoisting body). Specifically, the lower boom 16A is supported on the front of the revolving body 12 so as to be rotatable in the hoisting direction around a horizontal rotation center axis (first rotation center axis). The intermediate booms 16B, 16C, 16D are removably attached to the tip end of the lower boom 16A in that order. The upper boom 16E is removably attached to the tip end of the intermediate boom 16D. The lower boom 16A is rotatably supported on the revolving body 12 at a boom foot pin 16S provided at the lower end thereof.

[0025] The boom 16 also has idler sheaves 34S, 36S. The idler sheaves 34S, 36S are each rotatably supported on the rear side surface of the base end portion of the lower boom 16A.

[0026] However, the present invention is not limited to a specific boom structure. For example, the boom may not have an intermediate member, or may have a different number of intermediate members from the above. Furthermore, the boom may be composed of a single member.

[0027] The mast 20 has a base end and a rotating end, and the base end is rotatably connected to the rotating body 12. The rotation axis of the mast 20 is parallel to the rotation axis of the boom 16 and is located immediately rearward of the rotation axis of the boom 16. In other words, the mast 20 is rotatable in the same direction as the direction in which the boom 16 is raised and lowered.

[0028] Furthermore, the crane 10 is equipped with a pair of left and right boom backstops 23 and a pair of left and right boom guylines 24.

[0029] A pair of left and right boom backstops 23 are provided on both the left and right sides of the lower boom 16A of the boom 16. These boom backstops 23 come into contact with the center in the fore-and-aft direction of the rotating body 12 when the boom 16 reaches the upright position shown in Fig. 1. This contact prevents the boom 16 from being blown backward by strong winds or the like.

[0030] A pair of left and right boom guylines 24 connect the rotating end of the mast 20 to the tip of the boom 16. This connection coordinates the rotation of the mast 20 and the rotation of the boom 16.

[0031] The crane 10 further includes various winches. Specifically, the crane 10 includes a boom hoist winch 30 for raising and lowering the boom 16, a main winch 34 and an auxiliary winch 36 for hoisting and lowering a load. The crane 10 also includes a boom hoist rope 38, a main hoisting rope 50 (suspension rope) that hangs down from the upper boom 16E and is connected to the load, and an auxiliary hoisting rope 60. In the crane 10 according to this embodiment, the main winch 34 and the auxiliary winch 36 are installed near the base end of the boom 16. The boom hoist winch 30 is installed on the rotating body 12. The positions of these winches 30, 32, 34, 36 are not limited to those described above.

[0032] The boom hoist winch 30 winds and pays out the boom hoist rope 38. The boom hoist rope 38 is arranged so that the mast 20 rotates as a result of this winding and paying out. Specifically, sheave blocks 40, 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 the boom hoist rope 38 drawn out from the boom hoist winch 30 is stretched between the sheave blocks 40, 42. Therefore, as the boom hoist winch 30 winds and pays out the boom hoist rope 38, the distance between the two sheave blocks 40, 42 changes, and as a result, the mast 20 and the boom 16 linked thereto rotate in the hoisting direction.

[0033] The main winch 34 hoists and lowers a load using a main hoisting rope 50. The main hoisting rope 50 hangs down from the upper boom 16E of the boom 16 and is connected to the load. A main hoisting guide sheave 54 is disposed on the upper boom 16E, and a main hoisting sheave block is provided adjacent to the main hoisting guide sheave 54, in which a plurality of main hoisting point sheaves 56 are arranged in the width direction. The main hoisting rope 50 pulled out from the main hoisting winch 34 is hung in this order around the idler sheave 34S and the main hoisting guide sheave 54, and is also hung between the main hoisting point sheave 56 of the sheave block and a sheave 58 of a sheave block provided on a main hook 57 for a load. Therefore, when the main hoisting winch 34 winds or unwinds the main hoisting rope 50, the distance between the two sheaves 56, 58 changes, and the main hook 57 connected to the main hoisting rope 50 suspended from the tip of the boom 16 is hoisted up or down. As a result, the load can be hoisted up or down.

[0034] Similarly, the auxiliary winch 36 hoists and lowers the load using the auxiliary hoisting rope 60. For this auxiliary hoisting, an auxiliary hoisting guide sheave 64 is rotatably mounted coaxially with the main hoisting guide sheave 54, and an auxiliary hoisting point sheave (not shown) is rotatably mounted adjacent to the auxiliary hoisting guide sheave 64. The auxiliary hoisting rope 60 pulled out from the auxiliary hoisting winch 36 is hung in turn around the idler sheave 36S and the auxiliary hoisting guide sheave 64, and is suspended from the auxiliary hoisting point sheave. Therefore, when the auxiliary hoisting winch 36 winds or unwinds the auxiliary hoisting rope 60, an auxiliary hook for a suspended load (not shown) connected to the end of the auxiliary hoisting rope 60 is wound up or lowered.

[0035] The crane 10 further includes a drive control unit 700, a drive unit 700A, an operation unit 700B, and a sway prevention device 70. Fig. 2 is a block diagram of the sway prevention device 70 of the crane 10 according to this embodiment.

[0036] The driving section 700A drives each member of the crane 10. The driving section 700A has a slewing driving section 701, a hoisting driving section 702 (hoisting body driving section, boom driving section), and a winch driving section 703 (suspended load driving section).

[0037] The revolving drive unit 701 generates a driving force capable of revolving the revolving body 12 about the revolving central axis in a first revolving direction and a second revolving direction opposite to the first revolving direction. The revolving drive unit 701 includes a hydraulic motor that receives a supply of hydraulic oil to revolve the revolving body 12.

[0038] The hoisting drive unit 702 generates a driving force for rotating the boom hoist winch 30, and is capable of rotating the boom 16 about the central axis of rotation. The hoisting drive unit 702 includes a hydraulic motor that rotates the boom hoist winch 30 by receiving a supply of hydraulic oil.

[0039] The winch drive unit 703 generates a drive force for rotating the main hoisting winch 34, and the main hoisting rope 50 is wound and unwound by the main hoisting winch 34, making it possible to raise and lower the load relative to the ground. The winch drive unit 703 includes a hydraulic motor that rotates the main hoisting winch 34 by receiving a supply of hydraulic oil.

[0040] The operation unit 700B is disposed inside the cab 15, and receives operations by the operator to drive each member of the crane 10. The operation unit 700B has a rotation operation unit 704 (rotation operation unit), a hoisting operation unit 705 (hoisting operation unit, boom hoisting operation unit), and a winch operation unit 706 (lifting operation unit).

[0041] The turning operation unit 704 receives an operation for turning the turning body 12 by the turning drive unit 701. The turning operation unit 704 is switchable between a turning position for turning the turning body 12 in each of the first turning direction and the second turning direction and a neutral position for stopping the turning of the turning body 12.

[0042] The hoisting operation unit 705 receives an operation for hoisting the boom 16 by the hoisting drive unit 702. The hoisting operation unit 705 is switchable between a hoisting position for hoisting the boom 16 and a neutral position for stopping the hoisting of the boom 16.

[0043] 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 a lifting position for raising and lowering the suspended load and a neutral position for stopping the lifting and lowering of the suspended load.

[0044] The drive control unit 700 inputs command signals corresponding to the operation direction and operation amount received by the rotation operation unit 704, the hoisting operation unit 705 and the winch operation unit 706 to the rotation drive unit 701, the hoisting drive unit 702 and the winch drive unit 703, respectively, to drive each drive unit.

[0045] The anti-sway device 70 is capable of suppressing the sway of the load, which is a phenomenon in which the load connected to the main hoisting rope 50 sways in the rotation direction (rotation direction) of the rotating body 12, with the main hoisting point sheave 56 of the upper boom 16E as a fulcrum, after the rotation of the rotating body 12 has stopped.

[0046] The swivel vibration suppression device 70 includes an information acquisition section 700C, a detection section 700D, and a vibration suppression control section 700E.

[0047] The information acquisition unit 700C has a boom length information acquisition unit 708 (hoisting body length information acquisition unit). The boom length information acquisition unit 708 acquires information (length information) related to the length of the boom 16 used in the swing prevention control of the suspended load executed by the vibration suppression control unit 700E. That is, the boom length information acquisition unit 708 acquires and outputs information (hoisting body length information) corresponding to the length of the boom 16 in the boom longitudinal direction (hoisting body longitudinal direction), which is the direction connecting the base end (hoisting body base end) and the tip end (hoisting body tip end) of the boom 16. 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. Note that in another embodiment, the operation unit 700B may have an input unit (not shown), and the operator may input the length information of the boom 16 through the input unit, and the boom length information acquisition unit 708 may acquire the information.

[0048] The detection unit 700D has a rotation angle detection unit 710, a boom hoisting angle detection unit 711 (hoisting angle detection unit), a boom top rotation direction displacement detection unit 713 (hoisting body displacement detection unit), a boom top rotation direction speed detection unit 714 (hoisting body speed detection unit), a rope rotation direction sway angle detection unit 715 (rope sway angle detection unit), a rope rotation direction sway angular velocity detection unit 716 (rope sway angular velocity detection unit), a rope length detection unit 717 (rope length information acquisition unit), and a hanging load detection unit 718 (hanging load information acquisition unit).

[0049] The rotation angle detection unit 710 detects and outputs the rotation angle around the rotation central axis of the boom 16 (rotating structure 12). The rotation angle detection unit 710 includes a gyro sensor and a calculation unit, not shown. The rotation angle detection unit 710 measures the angular velocity around the rotation central axis of the rotating structure 12 with the gyro sensor, and the calculation unit converts the measured angular velocity into an angle by integrating it once with respect to time, and outputs the angle as the rotation angle.

[0050] The boom hoist angle detection unit 711 detects and outputs the hoist angle around the central axis of rotation of the boom 16. The boom hoist angle detection unit 711 is made up of an inclination sensor, and detects the relative angle (ground angle) of the boom 16 with respect to the ground. Note that the boom hoist angle detection unit 711 may also detect a relative angle with respect to another object.

[0051] The boom top rotation direction displacement detection unit 713 detects and outputs the amount of displacement (displacement of the tip of the undulating body) in the rotation direction of the tip of the boom 16 (upper boom 16E). In this embodiment, the boom top rotation 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 in the rotation direction of the upper boom 16E, and the calculation unit converts the measured acceleration into a displacement (amount of displacement) by integrating it twice with respect to time, and outputs the displacement.

[0052] The boom top rotation direction speed detection unit 714 detects and outputs the speed of the upper boom 16E in the rotation direction (the speed of the tip of the elevation body). In this embodiment, the boom top rotation direction speed detection unit 714 includes the acceleration sensor and a calculation unit shared with the boom top rotation direction displacement detection unit 713. The calculation unit converts the acceleration measured by the acceleration sensor attached to the upper boom 16E into a speed by integrating it once with respect to time, and outputs the speed.

[0053] The rope swivel sway angle detection unit 715 detects and outputs the sway angle of the main hoisting rope 50 relative to the vertical direction when viewed along the radial direction during the swivel operation of the swivel body 12. The rope swivel sway angle detection unit 715 includes a jig (not shown) that can be swung only in the swivel direction on the upper boom 16E, and an inclination sensor attached to the jig. The jig is engaged with the main hoisting rope 50, and the inclination sensor detects and outputs the swing angle of the main hoisting rope 50 in the swivel direction relative to the boom 16 (vertical direction) as a sway angle. The rope swivel sway angle detection unit 715 constitutes the suspended load displacement detection unit of the present invention. The rope swivel sway angle detection unit 715 detects and outputs the sway angle as a suspended load displacement, which is the displacement of the suspended load relative to the tip of the boom 16 (upper boom 16E).

[0054] The rope swivel direction sway angular velocity detection unit 716 detects and outputs a sway angular velocity, which is a change amount per unit time of the sway angle of the main winding rope 50. The rope swivel direction sway angular velocity detection unit 716 includes a gyro sensor attached to the above-mentioned jig, and the gyro sensor detects and outputs the sway angular velocity. Note that, in another embodiment, the rope swivel direction sway angular velocity detection unit 716 may include a camera attached to the upper boom 16E, acquire an image of the main hook 57 taken by the camera, detect and output the swing angle in the swivel direction of the main hook 57 (suspended load) as the swing angle, and output the angular velocity by differentiating the swing angle once. Note that the rope swivel direction sway angular velocity detection unit 716 constitutes the suspended load speed detection unit of the present invention. The rope rotation direction sway angular velocity detection unit 716 detects and outputs the sway angular velocity as a load velocity, which is the amount of change per unit time of the load displacement relative to the tip of the boom 16 (upper boom 16E).

[0055] The rope length detection unit 717 acquires and outputs rope length information, which is information corresponding to the length of the load rope between the boom tip and the load. In this 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 includes a rotation amount detection unit capable of detecting the rotation amount of the main winding winch 34, and a winding layer detection unit that detects the number of winding layers of the main winding rope 50 on the outer circumferential surface of the main winding winch 34. The rope length detection unit 717 calculates and outputs the distance from the winch diameter of the main winding winch 34, the winch rotation amount detected by the rotation amount detection unit, the payout amount of the main winding rope 50 paid out from the main winding winch 34 estimated from the winding layers of the main winding rope 50 detected by the winding layer detection unit, and the number of loops of the main winding rope 50 between the main winding point sheave 56 and the sheave blocks of the sheave 58.

[0056] The hoisting load detection unit 718 acquires and outputs information (hoisting load information) relating to the weight of the suspended load connected to the main hook 57. In this embodiment, the hoisting load detection unit 718 includes a load detector (load cell) (not shown) connected to the main hoisting rope 50, and detects the weight of the suspended load based on a change in the strain of the tension of the main hoisting rope 50. Note that in other embodiments, 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.

[0057] The vibration suppression control unit 700E is composed of a CPU (Central Processing Unit), a ROM (Read Only Memory) that stores a control program, a RAM (Random Access Memory) used as a working area for the CPU, and the like. The CPU executes the control program stored in the ROM, so that the vibration suppression control unit 700E functions to include a control determination unit 719 (control start condition determination unit), a control target amount setting unit 720, a control amount calculation unit 700F, a control gain setting unit 726, a swing target speed calculation unit 727, and a swing operation target calculation unit 728. The vibration suppression control unit 700E automatically executes swing prevention control of the suspended load when the swing operation of the crane 10 is stopped, based on the operation received by the operation unit 700B, the information acquired by the information acquisition unit 700C, and the information detected by the detection unit 700D.

[0058] The control determination unit 719 determines to start the anti-sway control (also called vibration suppression control) in response to the fact that the anti-sway control start condition is satisfied when all the operation units of the rotation operation unit 704, the hoisting operation unit 705, and the winch operation unit 706 are set to the neutral position after the rotation drive unit 701 has rotated the rotating body 12 in a predetermined rotation direction in response to the rotation operation unit 704 being set to the rotation position, and outputs a predetermined control start signal when it determines that the anti-sway control start condition is satisfied. It should be noted that the determination as to whether each operation unit is set to the neutral position is made by determining that each operation unit is set to the neutral position when the operation amount received by each operation unit is smaller than a preset threshold value. That is, this state is a state in which the operation of the crane 10 has stopped after the rotation operation of the rotating body 12, and it is desirable that the load connected to the main hook 57 is positioned vertically below the upper boom 16E (main hoisting point sheave 56). In addition, when the operation of the crane 10 is stopped after the rotation operation as described above, and a switch (input unit) for starting the rotation anti-sway control, which is arranged in advance in the cab 15 as described below, is pressed (turned ON) by the operator, the anti-sway control described below may be started.

[0059] The control target quantity setting unit 720 sets each control target quantity (state target quantity) at the time when the control determination unit 719 determines the execution of the swing prevention control and outputs a control start signal. Specifically, the control target quantity setting unit 720 sets target quantities for stopping the load at least in the swing direction at a predetermined target position for at least five (plural) control quantities (state quantities) including the load swing direction displacement X1, the load swing direction speed X2, the boom tip swing direction displacement X3, the boom tip swing direction speed X4, and the swing angle X5. The load swing direction displacement X1 is the displacement of the load (main hook 57) in the swing direction, and the load swing direction speed X2 is the speed of the load in the swing direction. The boom tip swing direction displacement X3 is the displacement of the upper boom 16E (main hoisting point sheave 56) in the swing direction, and the boom tip swing direction speed X4 is the speed of the upper boom 16E in the swing direction. Furthermore, the rotation angle X5 is the rotation angle of the boom 16 (the rotating body 12).

[0060] FIG. 3 is a schematic plan view for explaining the swing prevention control for the crane 10 according to this embodiment.

[0061] Referring to FIG. 3, in a plan view of the crane 10 at the time when the control determination unit 719 determines the start of execution of the swing prevention control and outputs a control start signal, an xy coordinate system is shown in which the direction in which the virtual center line of the boom 16 extends is the y direction and the direction perpendicular to the center line is the x direction with respect to the XY coordinate system with the swing center axis of the swing body 12 as the zero point. The xy coordinate system is set based on the virtual center line of the boom 16 on the assumption that the boom 16 is not elastically deformed. The boom 16 is bent upstream in the swing direction in the swing operation of the swing body 12 that was stopped before the state of FIG. 3. In addition, the main hoisting rope 50 connected to the tip of the boom 16 extends further upstream in the swing direction than the tip of the boom 16. If the swing prevention control according to this embodiment is not executed, the bending of the boom 16 is eliminated from the state of FIG. 3, and swing (swing during swing) of the suspended load connected to the main hoisting rope 50 (main hook 57) occurs.

[0062] In the state shown in FIG. 3, the control target quantity setting unit 720 sets the zero point position in the xy coordinate system, i.e., the virtual tip of the boom 16, as the target boom tip position, and sets the position vertically below it as the target load position. Therefore, through the swing prevention control, the swing speed and swing direction of the revolving body 12 are automatically controlled so that the displacement of the load in at least the swing direction becomes zero at the target load position. The target swing angle in the xy coordinate system for placing the tip of the boom 16 and the load at the target boom tip position and the target load position, respectively, is defined as θref. In other words, the control target quantity setting unit 720 can calculate the target boom tip position and the target load position from the target swing angle θref, the boom hoisting angle, and the length of the boom 16. In addition, the control target quantity setting unit 720 sets the target quantity of the speed control among the above control quantities to zero because the purpose is to stop the load. With regard to the turning speed, a left turning direction is defined as a plus (positive) value, and a right turning direction is defined as a minus (negative) value.

[0063] The control amount calculation unit 700F calculates the deviation between the detection values ​​detected by each detection unit of the detection unit 700D and the target amounts set by the control target amount setting unit 720 for each control amount of the load swing direction displacement X1, the load swing direction speed X2, the boom tip swing direction displacement X3, the boom tip swing direction speed X4, and the swing angle X5. More specifically, the control amount calculation unit 700F calculates the deviation between the detection values ​​detected by each detection unit of the detection unit 700D and the target amounts set by the control target amount setting unit 720, using the boom length information output from the boom length information acquisition unit 708, the swing angle output from the swing angle detection unit 710, the boom hoisting angle output from the boom hoisting angle detection unit 711, the boom tip displacement output from the boom top swing direction displacement detection unit 713, the boom tip speed output from the boom top swing direction speed detection unit 714, and the swing of the main hoisting rope 50 output from the rope swing direction sway angle detection unit 715. The current values ​​of the five state quantities are calculated based on the sway angle (load displacement output from the load displacement detection unit), the sway angular velocity of the main hoisting rope 50 output from the rope rotation direction sway angular velocity detection unit 716 (load speed output from the load speed detection unit), the rope length information output from the rope length detection unit 717, the hanging load weight information output from the hanging load weight detection unit 718, and the target state quantities of the five state quantities set by the control target quantity setting unit 720.

[0064] 3, the displacement X1 of the load in the rotation direction is the sum of the displacement X3 of the boom tip in the rotation direction and the displacement in the rotation direction of the load relative to the tip position of the boom 16. Therefore, the displacement X1 of the load in the rotation direction can be calculated by the following formula 1.

[0065]

number

[0066] In formula 1, L is the length of the main hoisting rope 50 between the tip of the boom 16 and the suspended load, and is detected by the rope length detection unit 717. Also, γl is the sway angle in the rotation direction of the main hoisting rope 50, and is detected by the rope rotation direction sway angle detection unit 715. As shown in formula 1, when γl<<1, it can be approximated as sin(γl)=γl.

[0067] Similarly, the load rotation direction speed X2 is obtained by adding the boom tip rotation direction speed X4 to the relative speed of the load with respect to the tip position of the boom 16. Therefore, the load rotation direction speed X2 can be calculated by the following formula 2.

[0068]

number

[0069] In addition, in Equation 2, γl′ is the sway angular velocity in the rotation direction of the main winding rope 50, and is detected by the rope rotation direction sway angular velocity detection unit 716.

[0070] Furthermore, the boom tip rotation direction displacement X3 and the boom tip rotation direction speed X4 are detected by the boom top rotation direction displacement detection unit 713 and the boom top rotation direction speed detection unit 714 described above, respectively.

[0071] Moreover, the rotation angle X5 corresponds to the deviation between the ever-changing rotation angle of the rotating body 12 (the boom 16) and the above-mentioned target rotation angle θref, and is calculated by the following formula 3.

[0072]

number

[0073] In addition, in the formula 3, integral(θ') is a value obtained by integrating with respect to time the turning angle detected by the turning angle detection unit 710. Also, the target turning angle θref is set by the control target amount setting unit 720 as described above.

[0074] The control gain setting unit 726 sets the control gains of each controlled variable so that the time integral of the weighted sum of each controlled variable and the input variable (swing speed) is minimized based on a control model that takes into account the effect of the elastic deformation (deflection) of the boom 16. Specifically, the control gain setting unit 726 sets control gains G1, G2, G3, G4, and G5 for the above-mentioned controlled variables X1, X2, X3, X4, and X5 calculated by the control variable calculation unit 700F, respectively. At this time, each control gain is set so that the above-mentioned controlled variables X1, X2, X3, X4, and X5 calculated by the control variable calculation unit 700F and the swing speed corresponding to the input variable quickly converge to zero. More specifically, the control gain setting unit 726 sets the control gains so that the time integral of the weighted sum of each controlled variable and the input variable (swing speed) is minimized based on a predetermined control model. The control model in this embodiment takes into consideration the influence of elastic deformation occurring in the boom 16 due to the inertial force generated by the moment of inertia of the boom 16 and the external force in the rotation direction generated by the swing of the suspended load. Note that 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, and the use of this control model makes it possible to design a stable control system. The control model can obtain a state space expression that takes into account the elasticity of the boom 16 by combining it with an equation that expresses the elasticity of the boom 16. Note that the control model according to this embodiment will be described in detail later.

[0075] The rotation target speed calculation unit 727 calculates the rotation target speed Vref of the rotating body 12 from the following equation 4 based on the control variables 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.

[0076]

number

[0077] Furthermore, the swing operation target calculation unit 728 calculates a swing operation target command value to be input to the drive control unit 700 so that the swing speed of the swing unit 12 becomes the swing target speed Vref calculated by the swing target speed calculation unit 727. Specifically, the swing operation target calculation unit 728 calculates a swing operation target amount based on the swing target speed Vref calculated by the swing target speed calculation unit 727 and the hydraulic characteristics in the swing drive unit 701. Then, the calculated swing operation target amount is input to the drive control unit 700, and the swing speed and swing direction of the swing unit 12 are set by the swing drive unit 701.

[0078] FIG. 4 is a flowchart of the swing anti-sway control of the crane 10 according to this embodiment. In this embodiment, when swing anti-sway control is started, known parameters are set and stored in advance in a storage unit (not shown) in the vibration suppression control unit 700E (step S01). The known parameters include the length of the boom 16, the elastic coefficient of the boom 16, the moment of inertia of the boom 16, and the like. As described above, 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 coefficient of the boom 16 and the moment of inertia of the boom 16 can be calculated by I and k by replacing the jib with the boom in Equation 17 described below. θ are included as, respectively.

[0079] Then, the control determination unit 719 determines whether or not a switch (input unit) for starting the swing prevention control arranged in the cab 15 is pressed (turned ON) (step S02). If the switch is turned ON (YES in step S02), the control determination unit 719 determines whether or not the switch was turned ON in the flow immediately before the flow shown in FIG. 4 is repeated (repeating steps S10 to S02 in FIG. 4) (step S03). If the switch is turned OFF in the previous flow (NO in step S03), the detection unit 700D updates the detection parameters (step S04). In more detail, the boom hoisting angle detection unit 711, the rope length detection unit 717, and the hoisting load detection unit 718 detect and update the hoisting angle of the boom 16, the payout amount of the main hoisting rope 50, and the hoisting load (load), respectively.

[0080] Next, the control target amount setting unit 720 sets the parameters of the control model (step S05). In detail, the control target amount setting unit 720 sets the target amount of each control amount as described above.

[0081] Next, the control gain setting unit 726 determines the control gains (feedback gains) (step S06). In detail, the control gain setting unit 726 determines the above-mentioned G1, G2, G3, G4, and G5, respectively, and proceeds to step S08.

[0082] In step S03, if the switch was ON in the previous flow (YES in step S03), the parameters and gains from steps S04 to S06 are maintained at the values ​​acquired in the previous flow (step S07), and the process proceeds to step S08.

[0083] In step S08, the control amount calculation unit 700F updates the state parameters. Specifically, the control amount calculation unit 700F calculates the swing direction displacement X1 of the load, the swing direction speed X2 of the load, the swing direction displacement X3 of the boom tip, the swing direction speed X4 of the boom tip, and the swing angle X5.

[0084] Next, the turning target speed calculation unit 727 calculates the turning target speed Vref (step S09).

[0085] Next, the swing operation target calculation unit 728 calculates a command current value for inputting a command signal to the swing drive unit 701 (step S10). Specifically, the swing operation target calculation unit 728 calculates a swing operation target command value for inputting to the drive control unit 700 so that the swing speed of the swing body 12 becomes the swing target speed Vref calculated by the swing target speed calculation unit 727, as described above.

[0086] In step S02, if the switch (input unit) for starting the swing anti-sway control is not pressed (NO in step S02), the vibration suppression control unit 700E prohibits automatic control of the crane 10 for the purpose of swing anti-sway control.

[0087] Then, the flow shown in FIG. 4 is repeated until the load stops (or substantially stops) at least in the rotation direction at the target load position in FIG.

[0088] <Second embodiment> Fig. 5 is a side view of a crane 10 according to a second embodiment of the present invention. Fig. 6 is a block diagram of a swing prevention device 70 of the crane 10 according to this embodiment. Note that in this embodiment, differences from the first embodiment will be mainly described, and descriptions of common points will be omitted.

[0089] 5, the crane 10 according to this embodiment further includes a jib 18 (elevating body) in comparison with the crane 10 in FIG.

[0090] The jib 18 has a jib base end supported at the tip of the boom 16 (boom tip, upper boom 16E) so as to be rotatable in the hoisting direction around a rotation axis (second rotation axis) parallel to the rotation axis of the boom 16, and a jib tip opposite the jib base end. In this embodiment, a main hoisting rope 50 hangs down from the jib tip and is connected to a suspended load. Note that, like the boom 16, the specific structure of the jib 18 is not limited.

[0091] Furthermore, the crane 10 is equipped with 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.

[0092] The rear strut 21 is pivotally supported at the tip of the boom 16 so as to be rotatable. The rear strut 21 is held in a position in which it projects from the tip of the upper boom 16E toward the boom erection side (the left side in FIG. 1). As a means for holding this position, a pair of left and right strut backstops 25 and a pair of left and right guy lines 26 are interposed between the rear strut 21 and the boom 16. The strut backstop 25 is interposed between the intermediate boom 16D and the middle part of the rear strut 21, and supports the rear strut 21 from below. The guy lines 26 are tensioned to connect the tip of the rear strut 21 and the lower boom 16A of the boom 16, and the tension of the guy lines 26 regulates the position of the rear strut 21. In other words, the pair of left and right strut backstops 25 and the pair of left and right guy lines 26 regulate the relative rotation of the rear strut 21 with respect to the boom 16 when the crane 10 is in use. The rear strut 21 has a sheave block 47 and rear strut idler sheaves 52, 62. The sheave block 47 is located at the pivot end of the rear strut 21 and includes multiple sheaves arranged in the width direction. The rear strut idler sheaves 52, 62 are located at a portion of the rear strut 21 that is closer to the base end than the longitudinal center, and each includes multiple sheaves arranged in the width direction.

[0093] The front strut 22 is disposed behind the jib 18 and is pivotally supported on the tip of the boom 16 (upper boom 16E) so as to rotate in conjunction with the jib 18. In detail, a pair of jib guylines 28 are stretched to connect the tip of the front strut 22 and the tip of the jib 18. Therefore, the jib 18 is also rotated integrally with the front strut 22 by the rotational drive of the front strut 22. The above-mentioned rear strut 21 is disposed on the rear side of the front strut 22 as shown in FIG. 1, and forms a substantially isosceles triangle shape with the front strut 22. The front strut 22 has a sheave block 48 and front strut idler sheaves 53, 63. The sheave block 48 is disposed at the rotation end of the front strut 22 and includes a plurality of sheaves arranged in the width direction. The front strut idler sheaves 53, 63 are arranged in a portion located closer to the base end side than the longitudinal center of the front strut 22, and each include a plurality of sheaves arranged in the width direction.

[0094] The crane 10 further includes a jib hoisting winch 32 for rotating the jib 18 in the hoisting direction, and a jib hoisting rope 44.

[0095] The jib hoist winch 32 winds and pays out the jib hoist rope 44 that is wound around the rear strut 21 and the front strut 22. The jib hoist rope 44 is arranged so that the front strut 22 rotates as a result of the winding and paying out. Specifically, the jib hoist rope 44 that is pulled out from the jib hoist winch 32 is hung around the idler sheave 32S and the intermediate boom sheave 46, and is further hung between the sheave blocks 47 and 48 multiple times. Therefore, the jib hoist winch 32 changes the distance between the sheave blocks 47 and 48 by winding and paying out the jib hoist rope 44, and rotates the front strut 22 relative to the rear strut 21. As a result, the jib hoist winch 32 raises and lowers the jib 18 that is linked to the front strut 22.

[0096] 6, in the crane 10 according to this embodiment, compared to FIG. 2, the operation unit 700B further includes a jib hoisting operation unit 705A (jib hoisting operation unit), and the drive unit 700A further includes a jib hoisting drive unit 702A (jib drive unit). The information acquisition unit 700C of the slewing anti-sway device 70 further includes a jib length information acquisition unit 709, and the detection unit 700D further includes a jib hoist angle detection unit 712. The detection unit 700D further includes a jib top slewing direction displacement detection unit 713A (hoisting body displacement detection unit) and a jib top slewing direction speed detection unit 714A (hoisting body speed detection unit) instead of the boom top slewing direction displacement detection unit 713 and the boom top slewing direction speed detection unit 714 in FIG. 2.

[0097] The jib hoisting operation unit 705A can be switched between a jib hoisting position for hoisting the jib 18 and a neutral position for stopping the hoisting of the jib 18. The jib hoisting drive unit 702A can rotate the jib 18 in the hoisting direction around the second rotation axis. 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 and the jib tip. The jib hoisting angle detection unit 712 detects and outputs the hoisting angle of the jib 18 around the second rotation axis. The jib top rotation direction displacement detection unit 713A detects and outputs the displacement of the jib tip in the rotation direction (jib tip displacement) as the hoisting body tip displacement. The jib top rotation direction speed detection unit 714A detects and outputs the speed of the jib tip in the rotation direction (jib tip speed) as the elevation body tip speed.

[0098] In addition, the control amount calculation unit 700F calculates the jib tip rotation direction displacement X3A and the jib tip rotation direction speed X4A instead of the boom tip rotation direction displacement X3 and the boom tip rotation direction speed X4. The jib tip rotation direction displacement X3A is the displacement of the tip of the jib 18 in the rotation direction as described above, and the jib tip rotation direction speed X4A is the speed of the tip of the jib 18 in the rotation direction.

[0099] In this embodiment, in step S01 in the flow chart of Fig. 4, the length information of the jib 18, the elastic coefficient of the jib 18, and the moment of inertia of the jib are each stored in a storage unit (not shown). In step S04, the hoisting angle of the jib 18 is further detected by the jib hoisting angle detection unit 712. In step S05, when the control determination unit 719 determines that the swing prevention control start condition is satisfied and the control start signal is output, the control target amount setting unit 720 sets the target state amounts for at least five (plural) control amounts (state amounts), namely, the load swing direction displacement X1, the load swing direction speed X2, the jib tip swing direction displacement X3A, the jib tip swing direction speed X4A, and the swing angle X5. Furthermore, in step S06, the control gain setting unit 726 sets each of the control gains G1 to G5, and in step S08, the control amount calculation unit 700F calculates the control amount based on the boom length information and the jib length information output from the boom length information acquisition unit 708 and the jib length information acquisition unit 709, respectively, the rotation angle output from the rotation angle detection unit 710, the boom hoisting angle output from the boom hoisting angle detection unit 711, the jib hoisting angle output from the jib hoisting angle detection unit 712, the jib tip displacement output from the jib top rotation direction displacement detection unit 713A, and the jib top rotation direction displacement detection unit 714. The current values ​​of the five state quantities including the jib tip rotation direction displacement X3A and the jib tip rotation direction velocity X4A are calculated based on the jib tip speed output from the rope rotation direction sway angle detection unit 714A, the sway angle output from the rope rotation direction sway angle detection unit 715, the sway angular velocity output from the rope rotation direction sway angular velocity detection unit 716, the rope length information output from the rope length detection unit 717, the hanging load weight information output from the hanging load weight detection unit 718, and the target state quantities of the five state quantities set by the control target quantity setting unit 720.

[0100] That is, in this embodiment as well, in each equation of the first embodiment described above, the boom 16 as the hoisting body is replaced with a jib 18, thereby realizing anti-sway control of rotation of the load (main hook 57) connected to the main hoisting rope 50 hanging down from the tip of the jib 18.

[0101] <Third embodiment> FIG. 7 is a block diagram of a swing prevention device 70 of a crane 10 according to a third embodiment of the present invention. FIG. 8 is an enlarged side view of the tip of a boom 16 of a crane 10 according to a third embodiment of the present invention. FIG. 9 is a block diagram of a suspended load displacement detection unit 715A and a suspended load speed detection unit 716A of a crane 10 according to a third embodiment of the present invention. Note that in this embodiment, differences from the first embodiment will be mainly described, and descriptions of commonalities will be omitted. Also, the structure of the crane 10 according to this embodiment is similar to that of the crane 10 shown in FIG. 2.

[0102] In this embodiment, the structure for acquiring the suspended load displacement and the suspended load speed is different from that of the previous first embodiment. Specifically, the sway prevention device 70 according to this embodiment (FIG. 7) has a suspended load displacement detection unit 715A instead of the rope sway angle detection unit 715 in FIG. 2, and has a suspended load speed detection unit 716A instead of the rope sway angular velocity detection unit 716 in FIG. 2.

[0103] 8, the slewing anti-sway device 70 has a camera 80 (photographing device), a jig 80S for the camera, and a recognition marker 57S (target). The camera 80 is supported by the jig 80S for the camera attached to the tip of the boom 16 (upper boom 16E). The jig 80S for the camera is fastened to the lattice (frame) of the boom 16 with a bolt or the like, and has a function of adjusting the attitude of the camera 80 so that the photographing direction of the camera 80 faces downward even if the hoisting angle of the boom 16 changes. This 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 together with the suspended load. The camera 80 photographs the recognition marker 57S (target) associated with the suspended load in this way, and outputs the photographed image information.

[0104] 9, the suspended load displacement detection unit 715A and the suspended load speed detection unit 716A include, in addition to the camera 80 described above, an image processing unit 81 and a detection amount calculation unit 82 (both are calculation units).

[0105] The image processing unit 81 and the detection amount calculation unit 82 acquire position information by performing image processing on the image information input from the camera 80, and input the position information to the control amount calculation unit 700F via a wired cable or wireless communication (not shown). 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 inputs the image processed information to the detection amount calculation unit 82. The detection amount calculation unit 82 acquires the coordinates of the marker 57S based on the size in pixels of the recognition marker 57S included in the received information and the previously acquired distance information from the camera 80 to the marker 57S. As a result, the displacement of the suspended load moving together with the marker 57S, particularly the sway angle (swing angle) in the rotation direction, is acquired. Furthermore, the detection amount calculation unit 82 calculates the speed of the suspended load, particularly the sway angular velocity of the suspended load in the rotation direction, by numerically differentiating the above-mentioned displacement (sway angle) of the suspended load.

[0106] As in the first embodiment, the control quantity calculation unit 700F calculates the deviation between the detection values ​​detected by each detection unit of the detection unit 700D and the target quantities set by the control target quantity setting unit 720 for each of the control quantities, namely, the load rotation directional displacement X1, the load rotation directional speed X2, the boom tip rotation directional displacement X3, the boom tip rotation directional speed X4, and the rotation angle X5. More specifically, the control quantity calculation unit 700F calculates current values ​​of the five control quantities (state quantities) based on the boom length information output from the boom length information acquisition unit 708, the rotation angle output from the rotation angle detection unit 710, the hoisting angle output from the boom hoisting angle detection unit 711, the boom tip displacement output from the boom top rotation direction displacement detection unit 713, the boom tip speed output from the boom top rotation direction speed detection unit 714, the load displacement output from the load displacement detection unit 715A, the load speed output from the load speed detection unit 716A, the rope length information output from the rope length detection unit 717, the hanging load weight information output from the hanging load weight detection unit 718, and the target state quantities of the five state quantities set by the control target quantity setting unit 720.

[0107] In this embodiment, the load rotation direction displacement X1 is the sum of the load rotation direction displacement X1' when viewed from the tip of the boom 16 (upper boom 16E) and the boom tip rotation direction displacement X3, and is calculated using the following equation 5.

[0108]

number

[0109] Here, X1' is the suspended load displacement as seen from the tip of the boom 16, acquired by the suspended load displacement detection unit 715A. On the other hand, the suspended load rotation direction speed X2 is the sum of the boom tip rotation direction speed X4 to the rotation direction speed X2' of the suspended load as seen from the tip of the boom 16, and is calculated by the following formula 6.

[0110]

number

[0111] The boom tip rotation direction displacement X3, the boom tip rotation direction speed X4, and the rotation angle X5 are detected or calculated in the same manner as in the first embodiment. Furthermore, the calculation processes by the control gain setting unit 726, the rotation target speed calculation unit 727, and the rotation operation target calculation unit 728 are also similar.

[0112] As described above, in this embodiment, the load rotation direction displacement X1 and the load rotation direction speed X2 can be acquired based on image information from the camera 80 attached to the tip of the boom 16. Therefore, compared to the previous first embodiment, even if bending occurs in the main hoisting rope 50 (suspension rope), the position of the recognition marker 57S associated with the load can be directly detected, making it possible to accurately acquire the load rotation direction displacement X1 and the load rotation direction speed X2.

[0113] <The process from creating a control model to deriving gains> Next, a control model used in the calculation of the vibration damping control unit 700E according to each embodiment described above will be described. In creating the control model, the behavior of the crane 10 is expressed by a motion equation as described below, and the motion equation is transformed into a state equation as shown in the following formula 7.

number

[0114] In addition, a dot placed above a letter in the following formulas, such as the x in formula 7, means a time derivative. For example, one dot placed above an x ​​means the first time derivative of x, and two dots placed above an x ​​means the second time derivative of x. Furthermore, in the text other than the formulas, apostrophes are placed instead of the dots due to writing restrictions. The same applies to other formulas and descriptions in the text.

[0115] Although various methods for designing such a control system are known, in this embodiment, a method called an optimal control method is used, which controls the target (crane 10) so as to minimize an evaluation function. In this optimal control method, the evaluation function is first defined as shown in the following equation 8.

[0116]

number

[0117]

number

[0118]

number

[0119] <Derivation of the state equation for cranes> Next, the derivation of the state equation shown in the above formula 7 will be described. Figures 10 and 11 are model diagrams for explaining the swing prevention control of the crane 10 according to this embodiment. Note that in Figures 10 and 11, the crane 10 according to the second embodiment is assumed, and the jib 18 is supported by the boom 16. However, in the crane 10 according to the first embodiment, the jib 18 in Figures 10 and 11 does not exist, that is, the length of the jib 18 is assumed to be zero, and the state equation can be derived in the same manner.

[0120] In deriving the state equation, first, a control model of the crane 10 is derived using the equation of motion. As shown in Figs. 10 and 11, the crane 10 is assumed to rotate around the Z axis. The position of the load is expressed using load position coordinates xt, yt, and zt. The load position coordinates xt, yt, and zt are based on the initial rotation angle at the moment (initial state) when the control start signal is output, and the origin is directly below the load position when the vibration of the jib 18 and the swing of the load stop. The yt axis is set to extend in the radial direction so as to share the XY plane with the XYZ coordinates of the global coordinate system, the xt axis is set to extend in the rotation direction, and the zt axis is set in the same direction as the Z axis. Here, the rotation angle, which is the angle by which the rotating body 12 rotates from the initial state, is defined as θ. The angle by which the rotating body 12 rotates from the position where the rotating body 12 starts rotating until the control start signal is output is defined as θt. Also, the length of the boom 16 is L B1 , the length of the jib 18 is L B2 , the boom 16 elevation angle is defined as γ1, and the jib 18 elevation angle is defined as γ2. The turning radius of the load in plan view is r0 = L B1 cosγ1+L B2 cos γ2. The sway angle of the main hoisting rope 50 is defined as γl. At this time, the kinetic energy T and potential energy U of the load are expressed by the following formula 11.

[0121]

number

[0122]

number

[0123]

number

[0124]

number

[0125]

number

[0126]

number

[0127] FIG. 12 is a model diagram for further explaining the swing prevention control of the crane 10 according to this embodiment. The inertia of the jib 18 (elevating body) acts as a mass (difficulty in moving and rotating) in linear motion with respect to rotational motion, and the forces that contribute to the deformation of the jib 18 are the forced displacement by the hydraulic motor and the tension of the main hoisting rope 50 applied to the jib 18, so the twisting deformation of the jib 18 is dominant. For this reason, when considering the elasticity of the jib 18, the equation of motion can be obtained by analogy with the spring-mass system as shown in FIG. 12. If the moment of inertia of the jib 18 is I, the torsional rigidity of the jib 18 is kθ, the angle of the jib tip is θ, and the rotation angle of the swing motor is θm, the equation of motion can be expressed by the following equation 17 derived from the Lagrange equation of motion of equation 14.

[0128]

number

[0129] Thus, Equation 17 includes a term that takes into account the elastic deformation of the undulating body. Based on the above, in order to show the state equation, state x is defined as shown in Equation 18 below.

number

[0130] From Equations 16, 17, and 18, the state equation of Equation 7 is expressed by the following Equations 19 and 20.

number

number

[0131] That is, based on the state equations expressed by Equations 19 and 20, the control gain setting unit 726 can calculate the control gains G1 to G5 (feedback gains).

[0132] Fig. 13 is a graph showing the transition of the displacement of the suspended load in the swing direction in another swing anti-sway control compared to the swing anti-sway control of the crane 10 according to this embodiment. The dashed line in Fig. 13 shows the displacement of the suspended load in the swing direction in the case where no swing anti-sway control was performed immediately after the swing operation of the crane 10 was stopped, and it can be seen that periodic swing continues. On the other hand, the solid line in Fig. 13 shows the result when the control gains G1 to G5 are calculated using a control model that does not consider the elastic deformation of the boom 16, unlike each embodiment of the present invention. As shown in Fig. 13, in such a calculation, the feedback control diverges, resulting in a larger swing of the suspended load than the result of the dashed line where no control is performed.

[0133] On the other hand, Fig. 14 is a graph showing the transition of the displacement in the swing direction of the suspended load in the swing prevention control of the crane 10 according to each embodiment of the present invention. The dashed line is the same as in Fig. 13. As shown in Fig. 14, when the control gains G1 to G5 are calculated using a control model that takes into account the elastic deformation of the hoisting body (boom 16) as in each embodiment of the present invention, it is confirmed that the swing of the suspended load converges early.

[0134] As described above, according to the swing prevention device 70 according to each embodiment of the present invention, in the crane 10 having undulating bodies such as the boom 16 and the jib 18, the control gain setting unit 726 determines the control gains G1 to G5 so as to minimize the time integral of the weighted sum of each control amount (state amount) (load swing direction displacement X1, load swing direction speed X2, boom tip swing direction displacement X3, boom tip swing direction speed X4, and swing angle X5) and the input amount (swing speed) based on a control model that takes into account the influence of the swing operation of the swing body 12 and the elastic deformation of the boom 16 due to the load of the suspended load. Then, the swing target speed calculation unit 727 calculates the swing target speed based on the control amount and the control gain, and the swing operation target calculation unit 728 drives the swing drive unit 701 so as to achieve the target speed, thereby enabling stable swing prevention of the suspended load.

[0135] Particularly in the first, second and third embodiments, the control gain setting unit 726 sets five control gains G1 to G5 corresponding to the five state quantities, respectively, based on a state equation relating to the behavior of the load, which is preset to include a term corresponding to at least the elastic deformation of the hoisting body (boom 16, jib 18), and which has the rotation speed of the hoisting body 12 (hoisting body) as a variable. Then, the rotation target speed calculation unit 727 calculates a rotation target speed, which is a target value of the rotation speed of the hoisting body 12, from the five control gains set by the control gain setting unit 726 and the current values ​​of the five state quantities calculated by the control amount calculation unit 700F. Then, the rotation operation target calculation unit 728 and the drive control unit 700 output command information corresponding to the rotation target speed to the rotation drive unit 701 so that the rotation speed of the hoisting body 12 becomes the rotation target speed (including the magnitude and direction of the speed) calculated by the rotation target speed calculation unit 727.

[0136] According to this configuration, the control gain setting unit 726 sets the control gains G1 to G5 of each state quantity based on a state equation that takes into account the elastic deformation of the hoisting body. The rotation target speed calculation unit 727 sets the rotation target speed Vref of the hoisting 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. The above state quantities include the displacement and speed of the load as well as the displacement and speed of the tip of the hoisting body, so that by combining this with rope length information of the load rope, the swing control of the load can be performed while taking into account the relative position between the load and the tip of the hoisting body. Therefore, even if the hoisting body is elastically deformed, such as deflected, by the moment of inertia applied to the hoisting body due to the hoisting operation or the load of the load, the swing of the load in the rotation direction can be stably converged.

[0137] Furthermore, in the first, second and third embodiments described above, when the control judgment unit 719 determines that the rotation anti-sway control start condition is satisfied and the control start signal is output, the control target quantity setting unit 720 sets the target state quantities of the rotation angle, the tip displacement of the hoisting body and the displacement of the load as the target position, which is the position vertically below the tip of the hoisting body when viewed in a plan view of the crane 10, assuming that the hoisting body is not elastically deformed, and further sets the target state quantities of the load speed and the tip speed of the hoisting body to zero.

[0138] With this configuration, a target position for converging the swing of the load is set based on the position of the tip of the hoisting body at the time the control start signal is output. Therefore, unlike other anti-sway devices that control the swing of the upper body to always move the tip of the hoisting body to a position above the load without considering the elastic deformation of the hoisting body, the tip of the hoisting body does not follow the movement of the load and the swing direction is not frequently changed, and the swing of the load can be converged early by controlling the swing operation according to the final target position.

[0139] Furthermore, the control gain setting unit 726 sets the five control gains G1 to G5 so that the integral value with respect to time of the weighted sum including the five state quantities and the rotation speed of the rotating body 12 is minimized. Therefore, the control gain for quickly converging the rotational swing of the load can be set in a short time. Note that a method based on the so-called pole placement method or a method based on H-infinity control may be adopted as a method for setting this control gain. The method for setting the control gain according to each embodiment of the present invention is based on the so-called LQ optimal control (Linear Quadratic Optimal Control). The LQ optimal control has a feature that it is easier to design a control system to be robust against disturbances compared to the above-mentioned pole placement method. Also, the LQ optimal control has a feature that it is easier to design a control system compared to the H-infinity control, and that it is easier to demonstrate its effect even when it is affected by disturbances.

[0140] In addition, in the above second embodiment, in a configuration in which the main hoisting rope 50 hangs down from the tip of the jib 18 which is supported at the tip of the boom 16 so that it can be raised and lowered, even if the jib 18 undergoes elastic deformation such as bending due to the moment of inertia imparted to the jib 18 by the rotation operation or the load of the suspended load, it is possible to stably converge the swing of the suspended load in the rotation direction.

[0141] In each embodiment of the present invention, as described above, the detection parameters for determining the feedback gain are the length of the hoisting body, which determines the working radius of the crane 10, the hoisting angle of the hoisting body, the elastic modulus of the hoisting body, the payout amount of the main hoisting rope 50, the moment of inertia of the hoisting body, and the weight of the suspended load (suspended load). On the other hand, the suspension load rotation direction displacement X1, the suspension load rotation direction speed X2, the boom tip rotation direction displacement X3, the boom tip rotation direction speed X4, and the rotation angle X5 correspond to the control quantities (state quantities).

[0142] The above describes the swing-stop device 70 according to each embodiment of the present invention and the crane 10 equipped with the same. However, the present invention is not limited to these embodiments. For example, the present invention can take the following modified embodiments.

[0143] (1) Fig. 15 is a model diagram for explaining swing prevention control of a crane according to a modified embodiment of the present invention. In each of the above embodiments, the state quantities are explained using the swing direction displacement X1 of the load, the swing direction speed X2 of the load, the swing direction displacement X3 of the boom tip, the swing direction speed X4 of the boom tip, and the swing angle X5, but these state quantities may be calculated from the detection results of other detection units.

[0144] 15, the boom tip rotation direction displacement X3 and the boom tip rotation direction velocity X4 may be calculated from the rotation angle θ and the rotation angular velocity dθ / dt by detecting the amount of deflection θe=θ-θm of the boom 16. If it is possible to detect the relative displacement xm of the load with respect to the tip of the boom 16, it is also possible to calculate the position θ of the tip of the boom 16 from the detection result and select the load rotation direction displacement X1, load rotation direction velocity X2, load rotation direction relative displacement X3, load rotation direction relative velocity X4, and rotation angle X5 as the control quantity (state quantity). The load rotation direction displacement X1, load rotation direction velocity X2, load rotation direction relative displacement X3, and load rotation direction relative velocity X4 may also be measured by a camera attached to the rotating body 12 and a camera attached to the tip of the boom 16.

[0145] (2) In addition, in the above embodiments, the structure of the crane to which the sway prevention device 70 according to each of the above embodiments is applied is not limited to the crane 10 shown in Figures 1 and 5, and may be a crane having another structure. In addition, the number of the above control variables (state variables) and corresponding control gains is not limited to five, and it is sufficient that at least five control variables and control gains are detected or calculated.

[0146] (3) Furthermore, in the third embodiment, the load rotation direction displacement X1 and the load rotation direction speed X2 are acquired based on the image information of the camera 80 attached to the tip of the boom 16, but the present invention is not limited to this. The load position in the global coordinate system may be detected by a GPS attached to the hook 57 or the load, and the load rotation direction displacement X1 and the load rotation direction speed X2 may be acquired. The swing-proof device 70 may also have a gyro sensor (IMU: Inertial Measurement Unit) connected to the tip of the main hoisting rope 50 (hanging rope) suspended from the tip of the boom 16. In this case, the load displacement detection unit 715A and the load speed detection unit 716A detect and output the load displacement and the load speed, respectively, based on the output of the gyro sensor. The load displacement detection unit 715A and the load speed detection unit 716A according to the third embodiment may also be applied to the second embodiment. [Explanation of symbols]

[0147] 10. Crane 12 Rotating body (upper body) 13 Counterweight 14 Running body (lower body) 15 Cab 16 Boom (elevating body) 18 Jib (elevating body) 20 Mast 30 Boom raising winch 32 Jib hoisting winch 34 Main winch 38 Boom hoisting rope 44 Jib hoisting rope 50 Main hoisting rope (suspension rope) 57 Main Hook 70 Swing anti-vibration device 700 Drive control unit (command information output unit) 700A Drive Unit 700B Operation unit 700C Information acquisition section 700D Detector 700E vibration control unit 700F Control quantity calculation unit (state quantity calculation unit) 701 Swivel drive unit 702 Drilling drive unit (drilling body drive unit, boom drive unit) 702A Jib hoisting drive unit (hoisting body drive unit, jib drive unit) 703 Winch drive unit (load drive unit) 704 Swivel operation unit (swivel operation unit) 705 Hoisting operation unit (hoisting operation unit, boom hoisting operation unit) 705A Jib hoisting control unit (hoisting control unit, jib hoisting control unit) 706 Winch operation unit (lifting operation unit) 708 Boom length information acquisition unit (boom length information acquisition unit) 709 Jib length information acquisition unit (elevation body length information acquisition unit) 710 Turning angle detector 711 Boom hoisting angle detector (boom hoisting angle detector) 712 Jib hoisting angle detector (hoisting angle detector) 713 Boom top rotation direction displacement detection unit (elevation body displacement detection unit) 713A Jib top rotation direction displacement detection unit (elevation body displacement detection unit) 714 Boom top rotation direction speed detector (elevation body speed detector) 714A Jib top rotation direction speed detector (elevation body speed detector) 715 Rope rotation direction sway angle detection unit (suspended load displacement detection unit, rope sway angle detection unit) 715A Suspended load displacement detector 716 Rope rotation direction sway angular velocity detection unit (load speed detection unit, rope sway angular velocity detection unit) 716A Load Speed ​​Detection Unit 717 Rope length detector (rope length information acquisition unit) 718 Suspended load detection unit (suspended load information acquisition unit) 719 Control decision unit (control start condition decision unit) 720 Control target quantity setting unit (target state quantity setting unit) 726 Control gain setting unit (Control gain setting unit) 727 Turning target speed calculation unit (Turning target speed calculation unit) 728 Turning operation target calculation unit (command information output unit) 80 Camera (photographic equipment) 80S Camera Jig 81 Image processing unit (calculation unit) 82 Detected amount calculation unit (calculation unit) X1 Load rotation direction displacement X2 Hanging load rotation direction speed X3 Boom tip rotation direction displacement X3A Jib tip rotation direction displacement X4 Boom tip rotation speed X4A Jib tip rotation speed X5 turning angle

Claims

1. A lower body and an upper body supported on the lower body so as to be rotatable about a rotation center axis extending in the vertical direction; A waving body supported on the upper body so as to be rotatable in a waving direction around a horizontal rotation center axis, the waving body including a base end portion of the waving body and a tip end portion of the waving body opposite to the base end portion of the waving body; A lifting rope suspended from the tip of the elevation body and connected to a lifting load; a rotation drive unit capable of rotating the upper body about the rotation central axis in a first rotation direction and a second rotation direction opposite to the first rotation direction; a rotation operation unit that receives an operation for rotating the upper body, the rotation operation unit being switchable between a rotation position for rotating the upper body in each of the first rotation direction and the second rotation direction and a neutral position for stopping the rotation of the upper body; a riser driving unit capable of rotating the riser in a rise / fall direction around the rotation center axis; a hoisting operation unit that receives an operation for hoisting the undulating body, the hoisting operation unit being switchable between a hoisting position for hoisting the undulating body and a neutral position for stopping the hoisting of the undulating body; A load drive unit capable of lifting and lowering the load relative to the ground by winding and unwinding the load rope; a lifting / lowering operation unit that receives an operation for lifting / lowering the suspended load, the lifting / lowering operation unit being switchable between a lifting / lowering position for lifting / lowering the suspended load and a neutral position for stopping the lifting / lowering of the suspended load; A crane rotation anti-sway device that is mounted on a crane having the above structure and is capable of suppressing the rotational sway of a suspended load, which is a phenomenon in which the suspended load connected to the suspension rope sways in the rotation direction of the upper body with the tip of the hoisting body as a fulcrum after the rotational movement of the upper body stops, an undulating body length information acquisition unit that acquires and outputs undulating body length information, which is information corresponding to the length of the undulating body in a longitudinal direction of the undulating body, which is a direction connecting the base end of the undulating body and the tip end of the undulating body; A rotation angle detection unit that detects and outputs a rotation angle of the upper body about the rotation central axis; an elevation angle detection unit that detects and outputs an elevation angle of the undulating body around the rotation center axis; a hoisting body displacement detection unit that detects and outputs a hoisting body tip displacement, which is a displacement of the hoisting body tip in the rotation direction; a hoisting body speed detection unit that detects and outputs a hoisting body tip speed, which is the speed of the hoisting body tip in the turning direction; A load displacement detection unit that detects and outputs a load displacement, which is a displacement of the load relative to the tip of the undulating body; a load speed detection unit that detects and outputs a load speed, which is a change in the load displacement per unit time relative to the tip of the undulating body; A rope length information acquisition unit that acquires and outputs rope length information, which is information corresponding to the length of the suspension rope between the tip of the hoisting body and the suspension load; a hanging load weight information acquisition unit that acquires and outputs hanging load weight information, which is information regarding the weight of the hanging load; a control start condition determination unit that determines whether or not a swing anti-sway control start condition is satisfied, the start condition being established when all operation units of the swing operation unit, the hoisting operation unit, and the lifting operation unit are each set to the neutral position after the swing drive unit has rotated the upper body in a predetermined swing direction in response to the swing operation unit being set to the swing position; and a target state quantity setting unit that, when it is determined by the control start condition determination unit that the swing anti-sway control start condition is satisfied, sets target state quantities for stopping the load at least in the swing direction at a predetermined target position for a plurality of state quantities including the load displacement, the load speed, the elevation body tip displacement, the elevation body tip speed, and the swing angle; a state quantity calculation unit that calculates current values ​​of the multiple state quantities based on the hoisting body length information output from the hoisting body length information acquisition unit, the slewing angle output from the slewing angle detection unit, the hoisting angle output from the hoisting body angle detection unit, the hoisting body tip displacement output from the hoisting body displacement detection unit, the hoisting body tip speed output from the hoisting body speed detection unit, the load displacement output from the load displacement detection unit, the load speed output from the load speed detection unit, the rope length information output from the rope length information acquisition unit, the hanging load weight information output from the hanging load weight information acquisition unit, and target state quantities of the multiple state quantities set by the target state quantity setting unit; a control gain setting unit that sets a plurality of control gains corresponding to the plurality of state quantities based on a state equation relating to a behavior of the suspended load that is preset and includes at least a term corresponding to the elastic deformation of the undulating body, the state equation including a variable being the rotation speed of the upper body; a turning target speed calculation unit that calculates a turning target speed, which is a target value of the turning speed, from the plurality of control gains set by the control gain setting unit and current values ​​of the plurality of state quantities calculated by the state quantity calculation unit; a command information output unit that outputs command information corresponding to the turning target speed to the turning drive unit so that the turning speed of the upper body becomes the turning target speed calculated by the turning target speed calculation unit; A crane sway prevention device comprising:

2. The load displacement detection unit includes a rope sway angle detection unit that detects and outputs the sway angle of the load rope with respect to the vertical direction when viewed along the radial direction during the rotation of the upper body as the load displacement, 2. The crane rotation sway prevention device according to claim 1, wherein the load speed detection unit includes a rope sway angular velocity detection unit that detects and outputs a sway angular velocity, which is a change in the sway angle of the load rope per unit time, as the load speed.

3. An imaging device that is attached to the tip of the hoisting body, images an object associated with the suspended load, and outputs image information of the image; A calculation unit that calculates the load displacement and the load speed based on the image information output from the photographing device; Further comprising:

2. The sway prevention device for a crane according to claim 1, wherein the image capturing device and the calculation unit function as the suspended load displacement detection unit to detect and output the suspended load displacement, and function as the suspended load speed detection unit to detect and output the suspended load speed.

4. The lifting device further includes a gyro sensor connected to a tip of the lifting rope suspended from the tip of the lifting body, 2. The sway prevention device for a crane according to claim 1, wherein the suspended load displacement detection unit and the suspended load speed detection unit detect and output the suspended load displacement and the suspended load speed, respectively, based on an output of the gyro sensor.

5. 5. A crane sway prevention device as claimed in any one of claims 1 to 4, wherein when the control start condition judgment unit judges that the sway prevention control start condition is satisfied, the target state quantity setting unit sets the target state quantities of the sway angle, the displacement of the tip of the descent body and the displacement of the load to the target position which is a position vertically below the tip of the descent body when it is assumed that the descent body is not elastically deformed in a planar view of the crane, and further sets the target state quantities of the load speed and the tip speed of the descent body to zero.

6. 6. The crane rotation sway prevention device according to claim 1, wherein the control gain setting unit sets the plurality of control gains so that an integral value with respect to time of a weighted sum including the plurality of state quantities and the rotation speed is minimized.

7. The crane includes: As the undulating body, a boom including a boom base end supported on the upper body so as to be rotatable in a hoisting direction about a first rotation central axis horizontal to the upper body, and a boom tip end opposite to the boom base end; A jib including a jib base end supported on the boom tip so as to be rotatable in a boom-hoisting direction about a second rotation axis parallel to the first rotation axis, and a jib tip opposite to the jib base end, which allows the hoisting rope to be hung from the jib tip; having As the elevation body drive unit, a boom driving unit capable of rotating the boom in a hoisting direction about the first rotation central axis; A jib drive unit capable of rotating the jib in a raising and lowering direction around the second rotation central axis; having As the raising and lowering operation unit, a boom hoist operation unit that receives an operation for hoisting the boom, the boom hoist operation unit being switchable between a boom hoist position for raising or lowering the boom and a neutral position for stopping the raising or lowering of the boom; A jib raising and lowering operation unit that receives an operation for raising and lowering the jib and is switchable between a jib raising and lowering position for raising and lowering the jib and a neutral position for stopping the raising and lowering of the jib; Having The undulating body length information acquisition unit is a boom length information acquisition unit that acquires and outputs boom length information, the boom length information being information corresponding to the length of the boom in a boom longitudinal direction that is a direction connecting the boom base end and the boom tip end; A jib length information acquisition unit that acquires and outputs jib length information, which is information corresponding to the length of the jib in the jib longitudinal direction, which is the direction connecting the jib base end and the jib tip end; having The elevation structure displacement detection unit detects and outputs a displacement of the jib tip in the rotation direction as the elevation structure tip displacement, The elevation body speed detection unit detects and outputs the speed of the tip of the jib in the rotation direction as the elevation body tip speed, The elevation angle detection unit is a boom hoist angle detection unit that detects and outputs a hoist angle of the boom about the first rotation central axis; A jib hoisting angle detection unit that detects and outputs the hoisting angle of the jib around the second rotation central axis; having When the control start condition determination unit determines that the swing anti-sway control start condition is satisfied, the target state quantity setting unit sets the target state quantities for a plurality of state quantities, namely, the load displacement, the load speed, the elevation body tip displacement which is the displacement of the jib tip in the swing direction, the elevation body tip speed which is the speed of the jib tip in the swing direction, and the swing angle, 7. The crane sway prevention device according to claim 1, wherein the state quantity calculation unit calculates current values ​​of the plurality of state quantities based on the boom length information and the jib length information output from the boom length information acquisition unit and the jib length information acquisition unit, respectively, the sway angle output from the sway angle detection unit, the boom hoisting angle output from the boom hoisting angle detection unit, the jib hoisting angle output from the jib hoisting angle detection unit, the hoisting body tip displacement output from the hoisting body displacement detection unit, the hoisting body tip speed output from the hoisting body speed detection unit, the load displacement output from the load displacement detection unit, the load speed output from the load speed detection unit, the rope length information output from the rope length information acquisition unit, the hanging load weight information output from the hanging load weight information acquisition unit, and target state quantities of the plurality of state quantities set by the target state quantity setting unit.

8. A lower body and an upper body supported on the lower body so as to be rotatable about a rotation center axis extending in the vertical direction; A lattice-type undulating body including a base end portion of the undulating body supported on the upper body so as to be rotatable in an undulating direction around a horizontal central axis of rotation, and a tip end portion of the undulating body opposite to the base end portion of the undulating body; A lifting rope suspended from the tip of the elevation body and connected to a lifting load; a rotation drive unit capable of rotating the upper body about the rotation central axis in a first rotation direction and a second rotation direction opposite to the first rotation direction; a rotation operation unit that receives an operation for rotating the upper body, the rotation operation unit being switchable between a rotation position for rotating the upper body in each of the first rotation direction and the second rotation direction and a neutral position for stopping the rotation of the upper body; a riser driving unit capable of rotating the riser in a rise / fall direction around the rotation center axis; a hoisting operation unit that receives an operation for hoisting the undulating body, the hoisting operation unit being switchable between a hoisting position for hoisting the undulating body and a neutral position for stopping the hoisting of the undulating body; A load drive unit capable of lifting and lowering the load relative to the ground by winding and unwinding the load rope; a lifting / lowering operation unit that receives an operation for lifting / lowering the suspended load, the lifting / lowering operation unit being switchable between a lifting / lowering position for lifting / lowering the suspended load and a neutral position for stopping the lifting / lowering of the suspended load; A crane sway prevention device according to any one of claims 1 to 7, A crane equipped with

9. A sheave block having a plurality of point sheaves arranged in a width direction is provided at the tip of the undulating body of the undulating body, 9. The crane according to claim 8, wherein the load rope is a load rope that hangs down from the tip of the hoisting body and is connected to a hook, is stretched between the point sheave of the sheave block at the tip of the hoisting body and a sheave of a sheave block provided on the hook, and is connected to a load via the hook.

Citation Information

Patent Citations

  • JP1975087251A

  • Method and device for controlling turn stop of crane

    JP1993254784A

  • Automatic rotation control device for rotary crane

    JP1995069584A

  • Load swing stopper of crane

    JP2008074579A

  • Crane and method for controlling such a crane

    WO2019007541A1