Swing stop control system for crane

The crane steadying control system addresses inefficiencies in existing stabilization methods by using pre-defined templates and reinforcement learning to adaptively select and adjust acceleration/deceleration patterns, ensuring effective stabilization across varying crane conditions.

JP2024164334AInactive Publication Date: 2024-11-27SUMITOMO HEAVY IND MATERIAL HANDLING SYST
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
JP2021165423
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2021-10-07
Publication Date
2024-11-27
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

Existing crane steadying control systems struggle to adequately stabilize the hanging point of a crane in various movement modes due to varying conditions, leading to inefficient calculation loads and insufficient stabilization.

Method used

A crane steadying control system that selects from pre-defined templates of acceleration/deceleration patterns based on real-time information, using a selection unit to choose the appropriate template and adjust parameters, and incorporates reinforcement learning to improve template selection over time.

Benefits of technology

The system effectively stabilizes the crane by selecting the most suitable template and parameters for the current conditions, reducing calculation load and ensuring efficient stabilization regardless of varying crane conditions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024164334000001_ABST
    Figure 2024164334000001_ABST
Patent Text Reader

Abstract

To provide a swing stop control system of a crane capable of properly controlling a swing stop according to a crane situation.SOLUTION: A selection part 12 selects a template to apply based on the information about a swing stop from multiple templates of acceleration / deceleration patterns of a hanging point SP of a crane 1. An operation control part 13 controls the crane 1 based on the selected template. And thus, the selection part 12 can select an appropriate template for the situation of the crane 1 because the selection part can select from the multiple templates. The selection part 12 can easily obtain the acceleration / deceleration pattern by using a pre-prepared template without calculating the acceleration / deceleration patterns from scratch.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 anti-sway control system. [Background technology]

[0002] Conventionally, there is known a crane anti-sway control system (see, for example, Patent Document 1) that controls a crane that suspends an object with a suspending member and a suspending part to prevent the sway of the suspending part. This crane anti-sway control system stops the sway of the suspending part when moving from a certain point to a target point in the shortest possible moving time. This system measures the state of sway during movement and corrects the speed pattern based on the measurement results. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2011-126689 A Summary of the Invention [Problem to be solved by the invention]

[0004] Here, the suspension point of the crane moves in various ways depending on the situation. In addition, the sway of the suspension part also occurs in various ways accordingly. When the crane anti-sway control system tries to calculate the optimal speed and acceleration pattern for the sway prevention of the crane depending on the various crane situations, it may not be able to sufficiently prevent the sway. Or, the calculation load due to the anti-sway control may become large.

[0005] The present invention has been made to solve such problems, and has an object to provide a crane anti-sway control system that can perform appropriate anti-sway control according to the condition of the crane. [Means for solving the problem]

[0006] The crane anti-sway control system of the present invention is a crane anti-sway control system that controls a crane that suspends an object with a hanging member and a hanging part to prevent the hanging part from swaying, and is equipped with a selection unit that selects a template to be applied from a plurality of templates of acceleration and deceleration patterns of the crane's hanging point based on information related to anti-swaying, and an operation control unit that controls the operation of the crane based on the selected template.

[0007] In the crane anti-sway control system, a selection unit selects a template to be applied from a plurality of templates of acceleration / deceleration patterns of the crane's hanging point based on information related to anti-sway. Furthermore, an operation control unit controls the operation of the crane based on the selected template. In this way, since the selection unit can select from a plurality of templates, it is possible to select an appropriate template according to the situation of the crane. Furthermore, the selection unit can easily obtain an acceleration / deceleration pattern by using a template prepared in advance, without having to calculate the acceleration / deceleration pattern from scratch. As described above, appropriate anti-sway control can be performed according to the situation of the crane.

[0008] The selection unit may calculate parameters of the acceleration / deceleration pattern in the selected template. In this case, the selection unit can set more appropriate parameters for the selected template depending on the situation of the crane.

[0009] The multiple templates may include an inching template that performs one of acceleration and deceleration and then immediately performs the other. Such an inching template can perform sway prevention while suppressing the movement distance of the suspension point. The selection unit can respond to the situation of the crane by selecting such an inching template.

[0010] The crane anti-sway control system may further include a learning unit that performs reinforcement learning based on the control content of the crane based on the selected template and the execution result of the control content. In this case, the selection unit can select a more appropriate template according to the situation of the crane by using the learning result of the learning unit.

[0011] The crane is a crane that performs a swing operation and a retraction operation while suspending an object, and the operation control unit may perform anti-sway control for the swing operation and the retraction operation. In this case, the crane anti-sway control system can appropriately suppress swings that occur due to the swing operation and the retraction operation according to the condition of the crane.

[0012] When the length of the hanging member changes, the selection unit may correct the acceleration and the acceleration / deceleration switching timing in the acceleration / deceleration pattern of the template based on the change in the length of the hanging member. In this case, even in a situation where the length of the hanging member changes and the premise of the simple pendulum model does not hold, the selection unit can perform appropriate anti-sway control by correcting the template to an appropriate shape according to the change in the length of the hanging member. Effect of the Invention

[0013] According to the present invention, there is provided a crane anti-sway control system that can perform appropriate anti-sway control depending on the state of the crane. [Brief description of the drawings]

[0014] [Figure 1] FIG. 1 is a diagram showing a crane anti-sway control system 100 according to an embodiment of the present invention, and a crane 1 that is an object to be controlled. [Diagram 2] FIG. 1 is a block diagram of a crane anti-sway control system 100. [Diagram 3] FIG. 13 is a diagram for explaining a physical model of a simple pendulum, which is a basic principle of the template. [Figure 4] FIG. 13 is a diagram for explaining a template of a trapezoidal acceleration / deceleration pattern. [Diagram 5] FIG. 13 is a diagram for explaining a one-stage inching template. [Figure 6] FIG. 13 is a diagram for explaining a reciprocating inching template. [Figure 7] FIG. 13 is a diagram for explaining a two-stage acceleration / deceleration template. [Figure 8] FIG. 13 is a diagram for explaining a three-stage acceleration / deceleration template. [Figure 9] FIG. 13 is a diagram for explaining a three-stage acceleration / deceleration template. [Figure 10] 4 is a flowchart showing the processing contents of the crane anti-sway control system 100. [Figure 11] FIG. 13 is a phase plane diagram showing a pattern for damping shake. [Figure 12] FIG. 1 is a diagram for explaining a jib crane to which a crane anti-sway control system is applied. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0015] Hereinafter, an embodiment of the present invention will be described with reference to the drawings. FIG. 1 is a diagram showing a crane sway prevention control system 100 according to an embodiment of the present invention, and a crane 1 to be controlled. Here, an overhead crane is exemplified as the crane 1. As shown in FIG. 1, the crane 1 is a device that holds a suspended load SL (object) with a suspending part 6 and suspends it with a suspending member 23, and moves the suspending part 6 and the suspending member 23 together with the suspended load SL. Note that the crane 1 is not limited to an overhead crane, and may be a hoist crane, a gantry crane, a bridge crane, a jib crane, or the like. The suspended load SL is also not particularly limited, and various items such as a coil, a slab, a bundled steel bar, and an iron plate may be adopted.

[0016] As shown in FIG. 1 , a crane 1 includes a rail 2, a girder 3, a trolley 4, a suspension part 6, a traveling device 7, a traverse device 8, and a hoisting device 9.

[0017] The rail 2 is a member that guides the movement of the hanging part 6 in the traveling direction D1 via the girder 3 and the trolley 4. The rail 2 is a pair of guide members that are spaced apart from each other in the lateral direction D2 and extend parallel to the traveling direction D1. The rail 2 is fixed to the ceiling of the building in which the crane 1 is installed. The girder 3 is a pair of members that guide the movement of the hanging part 6 in the lateral direction D2 via the trolley 4. The girder 3 is a pair of guide members that are spaced apart from each other in the traveling direction D1 and extend parallel to the lateral direction D2 so as to be spanned across the pair of rails 2. The girder 3 can travel in the traveling direction D1 along the rail 2 by the traveling device 7 described later. The trolley 4 suspends the hanging part 6 while being supported by the girder 3. The trolley 4 can travel in the lateral direction D2 along the girder 3 by the lateral travel device 8 described later.

[0018] The traveling devices 7 are devices for causing the girder 3 to travel along the rails 2. The traveling devices 7 are provided at both ends of the girder 3 in the lateral direction D2. Each traveling device 7 has wheels 21. The traverse device 8 is a device for causing the trolley 4 to travel lateral along the girder 3. The traverse device 8 has wheels 22 provided on the trolley 4.

[0019] The suspending part 6 holds the load SL by suspending it. The suspending part 6 is suspended from the trolley 4 by a suspending member 23. The suspending part 6 is connected to a hoisting device 9 provided on the trolley 4 via the suspending member 23. Therefore, the hoisting device 9 can lift the suspending part 6 by winding up the suspending member 23. Note that in the hoisting device 9, the point that serves as the base point for the amplitude of the suspending member 23 is sometimes referred to as the "suspension point SP."

[0020] The crane sway prevention control device 10 is a device that comprehensively controls the entire crane 1. The crane sway prevention control device 10 controls the crane 1 to prevent the sway of the hanging member 23. The crane sway prevention control device 10 is equipped with a processor, a memory, a storage, a communication interface, and a user interface, and is configured as a general computer. The processor is a computing device such as a CPU (Central Processing Unit). The memory is a storage medium such as a ROM (Read Only Memory) or a RAM (Random Access Memory). The storage is a storage medium such as a HDD (Hard Disk Drive). The communication interface is a communication device that realizes data communication. The user interface is an output device such as a liquid crystal display or a speaker, and an input device such as a steering lever, a button, a keyboard, a touch panel, or a microphone. The processor controls the memory, storage, communication interface, and user interface, and realizes the functions described below. In the crane sway prevention control device 10, for example, a program stored in the ROM is loaded into the RAM, and the program loaded into the RAM is executed by the CPU to realize various functions. The crane anti-sway control device 10 may be composed of multiple computers.

[0021] Next, a detailed structure of the crane anti-sway control system 100 will be described with reference to Fig. 2. As shown in Fig. 2, the crane anti-sway control system 100 includes a crane anti-sway control device 10, a detection unit 41, and a drive unit 42. The crane anti-sway control device 10 is electrically connected to the detection unit 41, and receives detection information detected by the detection unit 41. The crane anti-sway control device 10 is also electrically connected to the drive unit 42, and outputs an operation command signal to the drive unit 42.

[0022] The detector 41 is provided at each position of the crane 1, and is a device for detecting various information necessary for anti-sway control. The detector 41 includes, for example, a sway detection sensor for detecting the sway of the hanging member 23 and the hanging part 6. Such a detection sensor may, for example, detect the sway angle from an image of a target provided on the hanging part 6 by an imaging unit provided on the trolley 4. Alternatively, the detector 41 may detect information necessary for anti-sway control by measuring the acceleration of the hanging part 6 by an accelerometer provided on the hanging part 6, or by measuring the torque by a measuring instrument that measures the torque of a motor that drives the traveling and traversing. The detector 41 includes, for example, a sensor provided on the trolley 4 for detecting the speed and acceleration of the hanging point SP. The driving unit 42 is a device for generating the driving force of the crane 1, and is composed of the driving mechanisms of the traveling device 7, the traversing device 8, and the hoisting device 9.

[0023] The crane anti-sway control device 10 prepares a plurality of acceleration and deceleration patterns of the hanging point SP of the crane 1 as templates. Then, the crane anti-sway control device 10 selects an appropriate one based on the sway amplitude and the movement distance of the hanging point SP before the start of the sway control. The crane anti-sway control device 10 also calculates the parameters of the acceleration and deceleration pattern of the selected template based on the sway amplitude and sway period of the hanging member 23 and the movement distance of the hanging point SP. The crane anti-sway control device 10 calculates the timing of the sway phase at which the output pattern is output, and outputs the output pattern at the timing related to the calculation result. Here, the crane anti-sway control device 10 calculates the parameters of the acceleration and deceleration pattern so that the sway amplitude is smaller than at the start after the movement of the hanging point SP is completed. The calculation of such parameters is performed in consideration of a phase plane in which the sway angle and the sway angular velocity are taken as orthogonal axes in a physical model of a simple pendulum. Then, the crane anti-sway control device 10 repeatedly performs anti-sway control using an output pattern based on the template as described above until the sway amplitude falls within the range of the target value and the hanging point SP falls within the range of the target position.

[0024] Specifically, the crane anti-sway control device 10 includes a condition confirmation unit 11, a selection unit 12, an operation control unit 13, a learning unit 14, and a memory unit 16.

[0025] The condition confirmation unit 11 acquires the swing amplitude and swing period of the hanging part 6 and the movement distance to the target position of the hanging point SP based on the detection information received from the detection unit 41. The condition confirmation unit 11 also judges the condition of whether the swing amplitude is within the range of the target value, and judges the condition of whether the hanging point SP is within the range of the target position. The condition confirmation unit 11 checks these conditions at the timing before and after anti-sway control is performed.

[0026] The selection unit 12 selects a template to be applied from a plurality of templates of the acceleration / deceleration pattern of the hanging point SP of the crane 1 based on information on sway prevention. The selection unit 12 may select one template or a plurality of templates according to the state of the crane 1. When the selection unit 12 selects a plurality of templates, it also adjusts the order of the templates. The selection unit 12 also calculates parameters of the acceleration / deceleration pattern in the selected template. The selection unit 12 creates a final output pattern used for control by the operation control unit 13 by calculating the parameters of the acceleration / deceleration pattern in this way. A specific example of the acceleration / deceleration pattern template will be described later. The selection unit 12 uses information on the sway prevention, such as the sway amplitude and sway period of the hanging part 6 acquired by the condition confirmation unit 11, and information on the movement distance to the target position of the hanging point SP. The selection unit 12 also calculates the timing of the sway phase for outputting the created output pattern. A specific example of the template will be described later.

[0027] The movement control unit 13 controls the movement of the crane 1 based on the template selected by the selection unit 12. The movement control unit 13 controls the movement of the crane 1 using an output pattern created by the selection unit 12 based on the template. The movement control unit 13 acquires the timing of the swing phase at which the output pattern is output (sometimes referred to as output timing) from the selection unit 12. The movement control unit 13 estimates the swing phase of the hanging part 6 based on the detection information of the detection unit 41. Then, the movement control unit 13 outputs the output pattern to the drive unit 42 at a timing when the estimated swing phase matches the swing phase of the output timing.

[0028] The learning unit 14 performs reinforcement learning based on the control content of the crane 1 based on the selected template and the execution result of the control content. The learning unit 14 performs reinforcement learning, for example, with the state condition set to "the distance to the target position of the hanging point SP in the initial state, the swing amplitude and swing period of the hanging part 6", the action condition set to "template selection", and the reward condition set to "the time required for pattern output". The time required for pattern output is the time required from the start of the anti-sway control until the swing amplitude enters the range of the target value and the hanging point SP enters the range of the target position. It is the time required from the start to the end of the flowchart in FIG. 10 described later. The above-mentioned selection unit 12 may select a template and create an output pattern using the learning result of the learning unit 14.

[0029] The storage unit 17 stores various information necessary for the operation of the crane anti-sway control device 10. The storage unit 17 stores a plurality of templates selected by the selection unit 12.

[0030] Next, the templates selected by the selection unit 12 will be described with reference to FIGS.

[0031] First, referring to Fig. 3, the physical model of a simple pendulum, which is the basic principle of the template, will be described. Fig. 3(a) is a diagram showing a crane 1 as a physical model of a simple pendulum. Here, the X-axis direction indicates the horizontal direction, that is, either the traveling direction D1 or the lateral direction D2. The Y-axis direction indicates the up and down direction. The origin of the "suspended load coordinates" is the center of gravity of the suspended load SL. The equation of motion of a simple pendulum when the suspension point SP is capable of horizontal movement is given by equation (1) for the x-axis direction and equation (2) for the y-axis direction. Note that "time: t" and "gravitational acceleration: g" are used.

number

[0032] By expanding the above equations (1) and (2) and approximating cosθ to 1 and sinθ to 0 assuming that the swing angle θ is sufficiently small, the equation can be expanded as in equation (3). Furthermore, if it is assumed that the length of the hanging member 23 does not change, the second term on the left side of equation (3) becomes 0, and by integrating both sides as "ω = √(g / l)", equation (4) holds. Here, "C" is an integral constant, and when the length l of the hanging member 23 and the acceleration α are constant, the right side can be expressed as the constant r 2 This equation (5) can be expressed as follows: In the phase plane shown in FIG. 3(b), the suspended load SL is (-α / ω 2 3(b) depicts a circular locus centered at point (θ,0). The horizontal axis of the phase plane is the swing angle θ, and the vertical axis is the swing angular velocity divided by the swing angular frequency ω. Furthermore, since the differential of the rotation angle φ shown in FIG. 3(b) is calculated to be "-ω", this locus rotates clockwise with the angular frequency ω. The template selected by the selection unit 12 is set based on the phase plane shown in FIG. 3(b).

number

[0033] When stopping the swing in the traveling direction D1, the selection unit 12 applies the template to the acceleration / deceleration of the movement of the hanging point SP in the traveling direction D1. When stopping the swing in the lateral direction D2, the selection unit 12 applies the template to the acceleration / deceleration of the movement of the hanging point SP in the lateral direction D2. When stopping the swing that has components in both the traveling direction D1 and the lateral direction D2, the selection unit 12 applies both the template to the acceleration / deceleration of the movement of the hanging point SP in the traveling direction D1 and the template to the acceleration / deceleration of the movement of the hanging point SP in the lateral direction D2.

[0034] Next, referring to FIG. 4, a template of an acceleration / deceleration pattern with a trapezoidal speed output will be described as a simple example. The trapezoidal speed output shown in FIG. 4(b) is equivalent to an ON / OFF acceleration / deceleration pattern as shown in FIG. 4(c), and sets an acceleration time t1 (times tp1 to tp2) with acceleration turned ON, a constant speed time t2 (times tp2 to tp3) with acceleration / deceleration turned OFF, and a deceleration time t3 (times tp3 to tp4) with deceleration turned ON. If there is no initial deflection, when such an acceleration / deceleration pattern is shown on a phase plane, the phase of the acceleration time t1 starts (time tp1) from the origin (a state in which the deflection angle amplitude is 0) as shown in FIG. 4(a). The phase at this time is the acceleration α, so (-α / ω 2 The rotation angle θ at acceleration time t1 is the acceleration time (V / α) multiplied by ω, since the angular frequency of rotation is ω as explained above. When switching from acceleration time t1 to constant speed time t2 (time tp2), the acceleration becomes 0. Therefore, the phase switches to a trajectory that draws a circle centered at the origin. Next, when switching from constant speed time t2 to deceleration time t3 (time tp3), the phase becomes (α / ω 2 The phase of the deceleration time t3 returns to the origin when the speed becomes 0 and deceleration ends (time tp4). When stopped, the acceleration is 0 so the phase coincides with the center of rotation. Therefore, the stopped state of the oscillation is maintained. Note that during acceleration time t1, the sign of the acceleration and the sign of the oscillation angle are reversed, which means that the oscillation is occurring in the opposite direction to the acceleration direction.

[0035] When the selection unit 12 calculates the parameters of the acceleration / deceleration pattern in the template shown in FIG. 4(b), it calculates the swing period T and the swing angular frequency ω based on the detection information of the detection unit 41. Furthermore, the selection unit 12 sets the constant speed moving speed V of the hanging point and the acceleration α within the range of constraints due to the specifications of the crane 1. The selection unit 12 sets the lengths of the acceleration time t1, the constant speed time t2, and the deceleration time t2. At this time, the selection unit 12 sets the parameters so that a phase trajectory as shown in FIG. 4(a) is drawn. By setting the parameters in this way, a trapezoidal output pattern is created. The operation control unit 13 outputs the output pattern to the drive unit 42 at any timing when there is no initial swing. Unless otherwise specified, the parameter setting by the selection unit 12 and the output timing of the operation control unit 13 are calculated in the same manner as described above.

[0036] In this embodiment, as described above, multiple templates of the basic ON / OFF patterns of acceleration and deceleration are prepared by a drawing method. This is because the points to be emphasized in anti-sway differ depending on the operating conditions, and it is necessary to prepare a pattern that matches those points. For example, in the example shown in FIG. 4(b), the area of ​​the trapezoid that represents the movement distance of the hanging point SP is "TV", but on the premise that the swing period is fixed (there is no change in the length of the hanging member 23) as explained above, if the movement distance is short, the value of the movement speed V becomes small and the movement time becomes long. In addition, if the initial swing is not 0, there is a possibility that the swing will not stop. Therefore, it is preferable to prepare multiple types of templates to be able to respond to various situations.

[0037] Next, the "one-stage inching template" will be described with reference to Fig. 5. This one-stage inching template is a template that determines a start phase, accelerates, and then immediately thereafter decelerates, thereby attempting to stop shake with a single acceleration / deceleration. As shown in Figs. 5(b) and (c), an acceleration time t1 (times tp1 to tp2) with acceleration turned ON, and a deceleration time t2 (times tp2 to tp3) with deceleration turned ON are set. This template is used when it is assumed that there is an initial shake and shake prevention is prioritized over positioning.

[0038] In this acceleration / deceleration pattern, the acceleration time, deceleration time, and phase at which acceleration starts are calculated so that the phase at which deceleration is completed is at the origin on the phase plane. When this type of acceleration / deceleration pattern is shown on a phase plane, as shown in FIG. 5(a), acceleration starts from a state of starting phase φs (time point tp1). The starting phase is set to a position indicated by the rotation angle φs with the positive side of the vertical axis as the reference. Since the phase at this time is the acceleration α, it is expressed as (-α / ω 2 When the rotation angle reaches φ1 and the acceleration time t1 switches to deceleration time t2 (time tp2), the acceleration is -α. Therefore, the phase of the deceleration time t2 is (α / ω 2 The phase of the deceleration time t2 returns to the origin when the speed becomes 0 at the rotation angle φ2, and the deceleration ends and the motor stops (time tp3).

[0039] In the one-stage inching template, the selection unit 12 sets the start phase φs, the acceleration time t1, and the deceleration time t2. The operation control unit 13 outputs an output pattern to the drive unit 42 at a timing when the phase becomes the start phase at the time tp1 shown in FIG.

[0040] Next, the "reciprocating inching template" will be described with reference to FIG. 6. This reciprocating inching template is a template in which the first inching is performed by accelerating and then immediately decelerating, and the second inching is performed by decelerating after a predetermined period of acceleration / deceleration OFF and then accelerating immediately thereafter. In the reciprocating inching template, the time and direction of the two inchings are set according to the moving distance. By making the direction of the second inching the opposite direction to the first inching, it is possible to perform anti-sway control without moving the position. This template is used during anti-sway movement during small movements, including cases where there is no movement.

[0041] As shown in Figures 6(b) and (c), acceleration time t1 (time points tp1 to tp2) with acceleration turned ON, deceleration time t2 (time points tp2 to tp3) with deceleration turned ON, stop time t3 (time points tp3 to tp4) with acceleration and deceleration turned OFF, deceleration time t4 (time points tp4 to tp5) with deceleration turned ON, and acceleration time t5 (time points tp5 to tp6) with acceleration turned ON are set.

[0042] When such an acceleration / deceleration pattern is shown on a phase plane, as shown in FIG. 6(a), the phase of the acceleration time t1 starts from the origin (time tp1) if there is no initial vibration. The phase at this time is the acceleration α, so (-α / ω 2 When the rotation angle reaches φ1 and the acceleration time t1 switches to deceleration time t2 (time tp2), the acceleration is -α. Therefore, the phase of the deceleration time t2 is (α / ω 2 The phase of deceleration time t2 describes a circular trajectory centered on the origin. When the rotation angle is φ3 and the stop time t3 switches to deceleration time t4 (time tp4), the acceleration becomes -α. Therefore, the phase of acceleration time t4 is (α / ω 2 The rotation angle is φ4 and the deceleration time t4 switches to the acceleration time t5 (time tp5), and the acceleration is α. Therefore, the phase of the acceleration time t5 is (-α / ω2 When the rotation angle reaches φ5, the deceleration ends and the motor stops, returning to the origin (time tp6).

[0043] In the reciprocating inching template, the selection unit 12 sets the lengths of acceleration times t1 and t5, deceleration times t2 and t4, and stop time t3. When there is an initial shake, the selection unit 12 calculates and sets the start phase and the length of stop time t3 so that the residual shake amplitude at the completion of the second deceleration (time point tp6) is small. The operation control unit 13 outputs an output pattern to the drive unit 42 at the timing when the phase set by the selection unit 12 is achieved.

[0044] Next, the "two-stage acceleration / deceleration template" will be described with reference to Fig. 7. This two-stage acceleration / deceleration template is a template that performs two-stage acceleration with a constant speed movement at "V / 2" in between, moves at the constant speed, and then performs two-stage deceleration with a constant speed movement at "V / 2" in between. The two-stage acceleration / deceleration template is used when performing long-distance movement at maximum speed.

[0045] As shown in Figures 7(b) and (c), acceleration time t1 (time points tp1 to tp2) with acceleration turned ON, constant speed time t2 (time points tp2 to tp3) with acceleration and deceleration turned OFF, acceleration time t3 (time points tp3 to tp4) with acceleration turned ON, constant speed time t4 (time points tp4 to tp5) with acceleration and deceleration turned OFF, deceleration time t5 (time points tp5 to tp6) with deceleration turned ON, constant speed time t6 (time points tp6 to tp7) with acceleration and deceleration turned OFF, and deceleration time t7 (time points tp7 to tp8) are set.

[0046] When such an acceleration / deceleration pattern is shown on a phase plane, as shown in FIG. 7(a), in the absence of an initial shake, the phase of the acceleration time t1 starts from the origin (time tp1). Since the phase at this time is the acceleration α, (-α / ω 2The phase of the constant speed time t2 describes a circular locus centered on the origin. When the rotation angle becomes φ2 and the constant speed time t2 switches to acceleration time t3 (time tp3), the acceleration becomes α. Therefore, the phase of the acceleration time t3 is (-α / ω 2 The rotation angle is φ3 and the acceleration time t3 is switched to the constant speed time t4 (time tp4), the acceleration becomes 0. At this time, the phase returns to the origin. Therefore, during the constant speed time t4, the phase is maintained at the origin. When the constant speed time t4 is switched to the deceleration time t5 (time tp5), the deceleration becomes -α. Therefore, the phase during the deceleration time t5 is (α / ω 2 The phase of the deceleration time t7 is (α / ω 2 When the rotation angle reaches φ7, the acceleration ends and the robot stops, returning to the origin (time tp8).

[0047] In the two-stage acceleration / deceleration template, the selection unit 12 sets the lengths of the acceleration times t1 and t3, the deceleration times t5 and t7, and the constant velocity times t2, t4, and t6. When there is an initial shake, the selection unit 12 adjusts and sets the start phase and the lengths of the constant velocity times t2 and t4 so that the residual shake amplitude at the completion of the second deceleration (time tp8) is small. The operation control unit 13 outputs an output pattern to the drive unit 42 at a timing that matches the phase set by the selection unit 12.

[0048] Next, the "three-stage acceleration / deceleration template" will be described with reference to Fig. 8 and Fig. 9. This three-stage acceleration / deceleration template is an acceleration / deceleration pattern template in which a trapezoidal speed pattern is output three times. The three-stage acceleration / deceleration template is used for medium to short distance movements in which the maximum speed cannot be reached.

[0049] 9(a) and (b), an acceleration time tа1 (times tp1 to tp2) with acceleration turned ON, a constant speed time tc1 (times tp2 to tp3) with acceleration and deceleration turned OFF, and a deceleration time td1 (times tp3 to tp4) with deceleration turned ON are set. In addition, after a constant speed time tc2 (times tp4 to tp5) with acceleration and deceleration turned OFF, an acceleration time tа2 (times tp5 to tp6) with acceleration turned ON, a constant speed time tc0 (times tp6 to tp7) with acceleration and deceleration turned OFF, and a deceleration time td2 (times tp7 to tp8) with deceleration turned ON are set. In addition, after the constant speed time tc3 (times tp8 to tp9) with acceleration / deceleration OFF, an acceleration time tа3 (times tp9 to tp10) with acceleration ON, a constant speed time tc4 (times tp10 to tp11) with acceleration / deceleration OFF, and a deceleration time td3 (times tp11 to tp12) with deceleration ON are set. Note that, if there is no initial swing, the length of the time from times tp1 to tp3, the length of the time from times tp3 to tp5, the length of the time from times tp8 to tp10, and the length of the time from times tp10 to tp12 are "T / 6" with respect to the natural period T of the pendulum. The length of the time from times tp5 to tp8 is set to an arbitrary length.

[0050] When such an acceleration / deceleration pattern is shown on a phase plane, as shown in FIG. 8(a), in the absence of an initial shake, the phase of the acceleration time t1 starts from the origin (time tp1). Since the phase at this time is the acceleration α, (-α / ω 2 When the rotation angle reaches φa1 and the acceleration time ta1 switches to the constant speed time tc1 (time tp2), the acceleration becomes 0. Therefore, the phase switches to a trajectory that draws a circle centered on the origin. Next, when the constant speed time tc1 switches to the deceleration time td1 (time tp3), the phase becomes (α / ω 2 The phase traces a circular locus centered at the origin (time point tp4). When the rotation angle becomes φd1 and the deceleration time td1 switches to constant speed time tc2 (time point tp4), the acceleration becomes 0. Therefore, the phase switches to a locus that traces a circle centered at the origin. When the rotation angle becomes φc2 and the constant speed time tc2 switches to acceleration time ta2 (time point tp5), the acceleration becomes α. Therefore, the phase is (-α / ω 2The trajectory then switches to a circular trajectory centered at point a2 (point tp6). When the rotation angle reaches φa2 and the acceleration time ta2 switches to constant speed time tc0 (point tp6), the acceleration becomes 0. At this time, the phase also returns to the origin. Therefore, during the constant speed time tc0, the phase is maintained at the origin.

[0051] Next, as shown in FIG. 8(b), when the constant speed time tc0 switches to the deceleration time td2 (time tp7), the phase is (α / ω 2 The rotation angle becomes φd2 and the deceleration time td2 switches to constant speed time tc3 (time tp8), and the acceleration becomes 0. Therefore, the phase switches to a trajectory that describes a circle centered on the origin. When the rotation angle becomes φc3 and the constant speed time tc3 switches to acceleration time ta3 (time tp9), the acceleration becomes α. Therefore, the phase becomes (-α / ω 2 When the rotation angle reaches φa3 and the acceleration time ta3 switches to the constant speed time tc4 (time tp10), the acceleration becomes 0. Therefore, the phase switches to a trajectory that describes a circle centered on the origin. Next, when the constant speed time tc4 switches to the deceleration time td3 (time tp11), the phase becomes (α / ω 2 When the rotation angle reaches φd3, the acceleration ends and the robot stops, returning to the origin (time tp12).

[0052] In the three-stage acceleration / deceleration template, the selection unit 12 sets the lengths of the acceleration times ta1, ta2, and ta3, the deceleration times td1, td2, and td3, and the constant velocity times tc1, tc2, tc0, tc3, and tc4. When there is an initial shake, the selection unit 12 adjusts and sets the start phase and the lengths of the constant velocity times tc1 and tc2 so that the residual shake amplitude at the completion of the third deceleration (time point tp12) is small. The operation control unit 13 outputs the output pattern to the drive unit 42 at the timing when the phase set by the selection unit 12 is reached.

[0053] Next, the processing contents of the crane anti-sway control system 100 will be described with reference to Fig. 10. First, the condition confirmation unit 11 confirms the sway amplitude and sway period of the hanging part 6 and the movement distance to the target position of the hanging point SP based on the detection information received from the detection unit 41 (step S110). Next, the condition confirmation unit 11 judges whether or not the completion condition is satisfied (step S120). Here, the condition confirmation unit 11 judges the condition of whether or not the sway amplitude is within the range of the target value, and judges the condition of whether or not the hanging point SP is within the range of the target position. If it is judged in step S120 that the completion condition is satisfied, the processing shown in Fig. 10 ends.

[0054] On the other hand, if it is determined in step S120 that the completion condition is not satisfied, the selection unit 12 selects a template to be applied from the plurality of templates, and creates an output pattern (step S130). Specifically, the selection unit 12 selects a template to be applied from the plurality of templates of the acceleration / deceleration pattern of the hanging point SP of the crane 1, based on the information acquired in step S110. In addition, the selection unit 12 calculates the parameters of the acceleration / deceleration pattern in the selected template and the start phase for outputting the pattern, and creates a final output pattern.

[0055] Next, the operation control unit 13 controls the operation of the crane 1 by outputting the output pattern created in step S130 (step S140). At this time, the operation control unit 13 estimates the swing phase of the hanging part 6 based on the detection information of the detection unit 41. Then, the operation control unit 13 outputs the output pattern to the drive unit 42 at a timing when the estimated swing phase matches the swing phase of the output timing.

[0056] In addition, when the selection unit 12 selects multiple templates in step S130, it may create an output pattern only for the template of the first loop, and wait to create an output pattern for the template of the second or subsequent loops. In this case, after the operation control unit 13 outputs the output pattern of the first loop in step S140, the selection unit 12 creates an output pattern for the template of the second loop, taking into consideration the situation at that timing. In this way, for the second or subsequent loops, the selection unit 12 may calculate parameters after reflecting the results of the output pattern from the previous loop.

[0057] When step S140 is completed, the process is repeated from step S110. This allows the condition checking unit 11 to check whether the completion condition is met by the processes of steps S130 and S140. If the completion condition is not met, the processes of steps S130 and S140 are repeated.

[0058] A specific example of the anti-sway process will be described. Here, an example of a long distance movement with a large initial shake will be described. First, the selection unit 12 selects the "one-stage inching template (FIG. 5)" for the first loop, and selects the "two-stage acceleration / deceleration template (FIG. 7)" for the second loop. The "one-stage inching template" for the first loop is selected for the purpose of suppressing the initial shake because the initial shake is large. The "two-stage acceleration / deceleration template" for the second loop is selected for the purpose of dealing with a long moving distance because the initial shake is small and the moving distance is long by performing the first loop. The selection unit 12 creates an output pattern for each template according to the specifications of the crane. The operation control unit 13 outputs an output pattern based on the "one-stage inching template" at the timing when the calculated start phase is reached. Next, the operation control unit 13 outputs an output pattern based on the "two-stage acceleration / deceleration template" at the timing when the phase is the start phase set by the selection unit 12. If there is shaking during constant speed movement, the selection unit 12 adjusts the timing of the start of acceleration at time tp3 and the start of deceleration at time tp5.

[0059] If the completion condition is met in the second loop described above, the anti-sway process ends. On the other hand, when the travel distance remains deviated from the calculated value due to the timing adjustment of the second loop, the selection unit 12 selects the "single-stage inching template (Fig. 5)" or the "two-stage inching template (Fig. 6)" according to the amplitude of the residual sway, and creates an output pattern according to the specifications of the crane. The operation control unit 13 outputs the output pattern when the calculated start phase is reached. In the case of the "two-stage inching template," the selection unit 12 adjusts the start time of the second inching (time tp4 in Fig. 6) when stopping the sway. Thereafter, inching is repeated until the completion condition is met.

[0060] Depending on the control characteristics of the drive unit 42, the change in speed over time may not be linear when the acceleration / deceleration command is set to ON. In such a case, the selector 12 calculates the pattern as a constant acceleration that approximates a straight line. Also, if the evaluation of the vibration amplitude is always set to 0 in the above-mentioned anti-sway control, it becomes equivalent to the conventional technology that does not detect vibration.

[0061] Also, when the vibration amplitude is too large or the calculated acceleration / deceleration time cannot be secured due to limitations in the moving distance, a pattern according to the amplitude according to the available acceleration / deceleration time can be created and output with that phase, which can attenuate the vibration even if it cannot stop the vibration. For example, in FIG. 11, the same acceleration / deceleration as in the phase plane shown in FIG. 5(a) is performed, but the phase does not return to the origin at time tp3. However, the distance R1 from the origin of the phase at time tp3 is smaller than the distance R0 from the origin of the initial phase, and the vibration is attenuated. Therefore, it is sufficient to repeat such control to attenuate the vibration.

[0062] Next, the operation and effect of the crane anti-sway control system 100 according to the embodiment of the present invention will be described.

[0063] In the crane anti-sway control system 100, the selection unit 12 selects a template to be applied from a plurality of templates of acceleration / deceleration patterns of the hanging point SP of the crane 1 based on information related to anti-sway. Furthermore, the operation control unit 13 controls the operation of the crane 1 based on the selected template. In this way, since the selection unit 12 can select from a plurality of templates, it is possible to select an appropriate template according to the situation of the crane 1. Furthermore, the selection unit 12 can easily obtain an acceleration / deceleration pattern by using a template prepared in advance, without having to calculate the acceleration / deceleration pattern from scratch. As described above, appropriate anti-sway control can be performed according to the situation of the crane 1.

[0064] The selection unit 12 may calculate parameters of the acceleration / deceleration pattern in the selected template. In this case, the selection unit 12 can set more appropriate parameters for the selected template depending on the situation of the crane.

[0065] The multiple templates may include an inching template that performs one of acceleration and deceleration and then immediately performs the other. Such an inching template can perform sway prevention while suppressing the movement distance of the suspension point SP. The selection unit 12 can respond to the situation of the crane 1 by selecting such an inching template.

[0066] The crane anti-sway control system 100 may further include a learning unit 14 that performs reinforcement learning based on the control content of the crane 1 based on the selected template and the execution result of the control content. In this case, the selection unit 12 can select a more appropriate template according to the situation of the crane 1 by using the learning result of the learning unit 14.

[0067] Each of the above-mentioned multiple templates for vibration prevention has its own characteristics, and it is difficult to find a mathematical solution for which template to select in which situation. Therefore, the learning unit 14 performs reinforcement learning, so that the selection unit 12 can easily and appropriately select a template.

[0068] The present invention is not limited to the above-described embodiments.

[0069] For example, as shown in FIG. 12(a), the crane anti-sway control device 10 may perform anti-sway of the suspension part 6 of a jib crane 150. The jib crane 150 includes a running body 31, a tower body 32, a rotating body 33, a jib 34, and a mast 35. The base end of the jib 34 is connected to the rotating body 33. A suspension point SP is provided at the tip of the jib 34. In the jib crane 150, the rotating body 33 rotates in a rotation direction D3 (see FIG. 12(b)) around the tower body 32. Therefore, when the jib 34 rotates, the suspension point SP also moves in the rotation direction D3 (see FIG. 12(b)). In addition, the jib 34 performs a hoisting operation with the connection part with the rotating body 33 as a base point. Therefore, the suspension point DP moves in the retracting direction D4.

[0070] The crane anti-sway controller 10 for such a jib crane 150 detects the sway angle phase and amplitude of the hanging part 6 in the rotation direction D3 and the retracting direction D4 by the detection unit 41. The crane anti-sway controller 10 also repeatedly calculates and outputs output patterns of acceleration and deceleration for two axes in the rotation direction D3 and the retracting direction D4 based on the detection information to stop the sway. The crane anti-sway controller 10 calculates and outputs output patterns independently for the rotation direction D3 and the retracting direction D4 to stop the sway. The crane anti-sway controller 10 may use a template for the output pattern similar to that used in the above-mentioned overhead crane.

[0071] Here, as shown in Fig. 12(b), the swing of the hanging point SP in the rotation direction D3 before the rotation (SG1) may become a swing in the retracting direction D4 in response to the movement of the hanging point SP in the rotation direction D3 due to the influence of the Coriolis force (SG2). Also, as shown in Fig. 12(c), the swing of the hanging point SP in the retracting direction D4 before the rotation (SG3) may become a swing in the rotation direction D3 in response to the movement of the hanging point SP in the rotation direction D3 due to the influence of the Coriolis force (SG4). In this way, the direction of each of the swing components in the rotation direction D3 and the retracting direction D4 changes in response to the change in the rotation angle, so the nonlinearity becomes stronger and the anti-sway control that assumes a straight trajectory becomes ineffective.

[0072] When the suspension point SP moves a long distance in the rotation direction D3, the influence of the Coriolis force as described above occurs. In response to this, the crane anti-sway control device 10 performs control to reduce the influence of the Coriolis force during constant-speed movement by selecting a pattern that stops sway during acceleration and stops the sway suppression operation during constant-speed movement. In other words, the crane anti-sway control device 10 stops sway in a range where the change in the rotation angle is small and controls to enter constant-speed movement, making it possible to apply an output pattern for a straight trajectory in a form that approximates a straight trajectory.

[0073] For example, in the case of an output pattern that assumes that there will be vibration during movement as shown in Fig. 4, the Coriolis force is not taken into consideration, and therefore it cannot be applied to vibration suppression control when there is an effect of the Coriolis force. In contrast, when there is an effect of the Coriolis force, the output patterns shown in Fig. 7, and Figs. 8 and 9 can be specifically applied as patterns for suppressing vibration during acceleration / deceleration.

[0074] For example, in the output pattern of FIG. 7, in the linear trajectory of the overhead crane, sway occurs during acceleration time t1 due to acceleration operation, but the sway becomes zero at time tp4 when switching to constant speed time t4, and from this point until deceleration time t5 begins, no sway occurs because the speed is constant. When deceleration time t5 begins, sway occurs again at time tp5, and when deceleration in deceleration time t7 is completed, the sway becomes zero at time tp8. If this is applied to the start of the rotation trajectory of the jib crane 150, the above-mentioned Coriolis force becomes a disturbance element, but since the change in the angle of acceleration or deceleration is only affected within a relatively small range, the residual sway due to disturbance can be reduced. In this way, when performing sway prevention control that is affected by the Coriolis force of the jib crane 150, the crane sway prevention control device 10 applies the output pattern of FIG. 7 or the output patterns of FIG. 8 and FIG. 9 to perform sway prevention.

[0075] In conventional jib crane anti-sway technology, the sway in the rotation direction is stopped only by the rotation operation. However, the conventional technology does not take into account the fact that the Coriolis force changes the sway in the rotation direction to the sway in the retracting direction (see FIG. 12), so sufficient effects cannot be expected. In contrast, the crane anti-sway control system 100 takes the Coriolis force into account and provides anti-sway on two axes in the rotation direction and the retracting direction, thereby solving the problems in the jib crane 150. In addition, in the rotation operation, it is not easy to calculate the anti-sway pattern due to the nonlinearity caused by the above-mentioned Coriolis force. Therefore, the crane anti-sway control system 100 makes it possible to approximately treat it as an anti-sway pattern for a straight track by selecting a pattern that is less susceptible to the influence of the Coriolis force from among the anti-sway patterns for a straight track.

[0076] Here, in the jib crane 150, as shown in Fig. 12(d), the length of the hanging member 23 may change (from L2 to L1) during anti-sway control. In response to this, the crane anti-sway control device 10 performs control so as not to deteriorate the anti-sway accuracy even if the change in length of the hanging member 23 during movement of the suspension point SP causes deviation from the prerequisites of the calculated output pattern.

[0077] Specifically, when the length of the hanging member 23 changes, the motion control unit 13 corrects the acceleration in the acceleration / deceleration pattern of the template and the timing of switching between acceleration and deceleration based on the change in the length of the hanging member 23. If the acceleration when the output pattern is calculated is "α0", the speed of change of the hanging member 23 is "Vl", and the swing angular velocity is "dθ / dt", the motion control unit 13 issues a command to adjust the acceleration when the output pattern is output to "α=α0-2Vl×dθ / dt". In addition, when the output pattern is output, if the swing angular frequency when the output pattern is created is "ω0" and the scheduled time of acceleration / deceleration or constant speed is "t0", the motion control unit 13 corrects the output pattern set by the selection unit 12 so that acceleration / deceleration is switched when the time integral value from the start time "ts" of the current swing angular frequency "ω" becomes "ω0t0".

[0078] In actual operation of the jib crane 150, the length of the suspending member 23 generally changes due to the winding action of the suspending member 23 during horizontal movement. Also, as with the jib crane 150, the length of the suspending member 23 inevitably changes when moving horizontally with the suspended portion 6 at a constant height. The anti-sway control described for the overhead crane is based on the premise that the length of the suspending member 23 is constant, so if the anti-sway control of the jib crane 150 is performed in a state where this premise is not met, the anti-sway performance will deteriorate. The simplest way to suppress this is to maintain the state of the basic model in Figure 3, which is the premise.

[0079] To do this, first go back to equation (3) and set the sum of the first and second terms on the left side of equation (6) below to the original fixed acceleration, "α0." To do this, we need to change "dv / dt," i.e., the acceleration, and set this to α to get equation (7).

number

[0080] In the basic model of FIG. 3, the angular velocity of the phase rotation on the phase plane is "ω = √(l / g)". The acceleration and deceleration time is determined based on this. Since "ω" also changes with time due to the change in "l", this part also needs to be corrected. For example, in the one-stage inching template of FIG. 5, the acceleration time t1 is calculated so that "ω" is fixed (ω0) and the rotation angle is φ1 (φ1 = ω0 × t1). Here, if the length of the hanging member 23 changes, "ω" changes with time, so it is necessary to correct the output timing so that the time integral of "ω" becomes "φ1". Specifically, in order to make the phase at which acceleration and deceleration are switched ON / OFF the same, it is necessary to change the evaluation method for the time at which acceleration and deceleration are switched. Specifically, since the phase rotation amount for switching during output pattern calculation is "φ0 = ω0t0", the right-hand side part should be the time integral of ω. That is, the start time of acceleration and deceleration should be "ts", the current time should be "t", and the selection unit 12 should be corrected so that acceleration and deceleration are switched at the timing shown in formula (8).

number

[0081] As described above, the jib crane 150 is a crane that performs a rotation operation and a retraction operation while suspending a load SL, and the operation control unit 13 may perform anti-sway control for the rotation operation and the retraction operation. In this case, the crane anti-sway control system 100 can appropriately prevent the sway that occurs due to the rotation operation and the retraction operation according to the state of the jib crane 150.

[0082] When the length of the hanging member 23 changes, the selection unit 12 may correct the acceleration in the acceleration / deceleration pattern of the template and the timing of switching between acceleration and deceleration based on the change in the length of the hanging member 23. In this case, even if the length of the hanging member 23 changes and the assumptions of the simple pendulum model do not hold, the selection unit 12 can perform appropriate anti-sway control by correcting the template to an appropriate shape according to the change in the length of the hanging member 23. In other words, if the hanging member 23 is wound during movement, the anti-sway performance deteriorates due to disturbances caused by swing period changes. In the conventional technology, there are cases where an approximate correction is performed on the assumption that the change in the winding height is known in advance (such as automatic operation). In contrast, the above method allows correction in real time and can be handled even when the winding operation is manual. [Explanation of symbols]

[0083] 1...crane, 12...selection unit, 13...motion control unit, 14...learning unit, 100...crane anti-sway system, 150...jib crane.

Claims

1. A crane sway prevention control system that controls a crane that suspends an object with a suspending member and a suspending part to prevent the suspending part from swaying, A selection unit that selects a template to be applied from a plurality of templates of acceleration / deceleration patterns of the hanging point of the crane based on information about sway prevention; and an operation control unit that controls operation of the crane based on the selected template.

2. The crane anti-sway control system according to claim 1 , wherein the selection unit calculates parameters of the acceleration / deceleration pattern in the selected template.

3. The crane anti-sway control system according to claim 1 or 2, wherein the plurality of templates includes an inching template in which one of acceleration and deceleration is performed and then the other is performed immediately thereafter.

4. The crane sway prevention control system according to any one of claims 1 to 3, further comprising a learning unit that performs reinforcement learning based on the control content of the crane based on the selected template and the execution result of the control content.

5. The crane is a crane that performs a rotation operation and a pulling operation while suspending the object, The crane anti-sway control system according to any one of claims 1 to 4, wherein the operation control unit performs anti-sway control for the rotation operation and the retraction operation.

6. A crane anti-sway control system as described in any one of claims 1 to 5, wherein when the length of the hanging member changes, the selection unit corrects the acceleration and the acceleration / deceleration switching timing in the acceleration / deceleration pattern of the template based on the change in the length of the hanging member.

Citation Information

Patent Citations

  • Swing preventive control method of crane

    JP2011126689A