The present application is based on and claims priority to Japanese Priority Application No. 2017-235634 filed on Dec. 8, 2017, the entire contents of which are hereby incorporated by reference.
The present invention relates to an operation control apparatus for a crane for moving a suspended load in a vertical direction and a horizontal direction to transfer the suspended load to a target position.
When automatically operating a crane, in general, a movement trajectory of a suspended load is determined so as to avoid a collision with an obstacle, and an acceleration/deceleration pattern for moving in the horizontal direction is determined to perform the operation so as to reduce a swing of the suspended load as much as possible other than acceleration/deceleration.
Normally, as a method of operating a crane for moving a suspended load along a predetermined trajectory, before the operation of the crane is started, a hoisting height allowing movement of the suspended load in the horizontal direction and a horizontal direction position for starting lowering are determined in advance. Then, during the operation of the crane, when the suspended load reaches the hoisting height or the horizontal direction position, a movement in the horizontal direction and lowering are started respectively.
As an easiest method with respect to an acceleration/deceleration method for suppressing a swing of a suspended load, a method of accelerating/decelerating by a constant acceleration/deceleration such that the acceleration/deceleration time matches a vibration cycle of the suspended load when the length of a rope supporting the suspended load is constant is known. Also, Patent Document 1 discloses a vibration suppression method of determining, even when a rope length changes due to hoisting and lowering of a suspended load, an acceleration/deceleration pattern so as to suppress a swing of the suspended load at the completion time of acceleration/deceleration under a condition that the rope length change rate is constant.
[Patent Document 1] Japanese Patent No. 3742707
In an actual operation control of a crane, there may be a case in which a strong wind occurs during the operation, for example. In such a case, the speed is desired to be changed during the operation so as to temporarily decelerate the speed and return the speed to the original speed upon the problem being solved. However, if the speed is changed only in the horizontal direction while hoisting or lowering the suspended load and moving the suspended load in the horizontal direction, for example, there may be a case in which the suspended load cannot follow a trajectory planned in advance. In the worst case there is also a possibility of collision with an obstacle.
In this case, by changing the hoisting speed and the lowering speed changed by the rate of changing the moving speed in the horizontal direction, it is possible to reduce the deviation from the planned trajectory. However, these speeds cannot be changed instantaneously and a certain amount of time is required for changing the speeds. Therefore, even with this method, the actual trajectory of the suspended load cannot be completely matched with the planned trajectory. Furthermore, in order to suppress the swing of the suspended load caused by the speed change, even if the acceleration/deceleration pattern is determined using the rope length change rate at the time of starting the speed change, there is no guarantee that the rope length change rate is constant until the speed change is completed. As a result, it is difficult to completely suppress the swing of the suspended load.
Hence, an object of the present invention is to provide an operation control apparatus for a crane that can change the speed in a state of maintaining a movement trajectory of a suspended load planned before an operation even when a speed change is required during an operation of the crane and that can suppress a swing of the suspended load during the speed change.
In view of the above, according to a first aspect of the invention, an operation control apparatus for a crane for moving a suspended load in a vertical direction and a horizontal direction to transfer the suspended load to a target position includes: a trajectory creating unit configured to create in advance a movement trajectory of the suspended load; a function creating unit configured to create a function indicating a relationship between a horizontal direction position and a height of the suspended load in the movement trajectory; a vertical direction command value updating unit configured to generate a vertical direction position command value by sequentially updating, in accordance with the horizontal direction position of the suspended load and based on the function, the vertical position at which the suspended load should be present; a vertical direction control unit configured to generate a vertical direction speed command value of the suspended load based on the vertical direction position command value; and a vertical direction driving unit configured to move the suspended load in the vertical direction in accordance with the vertical direction speed command value.
According to a second aspect of the invention, the operation control apparatus described in the first aspect further includes: a horizontal direction command value updating unit configured to sequentially update a horizontal direction position command value of the suspended load based on a speed change amount in the horizontal direction of the suspended load; a horizontal direction control unit configured to generate a horizontal direction speed command value of the suspended load based on the horizontal direction position command value; and a horizontal direction driving unit configured to move the suspended load in the horizontal direction in accordance with the horizontal direction speed command value.
According to a third aspect of the invention, the operation control apparatus described in the second aspect further includes: an acceleration/deceleration pattern calculating unit configured to use a first height corresponding to a horizontal direction position at a start time of a speed change in the horizontal direction of the suspended load, a second height corresponding to a horizontal direction position at a completion time of the speed change in the horizontal direction of the suspended load, and a time required for the speed change in the horizontal direction of the suspended load to calculate a change rate average value of a length of a support member that supports the suspended load and configured to generate, by using the calculated change rate average value, an acceleration/deceleration pattern of a speed change period so as to suppress a swing of the suspended load due to the speed change in the horizontal direction, wherein the horizontal direction command value updating unit updates the horizontal direction position command value based on the acceleration/deceleration pattern.
According to a fourth aspect of the invention, the operation control apparatus described in the third aspect further includes: an ideal swing angle calculating unit configured to calculate an ideal swing angle of the suspended load with respect to the support member in the speed change period under a condition that the change rate average value of the length of the support member is constant in the speed change period in the horizontal direction of the suspended load; and a swing stop control unit configured to calculate a correction amount so that a deviation between the ideal swing angle and an actual swing angle approaches zero and configured to correct the horizontal direction speed command value by the correction amount to suppress the swing in the horizontal direction of the suspended load.
According to a fifth aspect of the invention, in the operation control apparatus described in the fourth aspect, the ideal swing angle calculating unit is provided in the acceleration/deceleration pattern calculating unit.
According to an embodiment of the present invention, even when a speed change in the horizontal direction is required during an operation of a crane, it is possible to prevent a collision with an obstacle by changing the speed while maintaining a planned movement trajectory of a suspended load and to minimize a swing of the suspended load.
An embodiment of the present invention will be described below with reference to the drawings. First,
According to this embodiment, before starting an operation of a crane, a trajectory that the suspended load 20 should follow is created in advance as illustrated in
During an operation of the crane, when the horizontal direction position of the suspended load 20 is in the above described range of A to B, the suspended load 20 is moved while sequentially updating, in accordance with Y=f(X), the height Y at which the suspended load 20 should be present with respect to the horizontal direction position X. For example, when a strong wind occurs during the movement of the suspended load 20 and a speed change in the horizontal direction is inevitable, the actual horizontal direction position and the vertical direction position of the suspended load 20 deviate from the trajectory of
At least at the start time and the completion time of movement in the horizontal direction, the movement speed of the suspended load 20 in the horizontal direction needs to be changed during an operation of the crane. Further, when a speed change is required due to an occurrence of an abnormal event such as a strong wind, the movement speed of the suspended load 20 in the horizontal direction needs to be changed during an operation of the crane. A specific processing procedure according to the present embodiment in a case where a speed change is required as described above will be described with reference to the flowchart illustrated in
When the speed is required to be changed, first, the current height Y1=f(X1) of the suspended load 20 at the horizontal direction position X1 of the suspended load 20 at the start time of changing the speed is obtained in step S1. Because the speed has not been changed yet at this time point, Y1 corresponding to X1 is on the trajectory illustrated in
Next, the movement distance ΔX of the suspended load 20 during the speed change is found, and the horizontal direction position X2 of the suspended load 20 at the completion time of the speed change is found to obtain the height Y2 of the suspended load 20 corresponding to the horizontal direction position X2 in step S2. That is, when a time T is spent from the start time point of the speed change such that the speed V1 of the suspended load 20 is changed by ΔV to the speed V2 (=V1+ΔV), ΔX can be found as ΔX=(V1+V2)T/2 by using the average value of the speeds (V1+V2)/2. Furthermore, for the horizontal direction position X2 at the completion time of the speed change, X2=X1+ΔX. Therefore, the height Y2 of the suspended load 20 corresponding to the position X2 can be found as Y2=f(X2)=f(X1+ΔX). That is, in this step S2, with respect to the horizontal direction position X2 reached when the horizontal direction speed of the suspended load 20 is changed, the height Y2 where the suspended load 20 should originally be located is found.
Subsequently, a change rate average value ν within the speed change time T of the length of the rope supporting the suspended load 20 is calculated in step S3. Because this change rate average value ν of the rope length is equal to the change rate average value of the height before and after the speed change time T, it can be found as ν=−(Y2−Y1)/T.
Further, when changing the speed of the suspended load 20 from V1 to V2=V1+ΔV, an acceleration that can suppress a swing of the suspended load 20 in a case where the change rate average value v of the rope length is constant is found, and the speed is changed by using an acceleration/deceleration pattern based on the found acceleration in step S4.
For example, an acceleration/deceleration pattern is considered in a case of controlling the swing angle θ [rad] of the suspended load 20 during a speed change to form the mathematical equation 1 to suppress a swing of the suspended load 20 at the completion time of the speed change (τ=1).
θ=−Aτ2(1−τ)2 [Mathematical equation 1]
(Here, A is a function of ΔV, τ is the ratio between the elapsed time t from the start of speed change and the speed change time T, and τ=t/T)
For example, as shown in the mathematical equation 10 of Patent Document 1 mentioned above, the equation of motion in a case where the length of the rope changes as in a case where the suspended load 20 is moved in the horizontal direction and the vertical direction by a crane can be represented by the following mathematical equation 2. Note that in the mathematical equation 2, friction due to air resistance to the suspended load 20 and energy loss due to bending of the rope 30 are ignored.
d2Z/dt2+(g/l)Z=−d2X/dt2 [Mathematical equation 2]
(Here, Z=lθ, l=l0+νt, g: gravitational acceleration, l0: initial rope length)
The acceleration in the horizontal direction (d2X/dt2) such that the speed changes by ΔV at t=T, that is, at τ=1 (at the completion time of speed change) is calculated, based on the left side of the above described mathematical equation 2, by the following mathematical equation 3 as indicated by the mathematical equation 14 of Patent Document 1.
d2X/dt2=(30ΔV/gT3)[l0(2−12τ+12τ2)+(νT)(6τ−24τ2+20τ3)+(gT2)τ2(1−τ)2] [Mathematical equation 3]
Note that although an actual change rate of the rope length when accelerating in the horizontal direction is not constant, by assuming the change rate average value ν of the rope length constant, a swing of the suspended load 20 due to a speed change can be reduced.
Also, the ideal swing angle θ* during a speed change when acceleration is applied to the suspended load 20 as described above is represented by the following mathematical equation 4 based on the mathematical equation 1 described above.
θ*=−(30ΔV/gT)τ2(1−τ)2 [Mathematical equation 4]
As the actual swing angle θ during the speed change is closer to the ideal swing angle θ*, a swing remaining at the completion time of the speed change can approach zero. Therefore, by applying swing stop control of correcting the speed in the horizontal direction so that the deviation Δθ=θ*−θ of the swing angle approaches zero, it is possible to move the suspended load 20 while further suppressing the swing of the suspended load 20.
Although the above description is for suppressing the swing of the suspended load 20 during a speed change based on the mathematical equations 1 and 4, other than this, for example, the speed can be changed while suppressing the swing of the suspended load 20 based on the following mathematical equation 5, for example.
θ=−A(1−cos ωt) [Mathematical equation 5]
(Here, ω=2π/T)
In this case, the acceleration (d2X/dt2) and the ideal swing angle θ* of the suspended load 20 may be given as in the following mathematical equations 6 and 7.
d2X/dt2=(ΔV/gT)[g(1−cos ωt)+2νω sin ωt+(l0+νt)ω2 cos ωt] [Mathematical equation 6]
θ*=−(ΔV/gT)(1−cos ωt) [Mathematical equation 7]
On a premise that a horizontal direction position X1 at the time of starting a speed change matches a position command value X1*, the vertical direction command value updating unit 53 uses the function Y*=f(X*) of the function creating unit 42 to find a height Y1 of the suspended load 20. Also, the vertical direction command value updating unit 53 calculates a speed V2 (=V1+ΔV) from V1 at the time of starting the speed change and from the speed change amount ΔV based on the sequentially input horizontal direction speed Vx. Then, the vertical direction command value updating unit 53 finds ΔX from ΔX=(V1+V2)T/2. Using the function Y*=f(X*), the vertical direction command value updating unit 53 finds, from the horizontal direction position X2 (=X1+ΔX) at the completion time of the speed change, a height Y2 that the suspended load 20 should reach at the completion time of the speed change.
Conversely, an acceleration/deceleration pattern calculating unit 51 calculates, for example, the right side of the mathematical equation 3 and outputs the calculated result as an acceleration command value (d2X*/dt2) in the horizontal direction. Note that the change rate average value ν of the rope length in the right side of the mathematical equation 3 can be calculated by using the vertical direction position command value Y* calculated by the vertical direction command updating unit 53. That is, ν can be calculated by using the first and second heights Y1 and Y2 from ν=−(Y2−Y1)/T, which is described above.
The horizontal direction command value updating unit 52 integrates the acceleration command value (d2X*/dt2) twice to calculate the horizontal direction position command value X*. This horizontal direction position command value X* corresponds to the horizontal direction position X2 to which the suspended load 20 reaches at the completion time of the speed change based on ΔV. Based on the horizontal direction position command value X* and a horizontal direction position detection value X (not illustrated), the horizontal direction control unit 55 generates a horizontal direction speed command value Vx* for driving the trolley 10 to move the suspended load 20 in the horizontal direction. Further, based on the vertical direction position command value Y*=f(X*) at the horizontal direction position command value X* obtained by the vertical direction command value updating unit 53, the vertical direction control unit 54 generates a vertical direction speed command value Vx* for hosting/lowering the suspended load 20 (rope 30), and controls a vertical direction driving mechanism (not illustrated) according to the generated speed command value Vx*.
Note that the acceleration/deceleration pattern calculating unit 51 calculates an ideal swing angle θ* according to, for example, the mathematical equation 4 described above. Causing a subtractor 56 to find thee deviation Δθ between the ideal swing angle θ* and a current swing angle θ, a swing stop control unit 57 performs calculation so that the deviation Δθ approaches zero to output a correction amount ΔVx. This correction amount ΔVx is added by an adder 58 to the output of the vertical direction control unit 55 to generate a final horizontal direction speed command value Vx*. Then, by controlling a horizontal direction driving mechanism (not illustrated) according to the generated speed command value Vx*, it is possible to transfer the suspended load 20 in the horizontal direction while minimizing the swing angle θ.
As described above, according to the present embodiment, in an automatic operation of a crane, when the movement speed in the horizontal direction of the suspended load 20 is changed, a predetermined acceleration/deceleration pattern is generated in accordance with the procedure of
Number | Date | Country | Kind |
---|---|---|---|
2017-235634 | Dec 2017 | JP | national |
Number | Name | Date | Kind |
---|---|---|---|
4147330 | Eik | Apr 1979 | A |
4354608 | Wudtke | Oct 1982 | A |
4547857 | Alexander | Oct 1985 | A |
8265811 | Kyllingstad | Sep 2012 | B2 |
9902596 | Morrow | Feb 2018 | B2 |
20050232626 | Schulte | Oct 2005 | A1 |
20070289931 | Henriksson | Dec 2007 | A1 |
20110066394 | Schneider | Mar 2011 | A1 |
20110076130 | Stocker | Mar 2011 | A1 |
20120092643 | Rintanen | Apr 2012 | A1 |
20120296519 | Eberharter | Nov 2012 | A1 |
20130120577 | Austefjord | May 2013 | A1 |
20130345857 | Lee | Dec 2013 | A1 |
20140107971 | Engedal | Apr 2014 | A1 |
20150112638 | Morrow | Apr 2015 | A1 |
20190078288 | Wu | Mar 2019 | A1 |
Number | Date | Country |
---|---|---|
3742707 | Feb 2006 | JP |
Number | Date | Country | |
---|---|---|---|
20190177130 A1 | Jun 2019 | US |