Automatic deviation correction control method for hoisting system
11782450 · 2023-10-10
Assignee
Inventors
Cpc classification
International classification
Abstract
The present invention provides an automatic deviation correction control method for a hoisting system, comprising the following steps: obtaining a lateral displacement X and an advancing included angle α generated by the deflection of the hoisting system; when the lateral displacement X is not 0 and the advancing included angle α is not 0, determining whether the lateral displacement X and the advancing included angle α satisfy a preset condition; if the lateral displacement X and the advancing included angle α do not satisfy the preset condition, controlling the hoisting system to correct the deviation toward a center line; and if the lateral displacement X and the advancing included angle α satisfy the preset condition, controlling the hoisting system to correct the deviation toward the center line in a reverse direction.
Claims
1. An automatic deviation correction control method for a hoisting system, characterized in that comprising the following steps: obtaining a lateral displacement X and an advancing included angle α generated by a deflection of the hoisting system, the lateral displacement X is a distance between a real-time position of the hoisting system and a center line, the advancing included angle α is an included angle between the real-time position of the hoisting system and the center line; when the lateral displacement X is 0 and the advancing included angle α is also 0, maintaining the hoisting system a straight-line travel, if the advancing included angle α is not 0, controlling the hoisting system to correct a deviation toward the center line so that the advancing included angle α tends to 0; when the lateral displacement X is not 0 and the advancing included angle α is 0, controlling the hoisting system to correct the deviation toward the center line; when the lateral displacement X is not 0 and the advancing included angle α is also not 0, determining whether the lateral displacement X and the advancing included angle α satisfy a preset condition, if the lateral displacement X and the advancing included angle α do not satisfy the preset condition, controlling the hoisting system to correct the deviation toward the center line; and if the lateral displacement X and the advancing included angle α satisfy the preset condition, controlling the hoisting system to correct the deviation toward the center line in a reverse direction; the preset condition comprising the lateral displacement X and the advancing included angle α of the hoisting system satisfies a following condition:
X≤R.sub.1(1−cos α) wherein a sensor is provided on a first side wheel of the hoisting system for detecting the lateral displacement X and the advancing included angle α, R.sub.1 is a rotation radius of the first side wheel of the hoisting system.
2. The automatic deviation correction control method for a hoisting system according to claim 1, characterized in that when the lateral displacement X is not 0 and the advancing included angle α is also not 0, if the lateral displacement X and the advancing included angle α do not satisfy the preset condition, controlling the hoisting system to correct the deviation toward the center line comprising controlling the hoisting system to correct the deviation toward the center line to a first position, the first position satisfies the following condition: the advancing included angle α is 0, and the lateral displacement X reaches a maximum value.
3. The automatic deviation correction control method for a hoisting system according to claim 2, characterized in that controlling the hoisting system to correct the deviation toward the center line to a second position, the second position satisfies the following condition:
X=R.sub.1(1−cos α) when the hoisting system travels from the first position to the second position, the absolute value of the advancing included angle α gradually increases, and the lateral displacement X gradually decreases.
4. The automatic deviation correction control method for a hoisting system according to claim 1, characterized in that if the lateral displacement X and the advancing included angle α satisfy the preset condition, controlling the hoisting system to correct the deviation toward the center line in a reverse direction comprising controlling the hoisting system to correct the deviation toward the center line to a third position, at this time, the deviation correction is completed, controlling the hoisting system maintaining a straight-line travel, and the third position satisfies the following condition: the advancing included angle α is 0, and the lateral displacement X is also 0.
5. The automatic deviation correction control method for a hoisting system according to claim 2, characterized in that when controlling the hoisting system to correct the deviation toward the center line to the first position, the lateral displacement X satisfies the following condition:
X.sub.1=X.sub.0+R.sub.1(1−cos α.sub.0) wherein, X.sub.1 is the lateral displacement of the hoisting system at the first position, X.sub.0 is the lateral displacement of the hoisting system at an initial position, R.sub.1 is the rotation radius of the first side wheel of the hoisting system, and α.sub.0 is the advancing included angle of the hoisting system at the initial position.
6. The automatic deviation correction control method for a hoisting system according to claim 3, characterized in that when controlling the hoisting system to correct the deviation toward the center line to the second position, the lateral displacement X satisfies the following condition:
X.sub.2=X.sub.1−R.sub.1(1−cos α.sub.2) and α.sub.2 satisfies the following condition:
7. The automatic deviation correction control method for a hoisting system according to claim 1, characterized in that when the lateral displacement of the hoisting system at an initial position satisfies the following conditions:
X>R.sub.1(1−cos α) the travel route of the hoisting system is an S-curve.
8. The automatic deviation correction control method for a hoisting system according to claim 1, characterized in that controlling the hoisting system to correct the deviation toward a center line comprising sending deviation rectification control commands to the hoisting system by using an industrial computer.
9. The automatic deviation correction control method for a hoisting system according to claim 1, characterized in that the hoisting system comprises a crane, which comprises a tire crane, a straddle carrier and a stacker.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
DETAILED DESCRIPTION OF THE INVENTION
(7) The present invention will be further described below in combination with the accompanying drawings and embodiments.
(8) In the following description, many specific details are set forth in order to provide a thorough understanding of the present invention. However, it will be apparent to those skilled in the art that the present invention can be practiced without these specific details. Therefore, the specific details are only exemplary, and the specific details may vary from the spirit and scope of the unrestrained and are still considered to be within the spirit and scope of the present invention.
(9) The hoisting system in this embodiment can be used for port logistics. The hoisting system includes a crane, which includes but is not limited to a tire crane, a straddle carrier and a stacker. The following takes a tire crane as an example to illustrate the working principle of the automatic deviation correction control method of the hoisting system of the present invention.
(10) Now refer to
(11) During the operation, the tire crane should have travelled along the planned parallel route, but due to the different performance of the frequency converter and the flatness of the road, the velocity of the tires on both sides is not equal, that is, V.sub.1≠V.sub.2. The tire crane will make a circular motion with O as the center. As shown in
(12) Assuming that the width of the tire crane body is H, the movement angle is α, the following formula can be obtained:
R.sub.2−R.sub.1=H
V.sub.2t=R.sub.2α
V.sub.1t=R.sub.1α
(13) From the above formula, the following formula can be obtained:
(14)
(15) Now refer to
(16)
(17) Now refer to
(18) As shown in
(19) As shown in
(20) As shown in
(21) As shown in
(22) As shown in
(23) Now refer to
X≤R.sub.1(1−cos α) wherein a sensor is provided on a first side wheel of the hoisting system for detecting the lateral displacement X and the advancing included angle α, R.sub.1 is the rotation radius of the first side wheel of the hoisting system.
(24) In a particular implementation, when the lateral displacement X is not 0 and the advancing included angle α is also not 0, if the lateral displacement X and the advancing included angle α do not satisfy the preset condition, controlling the hoisting system to correct the deviation toward the center line comprising controlling the hoisting system to correct the deviation toward the center line to a first position, the first position satisfies the following condition:
(25) the advancing included angle α is 0, and the lateral displacement X reaches a maximum value.
(26) In a particular implementation, controlling the hoisting system to correct the deviation toward the center line to a second position, the second position satisfies the following condition:
X=R.sub.1(1−cos α)
(27) when the hoisting system travels from the first position to the second position, the absolute value of the advancing included angle α gradually increases, and the lateral displacement X gradually decreases.
(28) If the lateral displacement X and the advancing included angle α satisfy the preset condition, controlling the hoisting system to correct the deviation toward the center line in a reverse direction comprising controlling the hoisting system to correct the deviation toward the center line to a third position, at this time, the deviation correction is completed, controlling the hoisting system maintaining a straight-line travel, and the third position satisfies the following condition:
(29) the advancing included angle α is 0, and the lateral displacement X is also 0.
(30) When controlling the hoisting system to correct the deviation toward the center line to the first position, the lateral displacement X satisfies the following condition:
X.sub.1=X.sub.0+R.sub.1(1−cos α.sub.0)
(31) wherein, X.sub.1 is the lateral displacement of the hoisting system at the first position, X.sub.0 is the lateral displacement of the hoisting system at an initial position, R.sub.1 is the rotation radius of the first side wheel of the hoisting system, and α.sub.0 is the advancing included angle of the hoisting system at the initial position.
(32) In a particular implementation, when controlling the hoisting system to correct the deviation toward the center line to the second position, the lateral displacement X satisfies the following condition:
X.sub.2=X.sub.1−R.sub.1(1−cos α.sub.2)
(33) and α.sub.2 satisfies the following condition:
(34)
(35) wherein, X.sub.2 is the lateral displacement of the hoisting system at the second position, X.sub.1 is the lateral displacement of the hoisting system at the first position, R.sub.1 is the rotation radius of the first side wheel of the hoisting system, R.sub.2 is the rotation radius of the second side wheel of the hoisting system, t.sub.2 is the time it takes for the hoisting system to travel from the first position to the second position, V.sub.1 is the velocity of the first side wheel of the hoisting system, V.sub.2 is the velocity of the second side wheel of the hoisting system, and α.sub.2 is the advancing included angle of the hoisting system at the second position.
(36) In a particular implementation, when controlling the hoisting system to correct the deviation toward the center line to the third position, the lateral displacement X is 0, and the advancing included angle α is also 0, then the deviation correction is completed, and controlling the hoisting system maintaining a straight-line travel.
(37) Now refer to
(38) Taking the right side wheel of the tire crane, that is, the first side wheel, as the control target, and setting the lateral displacement of the initial position of the tire crane as X.sub.0 and the advancing included angle as α.sub.0. Correcting the deviation of the deflection of the tire crane. The forward velocity of the right wheel and the left wheel of the tire crane are set as V.sub.1 and V.sub.2 respectively. The rotation radius of the first side wheel of the tire crane is set as R1, the rotation radius of the second side wheel of the tire crane is set as R2, and the body width of the tire crane is set as H. The following formula can be obtained:
(39)
(40) After time t.sub.1, the tire crane rotates θ.sub.1 with O′ as the center, and the lateral displacement is AA′, reaching the first position of point A. At point A, the tire crane is perpendicular to the X-axis, and the advancing included angle is 0. It is obvious that the values of the rotation angle θ.sub.1 and the initial advancing included angle α.sub.0 are equal. The following formula can be obtained:
(41)
(42) At this time, the advancing included angle of the tire crane is 0, and the lateral displacement reaches the maximum value. The tire crane corrects the deviation at the same velocity. After time t.sub.2, the tire crane continues to rotate θ.sub.2 with O′ as the center, and the lateral displacement is BB′, reaching the second position of point B, and the advancing included angle of the tire crane at point B is α.sub.2. It is obvious that the values of the rotation angle θ.sub.2 and the advancing included angle α.sub.2 are equal. The following formula can be obtained:
(43)
(44) If it is needed to correct the deviation in a reverse direction at point B, that is, taking O″ as the center and R.sub.1 as the radius, when the advancing included angle is 0 and the lateral displacement is also 0, the tire crane rotates θ.sub.3 with O″ as the center, reaching the third position of point C. It is obvious that the values of the rotation angle θ.sub.3 and the advancing included angle α.sub.2 are equal. The time of the process is t.sub.3 and the lateral displacement is BB′. The following formula can be obtained:
(45)
(46) In the deviation correction process of the tire crane, at t.sub.2 stage, when the following condition is met:
BB′=R.sub.1(1−cos α.sub.2)
(47) It is the time to correct the deviation in a reverse direction. The following formula can be obtained:
(48)
(49) Finally, the purpose of correcting the lateral displacement and advancing included angle at the same time. It can be seen that in
X>R.sub.1(1−cos α)
(50) Therefore, the travel route of the hoisting system is an S-curve.
(51) It should be noted that the deviation correction process of the hoisting system in
(52) Therefore, the application scenario in
(53) Now refer to
(54) According to the situation of the deviation correction test of the hoisting system at the initial stage, the first stage, the second stage and the third stage, through the deviation correction of 10 seconds at the first stage and the reverse deviation correction of 3.5 seconds at the second stage, at the third stage basically maintaining the hoisting system a straight-line travel. That is to say, the automatic deviation correction method of the hoisting system provided by the present embodiment can automatically correct the deviation of the hoisting system whose initial lateral displacement deviates from the center line by 15 cm back to the center line within 17 seconds. It can be seen that through the automatic deviation correction control method of the hoisting system provided by the present embodiment, the advancing included angle and lateral displacement of the hoisting system have been well corrected.
(55) In summary, an automatic deviation correction control method for hoisting system provided by the present invention covering various application scenarios of the hoisting system during the traveling process, and determining the applicable application scenarios of the hoisting system during the current traveling process by obtaining the lateral displacement and the advancing included angle of the hoisting system. When the lateral displacement X is 0 and the advancing included angle α is also 0, maintaining the hoisting system a straight-line travel, if the advancing included angle α is not 0, controlling the hoisting system to correct the deviation toward the center line so that the advancing included angle α tends to 0. When the lateral displacement X is not 0 and the advancing included angle α is also not 0, determining whether the lateral displacement X and the advancing included angle α satisfy a preset condition, if the lateral displacement X and the advancing included angle α do not satisfy the preset condition, controlling the hoisting system to correct the deviation toward the center line; and if the lateral displacement X and the advancing included angle α satisfy the preset condition, controlling the hoisting system to correct the deviation toward the center line in a reverse direction until the lateral displacement and the advancing included angle are both 0, then the deviation correction is completed, and controlling the hoisting system maintaining a straight-line travel. The control method is particularly efficient and has low computational complexity. Once the lateral displacement X and the advancing included angle α satisfy the preset condition, it will immediately trigger controlling the hoisting system to correct the deviation toward the center line in a reverse direction, quickly correcting the deviation of the hoisting system back to the center line in no more than twenty seconds, thereby implementing the automatic deviation correction of the hoisting system, and then effectively reducing the workload of a driver during work, laying a foundation for the unmanned operation of the port terminal.
(56) Although the present invention has been disclosed as above in a preferred embodiment, it is not intended to limit the present invention. Any person skilled in the art can make some modifications and improvements without departing from the spirit and scope of the present invention. Therefore, the scope of protection of the present invention should be subject to those defined in the claims.