Anti-collision control system and method for lifting appliance of container reach stacker

By installing radar on the body and spreader crane on the front of the container, the lifting angle and spreader status of the big boom are detected in real time, the problem of insufficient anti-collision accuracy in the existing technology is solved, and the spreader, big boom and car body are realized. Precise control between them improves safety performance and operating experience.

CN118908075APending Publication Date: 2024-11-08HANGCHA GRP
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411399450.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-10-09
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

The anti-collision strategy of existing container front cranes is not very accurate, which leads to collision problems between the spreader, the upper arm and the vehicle body, affecting operating efficiency and operational safety.

Method used

The radar set on the body and spreader is used for real-time detection. By obtaining the lifting angle and radar signal of the boom, we can determine whether the spreader is in a critical state of collision, and perform corresponding control operations to avoid collisions, ensuring the body, the boom and the Safe distance between spreaders.

Benefits of technology

Accurate detection and control of the status of the spreader is realized, effectively avoiding collisions between the spreader, the upper arm and the vehicle body, and improving the safety performance and operational experience of the front hoist of the container.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118908075A_ABST
    Figure CN118908075A_ABST
Patent Text Reader

Abstract

The invention discloses a lifting appliance anti-collision control method and system of a container reach stacker, electronic equipment and a storage medium, and belongs to the technical field of lifting equipment technologies. The anti-collision control method for the lifting appliance of the container reach stacker comprises the following steps: acquiring a lifting angle of a big arm; whether the lifting angle is larger than an angle threshold value or not is judged; if yes, detecting whether the lifting appliance is in a first collision critical state or not by using a lifting appliance radar; wherein the first collision critical state is the collision critical state of the lifting appliance and the big arm; if not, detecting whether the lifting appliance is in a first collision critical state or not by using a lifting appliance radar, and detecting whether the lifting appliance is in a second collision critical state or not by using a vehicle body radar; wherein the second collision critical state is the collision critical state of the lifting appliance and the vehicle body; and carrying out corresponding control operation on the lifting appliance and the big arm, so that the distance among the vehicle body, the big arm and the lifting appliance reaches a safe distance. The state of the lifting appliance can be accurately detected, and collision among the lifting appliance, a large arm and a vehicle body is prevented.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the technical field of lifting equipment, and in particular to a control system and method for preventing collision of a lifting device of a container front crane. Background Art

[0002] Container reach stacker, also known as container reach crane, reach crane or reach stacker, is a mobile lifting equipment used to load and unload containers. Container reach stacker is mainly used for stacking containers and horizontal transportation within the yard. It is an important equipment for stacking and loading and unloading containers in docks, ports, railway yards and other places. It has high requirements for active safety in operation. Among them, the anti-collision function of the spreader, the boom and the body is an important function that affects the driver's operating safety and comfort.

[0003] At present, the anti-collision strategy for container reach cranes is mostly to install a proximity switch on the spreader. The controller determines the opening and closing position of the spreader based on the state of the proximity switch, and then calculates the safe action range in real time based on the boom lifting angle and extension length collected by the length angle sensor to avoid collision between the spreader and the boom.

[0004] Since there is a certain error in the boom model of each container reach crane, the proximity switch installed on the spreader can only vaguely confirm the extension and retraction status of the spreader, resulting in low accuracy of the entire mathematical model. In actual use, problems such as the reserved safety area being too large affecting normal operation or the distance being too small causing collisions often occur, affecting work efficiency and operating experience.

[0005] Therefore, how to accurately detect the state of the spreader and prevent collision between the spreader, the boom and the vehicle body is a technical problem that technical personnel in this field currently need to solve. Summary of the invention

[0006] The purpose of the present application is to provide a method, system, electronic device and storage medium for anti-collision control of a spreader of a container front crane, which can accurately detect the state of the spreader and prevent collision between the spreader, the boom and the vehicle body.

[0007] In order to solve the above technical problems, the present application provides a method for preventing collision of a spreader of a container reach crane, wherein the container reach crane comprises a body, a boom and a spreader, the body is provided with N body radars, the spreader is provided with M spreader radars, and the method for preventing collision of a spreader of the container reach crane comprises:

[0008] Obtaining the lifting angle of the boom;

[0009] Determining whether the lifting angle is greater than an angle threshold;

[0010] If so, the spreader radar is used to detect whether the spreader is in a first critical collision state; wherein the first critical collision state is a critical collision state between the spreader and the boom;

[0011] If not, the spreader radar is used to detect whether the spreader is in the first critical collision state, and the vehicle body radar is used to detect whether the spreader is in the second critical collision state; wherein the second critical collision state is a critical collision state between the spreader and the vehicle body;

[0012] If the spreader is in the first critical collision state and / or the second critical collision state, corresponding control operations are performed on the spreader and the boom so that the distance between the vehicle body, the boom and the spreader reaches a safe distance.

[0013] Optionally, the spreader radar includes a first radar, a second radar, a third radar, a fourth radar, a fifth radar and a sixth radar, and the vehicle body radar includes a seventh radar and an eighth radar;

[0014] Among them, the first radar is arranged at the left rear side of the spreader, and the signal emission direction of the first radar is the rear of the spreader; the second radar is arranged at the right rear side of the spreader, and the signal emission direction of the second radar is the rear of the spreader; the third radar is arranged at the upper right side of the spreader, and the signal emission direction of the third radar is above the spreader; the fourth radar is arranged at the right front side of the spreader, and the signal emission direction of the fourth radar is in front of the spreader; the fifth radar is arranged at the left front side of the spreader, and the signal emission direction of the fifth radar is in front of the spreader; the sixth radar is arranged at the upper left side of the spreader, and the signal emission direction of the sixth radar is above the spreader; the seventh radar is arranged at the left front side of the vehicle body, and the signal emission direction of the seventh radar is the forward direction of the vehicle body; the eighth radar is arranged at the right front side of the vehicle body, and the signal emission direction of the eighth radar is the forward direction of the vehicle body.

[0015] Optionally, before using the spreader radar to detect whether the spreader is in the first collision critical state and / or the second collision critical state, the method further includes:

[0016] acquiring radar safety thresholds corresponding to the first radar, the second radar, the third radar, the fourth radar, the fifth radar, the sixth radar, the seventh radar, and the eighth radar;

[0017] The product of the radar safety threshold and the safety factor is set as the collision critical distance of the corresponding radar;

[0018] Among them, if the obstacle distance detected by any one or any several of the first radar, the second radar, the third radar, the fourth radar, the fifth radar and the sixth radar is less than the corresponding critical collision distance, the sling is in the first critical collision state; if the obstacle distance detected by the seventh radar and / or the eighth radar is less than the corresponding critical collision distance, the sling is in the second critical collision state.

[0019] Optionally, if the spreader is in the second collision critical state, performing corresponding control operations on the spreader and the boom, including:

[0020] If the obstacle distance detected by the seventh radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the counterclockwise rotation solenoid valve of the spreader is controlled to be 0;

[0021] If the obstacle distance detected by the eighth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the clockwise rotation solenoid valve of the spreader is controlled to be 0.

[0022] Optionally, if the spreader is in the first collision critical state, performing corresponding control operations on the spreader and the boom includes:

[0023] If the obstacle distance detected by the first radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the left shift solenoid valve, the opening solenoid valve and the counterclockwise rotation solenoid valve of the spreader is controlled to be 0;

[0024] If the obstacle distance detected by the second radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the right shift solenoid valve, the opening solenoid valve and the clockwise rotation solenoid valve of the spreader is controlled to be 0;

[0025] If the obstacle distance detected by the third radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve, the extension solenoid valve and the retraction proportional valve of the boom is controlled to be 0, and the output current of the right shift solenoid valve and the opening solenoid valve of the spreader is controlled to be 0;

[0026] If the obstacle distance detected by the fourth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the right shift solenoid valve, the opening solenoid valve and the counterclockwise rotation solenoid valve of the spreader is controlled to be 0;

[0027] If the obstacle distance detected by the fifth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the left shift solenoid valve, the opening solenoid valve and the clockwise rotation solenoid valve of the spreader is controlled to be 0;

[0028] If the obstacle distance detected by the sixth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve, the extension solenoid valve and the retraction proportional valve of the boom is controlled to be 0, and the output current of the left shift solenoid valve and the opening solenoid valve of the spreader is controlled to be 0.

[0029] Optionally, obtaining radar safety thresholds corresponding to the first radar, the second radar, the third radar, the fourth radar, the fifth radar, the sixth radar, the seventh radar, and the eighth radar includes:

[0030] Control the lifting angle of the boom to reach the angle threshold, and control the spreader to rotate counterclockwise at the left limit position; after receiving the first stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the first radar as the radar safety threshold corresponding to the first radar;

[0031] Control the lifting angle of the boom to reach the angle threshold, and control the spreader to rotate clockwise at the right limit position; after receiving the second stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the second radar as the radar safety threshold corresponding to the second radar;

[0032] Control the lifting angle of the boom to reach 0°, control the spreader to rotate 90° clockwise at the middle position, and control the boom to lift; after receiving the third stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the third radar as the radar safety threshold corresponding to the third radar;

[0033] Control the lifting angle of the boom to reach the angle threshold, control the spreader to rotate 180° clockwise at the middle position and then move to the right limit position, and control the spreader to rotate counterclockwise at the right limit position; after receiving the fourth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the fourth radar as the radar safety threshold corresponding to the fourth radar;

[0034] Control the lifting angle of the boom to reach the angle threshold, control the spreader to rotate 180° counterclockwise at the middle position and then move to the left limit position, and control the spreader to rotate clockwise at the left limit position; after receiving the fifth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the fifth radar as the radar safety threshold corresponding to the fifth radar;

[0035] Control the lifting angle of the boom to reach 0°, control the spreader to rotate 90° counterclockwise at the middle position, and control the boom to lift; after receiving the sixth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the sixth radar as the radar safety threshold corresponding to the sixth radar;

[0036] Control the lifting angle of the boom to reach 0°, and control the spreader to rotate counterclockwise at the left limit position; after receiving the seventh stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the seventh radar as the radar safety threshold corresponding to the seventh radar;

[0037] Control the lifting angle of the boom to reach 0°, and control the spreader to rotate clockwise at the right extreme position; after receiving the eighth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the eighth radar as the radar safety threshold corresponding to the eighth radar.

[0038] Optionally, before determining whether the lifting angle is greater than the angle threshold, the method further includes:

[0039] The angle threshold is determined according to the structure and size of the container reach crane; wherein the angle threshold is a minimum lifting angle that meets a preset condition, wherein the preset condition is that the spreader or the container does not collide with the vehicle body.

[0040] The present application also provides a spreader anti-collision control system for a container reach crane, the container reach crane comprises a body, a boom and a spreader, the body is provided with N body radars, the spreader is provided with M spreader radars, and the spreader anti-collision control system for the container reach crane comprises:

[0041] An angle acquisition module, used to acquire the lifting angle of the boom;

[0042] An angle judgment module, used to judge whether the lifting angle is greater than an angle threshold;

[0043] a first detection module, configured to detect, by using the spreader radar, whether the spreader is in a first critical collision state if the lifting angle is greater than the angle threshold; wherein the first critical collision state is a critical collision state between the spreader and the boom;

[0044] a second detection module, configured to detect whether the spreader is in the first critical collision state by using the spreader radar, and detect whether the spreader is in the second critical collision state by using the vehicle body radar if the lifting angle is less than or equal to the angle threshold; wherein the second critical collision state is a critical collision state between the spreader and the vehicle body;

[0045] A control module is used to perform corresponding control operations on the spreader and the boom if the spreader is in the first collision critical state and / or the second collision critical state, so that the distance between the vehicle body, the boom and the spreader reaches a safe distance.

[0046] The present application also provides a storage medium having a computer program stored thereon, wherein when the computer program is executed, the steps of the above-mentioned method for controlling the anti-collision of the spreader of the container reach crane are implemented.

[0047] The present application also provides an electronic device, including a memory and a processor, wherein the memory stores a computer program, and when the processor calls the computer program in the memory, the steps of the above-mentioned container front crane sling anti-collision control method are implemented.

[0048] The present application provides a method for controlling the spreader collision prevention of a container reach crane, and the container reach crane used in the method includes a body, a boom and a spreader, and the body and the spreader are provided with corresponding radars. The present application obtains the lifting angle of the boom and adopts a corresponding detection strategy according to the lifting angle. If the lifting angle is greater than the angle threshold, the spreader radar is used to detect whether the spreader is in a critical collision state with the boom; if the lifting angle is less than or equal to the angle threshold, the body radar and the spreader radar are used to detect whether the spreader is in a critical collision state with the body and the boom. When the spreader is detected to be in a first critical collision state or a second critical collision state, the present application takes corresponding control measures to make the distance between the body, the boom and the spreader reach a safe distance. The present application monitors the lifting angle of the boom, and adopts different detection strategies according to different angles, uses the body radar and the spreader radar to accurately detect the state of the spreader, and timely controls the spreader and the boom before a collision occurs, so as to avoid the spreader from colliding with the body or the boom. Therefore, the present application can accurately detect the state of the spreader and prevent collisions between the spreader, the boom and the body. The present application also provides a container front crane's sling anti-collision control system, a storage medium and an electronic device, which have the above-mentioned beneficial effects and are not described in detail here. BRIEF DESCRIPTION OF THE DRAWINGS

[0049] In order to more clearly illustrate the embodiments of the present application, the following is a brief introduction to the drawings required for use in the embodiments. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.

[0050] Figure 1 A flow chart of a method for controlling the anti-collision of a spreader of a container reach crane provided in an embodiment of the present application;

[0051] Figure 2 A schematic diagram of signal acquisition of a control system for a container reach stacker provided in an embodiment of the present application;

[0052] Figure 3 A top view of a radar arrangement of a container reach stacker provided in an embodiment of the present application;

[0053] Figure 4 A side view of a radar arrangement of a container reach stacker provided in an embodiment of the present application;

[0054] Figure 5 Axonometric diagram of the radar arrangement of a container reach crane provided in an embodiment of the present application;

[0055] FIG6 is an overall side view of a container reach crane provided in an embodiment of the present application;

[0056] Figure 7 A flow chart of anti-collision control for a container reach crane provided in an embodiment of the present application. DETAILED DESCRIPTION

[0057] In order to make the purpose, technical solution and advantages of the embodiments of the present application clearer, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.

[0058] See below Figure 1 , Figure 1 A flow chart of a method for controlling the anti-collision of a spreader of a container reach crane provided in an embodiment of the present application.

[0059] Specific steps may include:

[0060] S101: Acquire the lifting angle of the boom;

[0061] Among them, the container reach crane includes a body, a boom and a spreader, the body is provided with N body radars, the spreader is provided with M spreader radars, and the above-mentioned container reach crane is also provided with a whole vehicle controller. This embodiment can be realized by the whole vehicle controller of the container reach crane.

[0062] In this embodiment, the radar installed on the sling is referred to as a sling radar, and the radar installed on the vehicle body is referred to as a vehicle body radar. The above radars may be millimeter wave radars, laser radars, ultrasonic radars or other radars.

[0063] One end of the boom is connected to the vehicle body, and the other end is connected to the hoist; the lifting angle of the boom is used to describe the degree of inclination of the boom. The lifting angle of the boom is the angle between the boom and the horizontal plane, that is, the angle between the length direction of the boom and the horizontal plane.

[0064] S102: Determine whether the lifting angle is greater than an angle threshold; if so, proceed to S103; if not, proceed to S104;

[0065] In this embodiment, an angle threshold can be predetermined, and the angle threshold can be set by the staff based on experience, or can be determined based on the structural dimensions of the container reach crane. As a feasible implementation, before determining whether the lifting angle is greater than the angle threshold, the angle threshold can also be determined based on the structure and dimensions of the container reach crane; wherein the angle threshold is the minimum lifting angle that meets the preset condition, wherein the preset condition is that the spreader or container does not collide with the vehicle body.

[0066] S103: Using the spreader radar to detect whether the spreader is in a first collision critical state;

[0067] Among them, this step is based on the fact that the lifting angle of the boom is greater than the angle threshold. At this time, due to the large lifting angle, the spreader or container does not collide with the vehicle body. At this time, attention can be paid to the collision between the spreader and the boom.

[0068] Specifically, in this embodiment, the spreader radar can be used to detect the distance between the spreader and the boom. If the distance between the spreader and the boom is less than the critical distance, it is determined that the spreader is in the first collision critical state. The first collision critical state refers to the state where the distance between the spreader and the boom is less than the critical distance. At this time, the spreader and the boom are about to collide, and measures need to be taken to avoid contact.

[0069] S104: using the spreader radar to detect whether the spreader is in the first critical collision state, and using the vehicle body radar to detect whether the spreader is in the second critical collision state;

[0070] Among them, this embodiment is based on the premise that the lifting angle of the boom is less than or equal to the angle threshold. At this time, due to the small lifting angle, the boom, the sling or the container may collide with the vehicle body. At this time, attention can be paid to the collision between the sling and the boom, or the collision between the sling and the vehicle body.

[0071] Specifically, the process of detecting whether the spreader is in the first critical collision state is consistent with the process of S103. In this embodiment, the spreader radar can be used to detect the distance between the spreader and the vehicle body. If the distance between the spreader and the vehicle body is less than the critical distance, it is determined that the spreader is in the second critical collision state. The second critical collision state refers to a state where the distance between the spreader and the vehicle body is less than the critical distance. At this time, the spreader and the vehicle body are about to collide, and measures need to be taken to avoid contact.

[0072] The first critical collision state is the critical collision state between the spreader and the boom, and the second critical collision state is the critical collision state between the spreader and the vehicle body. The spreader in this embodiment can be a spreader when the container is not grabbed, or can be a spreader when the container is grabbed. If the spreader has not grabbed the container, the spreader in this embodiment refers to the spreader body; if the spreader has grabbed the container, the spreader in this embodiment refers to the spreader body and the container grabbed by it. Therefore, if the spreader has grabbed the container, the collision between the spreader and the boom mentioned in this embodiment refers to the collision between the spreader and the container as a whole and the boom, and the collision between the spreader and the vehicle body mentioned in this embodiment refers to the collision between the spreader and the container as a whole and the vehicle body.

[0073] S105: If the spreader is in the first critical collision state and / or the second critical collision state, corresponding control operations are performed on the spreader and the boom to ensure that the distance between the vehicle body, the boom and the spreader reaches a safe distance.

[0074] If, after the operation of S103 or S104, it is determined that the spreader is in the first critical collision state and / or the second critical collision state, corresponding control operations can be performed on the spreader and the boom so that the distance between the vehicle body, the boom and the spreader reaches a safe distance. After the distance between the vehicle body, the boom and the spreader reaches a safe distance, the spreader is not in the first critical collision state or the second critical collision state.

[0075] The container reach stacker used in this embodiment includes a body, a boom and a spreader, and the body and the spreader are provided with corresponding radars. This embodiment obtains the lifting angle of the boom and adopts a corresponding detection strategy according to the lifting angle. If the lifting angle is greater than the angle threshold, the spreader radar is used to detect whether the spreader is in a critical collision state with the boom; if the lifting angle is less than or equal to the angle threshold, the body radar and the spreader radar are used to detect whether the spreader is in a critical collision state with the body and the boom. When the spreader is detected to be in the first critical collision state or the second critical collision state, this embodiment takes corresponding control measures to make the distance between the body, the boom and the spreader reach a safe distance. This embodiment monitors the lifting angle of the boom and adopts different detection strategies according to different angles, uses the body radar and the spreader radar to accurately detect the state of the spreader, and timely controls the spreader and the boom before a collision occurs to avoid the spreader from colliding with the body or the boom. Therefore, this embodiment can accurately detect the state of the spreader and prevent collisions between the spreader, the boom and the body.

[0076] As for Figure 1 For further introduction to the corresponding embodiment, the sling is provided with 6 sling radars, and the vehicle body is provided with 2 vehicle body radars. The sling radars include a first radar, a second radar, a third radar, a fourth radar, a fifth radar and a sixth radar, and the vehicle body radars include a seventh radar and an eighth radar.

[0077] The first radar is arranged at the left rear side of the spreader, and the signal transmission direction of the first radar is the rear of the spreader. The first radar is arranged on the main beam of the spreader, and the left rear side position can be a position which is a certain distance (such as 30-50 cm) from the left end of the main beam and does not interfere with surrounding parts; the signal transmission direction of the first radar is perpendicular to the rear end of the main beam and faces backward.

[0078] The second radar is set at the right rear side of the spreader, and the signal emission direction of the second radar is the rear of the spreader. The second radar is set on the main beam of the spreader, and the right rear side position is a certain distance (such as 30-50 cm) from the right end of the main beam and does not interfere with surrounding parts; the signal emission direction of the second radar is perpendicular to the rear end of the main beam and faces backward.

[0079] The third radar is set at the upper right side of the spreader, and the signal transmission direction of the third radar is above the spreader. The third radar G3 can be installed on the main beam of the spreader through a bracket, and the upper right side position is the position of the upper right end face of the spreader main beam; as a feasible implementation method, the upper right side position is no more than 30cm away from the center line and 50~80cm away from the right end face. The signal transmission direction of the third radar is vertically upward.

[0080] The fourth radar is set at the right front side of the spreader, and the signal emission direction of the fourth radar is the front of the spreader. The fourth radar is set on the main beam of the spreader, and the right front side position is a position that is a certain distance (such as 30-50 cm) from the right end of the main beam and does not interfere with surrounding parts. The signal emission direction of the fourth radar is perpendicular to the front end of the main beam and faces forward.

[0081] The fifth radar is set at the left front side of the spreader, and the signal emission direction of the fifth radar is the front of the spreader. The fifth radar is set on the main beam of the spreader, and the left front side position is a position that is a certain distance (such as 30-50 cm) from the left end of the main beam and does not interfere with surrounding parts. The signal emission direction of the fifth radar is perpendicular to the front end of the main beam and faces forward.

[0082] The sixth radar is arranged at the upper left side of the spreader, and the signal transmission direction of the sixth radar is above the spreader. The sixth radar can be installed on the main beam of the spreader through a bracket, and the upper left side position is the position of the upper left end surface of the main beam of the spreader; as a feasible implementation method, the upper left side position is no more than 30cm away from the center line and 50~80cm away from the left end surface. The signal transmission direction of the sixth radar is vertically upward.

[0083] The seventh radar is arranged at the left front side of the vehicle body, and the signal transmission direction of the seventh radar is the forward direction of the vehicle body. The left front side position is the position on the bracket on the left front side of the vehicle body, and the signal transmission direction of the seventh radar is forward (the forward direction of the vehicle).

[0084] The eighth radar is arranged at the right front side of the vehicle body, and the signal transmission direction of the eighth radar is the forward direction of the vehicle body. The right front side position is the position on the bracket at the right front side of the vehicle body, and the signal transmission direction of the eighth radar is forward (the forward direction of the vehicle).

[0085] As for Figure 1 Further introduction to the corresponding embodiment, before using the sling radar to detect whether the sling is in the first critical collision state and / or the second critical collision state, the critical collision distance of each radar can also be determined, so as to judge whether the sling is in the first critical collision state and / or the second critical collision state based on the obstacle distance detected by the radar and the critical collision distance.

[0086] Specifically, in this embodiment, the radar safety threshold corresponding to each of the first radar, the second radar, the third radar, the fourth radar, the fifth radar, the sixth radar, the seventh radar, and the eighth radar can be obtained; and the product of the radar safety threshold and the safety factor is set as the collision critical distance of the corresponding radar (the first radar to the eighth radar). The above radar safety threshold can be obtained through experimental testing.

[0087] Correspondingly, this embodiment can determine whether the sling is in the first critical collision state and / or the second critical collision state according to the following principles: if the obstacle distance detected by any one or any several of the first radar, the second radar, the third radar, the fourth radar, the fifth radar and the sixth radar is less than the corresponding critical collision distance, then the sling is in the first critical collision state; if the obstacle distance detected by the seventh radar and / or the eighth radar is less than the corresponding critical collision distance, then the sling is in the second critical collision state.

[0088] As for Figure 1 Further introduction to the corresponding embodiment, the boom has a lifting proportional valve, a lowering proportional valve, an extension proportional valve and a retraction proportional valve, and the sling has a left-shift solenoid valve, a right-shift solenoid valve, an opening solenoid valve, a closing solenoid valve, a clockwise rotation solenoid valve and a counterclockwise rotation solenoid valve. The lifting proportional valve is used to control the lifting of the boom, the lowering proportional valve is used to control the lowering of the boom, the extension proportional valve is used to control the extension of the boom, the retraction proportional valve is used to control the retraction of the boom, the left-shift solenoid valve is used to control the left movement of the sling, the right-shift solenoid valve is used to control the right movement of the sling, the opening solenoid valve is used to control the opening of the sling, the closing solenoid valve is used to control the closing of the sling, the clockwise rotation solenoid valve is used to control the clockwise rotation of the sling, and the counterclockwise rotation solenoid valve is used to control the counterclockwise rotation of the sling. When the output current of the above-mentioned proportional valve or solenoid valve is 0, the corresponding lifting, lowering, extension, retraction, left-shift, right-shift, opening, closing and rotation operations are not performed.

[0089] When the spreader is in the first collision critical state, this embodiment can perform corresponding control operations on the spreader and the boom in the following manner:

[0090] If the obstacle distance detected by the first radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the left shift solenoid valve, the opening solenoid valve and the counterclockwise rotation solenoid valve of the spreader is controlled to be 0;

[0091] If the obstacle distance detected by the second radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the right shift solenoid valve, the opening solenoid valve and the clockwise rotation solenoid valve of the spreader is controlled to be 0;

[0092] If the obstacle distance detected by the third radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve, the extension solenoid valve and the retraction proportional valve of the boom is controlled to be 0, and the output current of the right shift solenoid valve and the opening solenoid valve of the spreader is controlled to be 0;

[0093] If the obstacle distance detected by the fourth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the right shift solenoid valve, the opening solenoid valve and the counterclockwise rotation solenoid valve of the spreader is controlled to be 0;

[0094] If the obstacle distance detected by the fifth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the left shift solenoid valve, the opening solenoid valve and the clockwise rotation solenoid valve of the spreader is controlled to be 0;

[0095] If the obstacle distance detected by the sixth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve, the extension solenoid valve and the retraction proportional valve of the boom is controlled to be 0, and the output current of the left shift solenoid valve and the opening solenoid valve of the spreader is controlled to be 0.

[0096] When the spreader is in the second critical collision state, this embodiment may perform corresponding control operations on the spreader and the boom in the following manner:

[0097] If the obstacle distance detected by the seventh radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the counterclockwise rotation solenoid valve of the spreader is controlled to be 0;

[0098] If the obstacle distance detected by the eighth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the clockwise rotation solenoid valve of the spreader is controlled to be 0.

[0099] As for Figure 1 For further introduction to the corresponding embodiment, the container reach stacker may be tested in advance to determine the radar safety threshold corresponding to each radar, and the specific process is as follows:

[0100] Control the lifting angle of the boom to reach the angle threshold, and control the spreader to rotate counterclockwise at the left limit position; after receiving the first stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the first radar as the radar safety threshold corresponding to the first radar;

[0101] Control the lifting angle of the boom to reach the angle threshold, and control the spreader to rotate clockwise at the right limit position; after receiving the second stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the second radar as the radar safety threshold corresponding to the second radar;

[0102] Control the lifting angle of the boom to reach 0°, control the spreader to rotate 90° clockwise at the middle position, and control the boom to lift; after receiving the third stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the third radar as the radar safety threshold corresponding to the third radar;

[0103] Control the lifting angle of the boom to reach the angle threshold, control the spreader to rotate 180° clockwise at the middle position and then move to the right limit position, and control the spreader to rotate counterclockwise at the right limit position; after receiving the fourth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the fourth radar as the radar safety threshold corresponding to the fourth radar;

[0104] Control the lifting angle of the boom to reach the angle threshold, control the spreader to rotate 180° counterclockwise at the middle position and then move to the left limit position, and control the spreader to rotate clockwise at the left limit position; after receiving the fifth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the fifth radar as the radar safety threshold corresponding to the fifth radar;

[0105] Control the lifting angle of the boom to reach 0°, control the spreader to rotate 90° counterclockwise at the middle position, and control the boom to lift; after receiving the sixth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the sixth radar as the radar safety threshold corresponding to the sixth radar;

[0106] Control the lifting angle of the boom to reach 0°, and control the spreader to rotate counterclockwise at the left limit position; after receiving the seventh stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the seventh radar as the radar safety threshold corresponding to the seventh radar;

[0107] Control the lifting angle of the boom to reach 0°, and control the spreader to rotate clockwise at the right extreme position; after receiving the eighth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the eighth radar as the radar safety threshold corresponding to the eighth radar.

[0108] The above-mentioned first to eighth stop commands can be commands issued by the user, or can be commands automatically issued based on the working scene image of the container front crane using an artificial intelligence model.

[0109] The process described in the above embodiment is explained below through an embodiment in actual application.

[0110] In the related art, proximity switches are usually installed on the sling to detect collisions. However, in actual use, the safety area is often too large to affect normal operation, or the distance is too small to still cause collisions, affecting work efficiency and operating experience. At the same time, the related technology cannot prevent the collision between the sling and the vehicle body when the sling box is in the state of being hoisted.

[0111] In response to the technical problems existing in the relevant technologies, this example provides a control system and method for the anti-collision of the spreader of a container front crane. It only requires the installation of millimeter-wave radars in six designated areas of the main beam of the spreader and two areas at the front of the vehicle body. After calibration, the real-time distance between the boom and the spreader monitored by the radar can be combined with the state of the safety bypass switch and the length angle sensor signal to limit the related actions of the boom and the spreader to avoid the collision between the boom and the spreader and between the spreader and the vehicle body, effectively improving the safety performance and driving experience of the container front crane. In the entire algorithm strategy, ten adjustable parameters are introduced, including radar safety thresholds L1~L8, real-time angle thresholds for collision between the boom and the vehicle body, and safety factor n. The administrator can set them through interactive instruments to adjust the reliability of the control program.

[0112] The container reach crane anti-collision control system provided in this embodiment includes a safety bypass switch, a length angle sensor ACQ, a spreader left rear millimeter wave radar G1 (i.e., a first radar), a spreader right rear millimeter wave radar G2 (i.e., a second radar), a spreader right upper millimeter wave radar G3 (i.e., a third radar), a spreader right front millimeter wave radar G4 (i.e., a fourth radar), a spreader left front millimeter wave radar G5 (i.e., a fifth radar), a spreader left upper millimeter wave radar G6 (i.e., a sixth radar), a body left front millimeter wave radar G7 (i.e., a seventh radar), and a body right front millimeter wave radar G8 (i.e., a fifth radar). Wave radar G8 (i.e. the eighth radar), spreader controller, interactive bus instrument M, vehicle control unit (VCU), boom lifting proportional valve Y1, boom lowering proportional valve Y2, boom extension proportional valve Y3, boom retraction proportional valve Y4, spreader left shift valve Y5 (i.e. left shift solenoid valve), spreader right shift valve Y6 (i.e. right shift solenoid valve), spreader opening valve Y7 (i.e. opening solenoid valve), spreader closing valve Y8 (i.e. closing solenoid valve), spreader clockwise valve Y9 (i.e. clockwise rotation solenoid valve) and spreader counterclockwise valve Y10 (i.e. counterclockwise rotation solenoid valve). The vehicle controller comprehensively analyzes the operation instructions of the radar, length angle sensor and handle, and combines the radar safety threshold L1~L8 set by the instrument to limit the action of the solenoid valve to avoid the collision between the spreader and the boom and the body; the bus instrument, vehicle controller, spreader controller and radar exchange information through the CAN bus; the administrator can input the eight thresholds L1~L8 of the eight radars when the spreader is in different dangerous states, the real-time angle threshold and safety factor n of the collision between the boom and the body through the instrument during calibration to adjust the reliability of the system operation. In this solution, the forward direction of the container reach crane is taken as the front.

[0113] Radar G1 is fixed on the left rear side of the main beam of the spreader by bolts to detect the distance of obstacles on the left rear side of the spreader; radar G2 is fixed on the right rear side of the main beam of the spreader by bolts to detect the distance of obstacles on the right rear side of the spreader; radar G3 is fixed on the upper right side of the spreader by bolts to detect the distance of obstacles on the upper right side of the spreader; radar G4 is fixed on the right front side of the spreader by bolts to detect the distance of obstacles on the right front side of the spreader; radar G5 is fixed on the left front side of the spreader by bolts to detect the distance of obstacles on the left front side of the spreader; radar G6 is fixed on the upper left side of the spreader by bolts to detect the distance of obstacles on the upper left side of the spreader; radar G7 is fixed on the left front side of the vehicle body by bolts to detect the distance of obstacles on the left front side of the vehicle body; radar G8 is fixed on the right front side of the vehicle body by bolts to detect the distance of obstacles on the right front side of the vehicle body.

[0114] In this embodiment, the radar safety thresholds L1-L8 can be determined according to the following steps A1-A6:

[0115] Step A1: Lift the container front onto a flat surface, lower the boom to a position with an angle of 0°, control the spreader to rotate counterclockwise until the spreader is about to collide with the left front side of the vehicle body, and record the minimum distance L7 between the radar G7 and the spreader at this time; then control the spreader to rotate clockwise until the spreader is about to collide with the right front side of the vehicle body, and record the minimum distance L8 between the radar G8 and the spreader at this time. L7 is the radar safety threshold of the seventh radar, and L8 is the radar safety threshold of the eighth radar.

[0116] Step A2: Control the boom to rise to 30°, first move the spreader to the left, rotate the spreader counterclockwise until the spreader is about to collide with the boom, and record the minimum distance L1 between the radar G1 and the boom at this time; then move the spreader to the right, rotate the spreader clockwise until the spreader is about to collide with the boom, and record the minimum distance L2 between the radar G2 and the boom at this time. L1 is the radar safety threshold of the first radar, and L2 is the radar safety threshold of the second radar.

[0117] Step A3: Control the boom to rise to 30°, first center the spreader, with the direction perpendicular to the forward direction of the vehicle body, control the spreader to rotate 180° clockwise, then move the spreader to the right, rotate the spreader counterclockwise until the spreader is about to collide with the boom, and record the minimum distance L4 between the radar G4 and the boom at this time. L4 is the radar safety threshold of the fourth radar.

[0118] Step A4: Control the boom to rise to 30°, first center the spreader, with the direction perpendicular to the forward direction of the vehicle body, control the spreader to rotate 180° counterclockwise, then move the spreader to the left, and rotate the spreader clockwise until the spreader is about to collide with the boom, and record the minimum distance L5 between the radar G5 and the boom at this time. L5 is the radar safety threshold of the fifth radar.

[0119] Step A5: Control the boom to drop to 0°, first center the spreader, with the direction perpendicular to the forward direction of the vehicle body, control the spreader to rotate 90° clockwise, and slowly lift the spreader. When the right side of the spreader is about to collide with the boom, record the minimum distance L3 between the radar G3 and the boom at this time. L3 is the radar safety threshold of the third radar.

[0120] Step A6: Control the boom to drop to 0°, first center the spreader, with the direction perpendicular to the forward direction of the vehicle body, control the spreader to rotate 90° counterclockwise, and slowly lift the spreader. When the left side of the spreader is about to collide with the boom, record the minimum distance L6 between the radar G6 and the boom at this time. L6 is the radar safety threshold of the sixth radar.

[0121] In this embodiment, anti-collision control of the sling can be achieved through steps B1 to B3:

[0122] Step B1: After the radar G1~G8 is installed, the vehicle controller first calibrates the radar safety thresholds L1~L8 through the radar calibration method of steps A1~A6. The vehicle controller obtains the angle of the boom when the current hoist is lifted by analyzing the data collected from the length angle sensor ACQ, and obtains the real-time minimum distance l between the current radar G1~G8 and the current obstacle by analyzing the radar data. 1 ~l 8 The customer sets the radar safety threshold L1~L8, the system safety factor n and the angle threshold α at which the vehicle body may collide with the hoist through the instrument. 1 , in this application example, n=1.2, α 1 =32°. 1 ~l 8 That is, the minimum obstacle distance actually detected by the radar.

[0123] Step B2: The vehicle controller determines the state of the safety bypass switch S. If the safety bypass switch is not closed, it goes to step B3. If the safety bypass switch is closed, it means that the safety bypass function is turned on, and the system will release the restrictions on the boom and spreader movements by the spreader anti-collision system.

[0124] Step B3: The vehicle controller determines the boom lifting angle. If the boom lifting angle α≤α 1 , then execute the body crane anti-collision procedure and the crane boom anti-collision procedure. If the boom lifting angle α>α 1 , only the crane boom anti-collision procedure will be executed;

[0125] The vehicle body sling anti-collision procedure means that the vehicle controller first obtains the minimum distance l between the sling and the left side of the vehicle body through the radar G7. 7 , obtain the minimum distance l between the sling and the right side of the vehicle body through radar G8 8 If l 7<n×L7, the left side of the vehicle body is in a dangerous state of collision with the spreader. At this time, the vehicle controller controls the boom lifting proportional valve Y1 and the retracting proportional valve Y4 to output 0 current, and the spreader controller controls the spreader to rotate counterclockwise solenoid valve Y9 to output 0; if l 8 <n×L8, the right side of the vehicle body is in a dangerous state of collision with the spreader. At this time, the vehicle controller controls the boom lifting proportional valve and the retracting proportional valve to output 0 current, and the spreader controller controls the spreader to rotate clockwise solenoid valve Y10 to output 0.

[0126] The anti-collision procedure for the spreader boom refers to the vehicle controller first obtaining the minimum distance l between the boom and the spreader in six directions through radars G1~G6. 1 ~l 6 If l 1 <n×L1, the left rear side of the spreader is in a dangerous state of colliding with the boom. At this time, the vehicle controller controls the boom lifting proportional valve Y1 and the retracting proportional valve Y4 to output 0 current, and the spreader controller controls the spreader left shift solenoid valve Y5, the spreader opening solenoid valve Y7 and the spreader counterclockwise rotation solenoid valve Y10 to output 0; if l 2 <n×L2, the right rear side of the spreader is in a dangerous state of colliding with the boom. At this time, the vehicle controller controls the boom lifting proportional valve Y1 and the retracting proportional valve Y4 to output 0 current, and the spreader controller controls the spreader right shift solenoid valve Y6, the spreader opening solenoid valve Y7 and the spreader clockwise rotation solenoid valve Y9 to output 0; if l 4 <n×L4, the right front side of the spreader is in a dangerous state of colliding with the boom. At this time, the vehicle controller controls the boom lifting proportional valve Y1 and the retracting proportional valve Y4 to output 0 current, and the spreader controller controls the spreader right shift solenoid valve Y6, the spreader opening solenoid valve Y7 and the spreader counterclockwise rotation solenoid valve Y10 to output 0; if l 5 <n×L5, the left front side of the spreader is in a dangerous state of colliding with the boom. At this time, the vehicle controller controls the boom lifting proportional valve Y1 and the retracting proportional valve Y4 to output 0 current, and controls the spreader left shift solenoid valve Y5, the spreader opening solenoid valve Y7 and the spreader clockwise rotation solenoid valve Y9 to output 0 through the spreader controller; if l 3 <n×L3, the right side of the spreader is in a dangerous state of colliding with the boom. At this time, the vehicle controller controls the boom lifting proportional valve Y1, the extension solenoid valve Y3 and the retraction proportional valve Y4 to output 0 current, and the spreader controller controls the spreader right movement solenoid valve Y6 and the spreader opening solenoid valve Y7 to output 0; if l 4 <n×L4, the left side of the spreader is in a dangerous state of collision with the boom. At this time, the vehicle controller controls the boom lifting proportional valve Y1, the extension solenoid valve Y3 and the retraction proportional valve Y4 to output 0 current, and the spreader controller controls the spreader left movement solenoid valve Y5 and the spreader opening solenoid valve Y7 to output 0.

[0127] See also Figure 2 , Figure 2 A control system signal acquisition schematic diagram of a container reach crane provided in an embodiment of the present application, the container reach crane includes a safety bypass switch, millimeter wave radars G1-G8, a length angle sensor ACQ, an interactive instrument M, a vehicle controller VCU, a boom lifting proportional valve Y1, a boom lowering proportional valve Y2, a boom extension proportional valve Y3, a boom retraction proportional valve Y4, a spreader controller, a spreader left shift valve Y5, a spreader right shift valve Y6, a spreader opening valve Y7, a spreader closing valve Y8, a spreader clockwise valve Y9, and a spreader counterclockwise valve Y10. The vehicle controller VCU can send a spreader action request to the spreader controller. The administrator can set the adjustable parameters of the interactive instrument M, as follows: radar safety threshold L1 corresponding to radar G1, radar safety threshold L2 corresponding to radar G2, radar safety threshold L3 corresponding to radar G3, radar safety threshold L4 corresponding to radar G4, radar safety threshold L5 corresponding to radar G5, radar safety threshold L6 corresponding to radar G6, radar safety threshold L7 corresponding to radar G7, radar safety threshold L8 corresponding to radar G8, safety factor n and angle threshold α.

[0128] See also Figure 3 , Figure 3 A top view of the radar arrangement of a container reach crane provided in an embodiment of the present application shows the directions of front, rear, left, right, clockwise rotation and counterclockwise rotation. G1 represents the first radar, G2 represents the second radar, G3 represents the third radar, G4 represents the fourth radar, G5 represents the fifth radar, G6 represents the sixth radar, and the main beam of the crane is also shown.

[0129] See also Figure 4 , Figure 4 This is a side view of the radar arrangement of a container reach stacker provided in an embodiment of the present application, showing the spreader and the boom, G1 represents the first radar, G5 represents the fifth radar, and G6 represents the sixth radar. Figure 5 , Figure 5 This is an axonometric view of the radar arrangement of a container reach crane provided in an embodiment of the present application, G7 represents the seventh radar, and G8 represents the eighth radar. Please refer to Figure 6, which is an overall side view of a container reach crane provided in an embodiment of the present application, G1 represents the first radar, G5 represents the fifth radar, G6 represents the sixth radar, and G7 represents the seventh radar.

[0130] See also Figure 7 , Figure 7The anti-collision control flow chart of a container front crane provided in the embodiment of the present application is as follows: the vehicle controller obtains the state of the ACQ sensor to obtain the boom lifting angle α, and obtains the state of the safety bypass switch S. Determine whether the safety bypass switch is closed; if so, end the process; if not, determine whether α≤α 1 If α≤α 1 , then execute the body sling anti-collision program and the sling arm anti-collision program; if α>α 1 , the crane boom anti-collision program is executed. The parameters introduced in this embodiment include eight thresholds L1~L8 of radar G1~G8 when the crane is in different dangerous states, the real-time distance l between radar G1~G8 and the nearest obstacle 1 ~l 8 , the angle threshold α of the collision between the arm and the vehicle body 1 , the real-time angle value of the upper arm α and the system safety factor n.

[0131] This embodiment provides a method for preventing a vehicle body from colliding with a sling when the sling is at a low lifting height. This embodiment proposes eight working conditions where the sling may collide with the boom and the vehicle body based on the radar status data, and proposes eight corresponding processing strategies to achieve the purpose of collision prevention. This embodiment proposes a calibration method for the radar safety threshold of the sling for the specific working conditions of the front sling collision prevention, and introduces the radar safety distance threshold L1~L8 and the safety factor n, which increases the adjustable characteristics of the system. Through the scheme of this embodiment, it is only necessary to install millimeter-wave radars in eight designated areas of the main beam of the sling and the front end of the vehicle body. After calibration, the real-time distance between the boom and the sling, the vehicle body and the sling monitored by the radar can be combined with the handle action signal, the length angle sensor signal and the lock status signal to control the related actions of the boom and the sling to avoid the collision problem between the sling and the boom, effectively improving the safety performance and driving experience of the vehicle. This embodiment determines the dangerous state of the spreader by installing millimeter-wave radars at eight specific positions on the main beam of the spreader and the front end of the vehicle body (spreader left rear, spreader left front, spreader left upper, spreader right upper, spreader left front, spreader right front, vehicle body left front, vehicle body right front) to limit the movement of the boom and spreader, avoiding complex and cumbersome calculations and realizing a simpler and more reliable anti-collision strategy. This embodiment solves the problem that when operating the spreader during the container front crane operation, the container or spreader may collide with the boom and vehicle body, so as to improve the active safety and operation experience of the vehicle.

[0132] The embodiment of the present application provides a spreader anti-collision control system for a container reach crane, the container reach crane comprises a body, a boom and a spreader, the body is provided with N body radars, the spreader is provided with M spreader radars, and the spreader anti-collision control system for the container reach crane comprises:

[0133] An angle acquisition module, used to acquire the lifting angle of the boom;

[0134] An angle judgment module, used to judge whether the lifting angle is greater than an angle threshold;

[0135] a first detection module, configured to detect, by using the spreader radar, whether the spreader is in a first critical collision state if the lifting angle is greater than the angle threshold; wherein the first critical collision state is a critical collision state between the spreader and the boom;

[0136] a second detection module, configured to detect whether the spreader is in the first critical collision state by using the spreader radar, and detect whether the spreader is in the second critical collision state by using the vehicle body radar if the lifting angle is less than or equal to the angle threshold; wherein the second critical collision state is a critical collision state between the spreader and the vehicle body;

[0137] A control module is used to perform corresponding control operations on the spreader and the boom if the spreader is in the first collision critical state and / or the second collision critical state, so that the distance between the vehicle body, the boom and the spreader reaches a safe distance.

[0138] The container reach stacker used in this embodiment includes a body, a boom and a spreader, and the body and the spreader are provided with corresponding radars. This embodiment obtains the lifting angle of the boom and adopts a corresponding detection strategy according to the lifting angle. If the lifting angle is greater than the angle threshold, the spreader radar is used to detect whether the spreader is in a critical collision state with the boom; if the lifting angle is less than or equal to the angle threshold, the body radar and the spreader radar are used to detect whether the spreader is in a critical collision state with the body and the boom. When the spreader is detected to be in the first critical collision state or the second critical collision state, this embodiment takes corresponding control measures to make the distance between the body, the boom and the spreader reach a safe distance. This embodiment monitors the lifting angle of the boom and adopts different detection strategies according to different angles, uses the body radar and the spreader radar to accurately detect the state of the spreader, and timely controls the spreader and the boom before a collision occurs to avoid the spreader from colliding with the body or the boom. Therefore, this embodiment can accurately detect the state of the spreader and prevent collisions between the spreader, the boom and the body.

[0139] Further, the spreader radar includes a first radar, a second radar, a third radar, a fourth radar, a fifth radar and a sixth radar, and the vehicle body radar includes a seventh radar and an eighth radar;

[0140] Among them, the first radar is arranged at the left rear side of the spreader, and the signal emission direction of the first radar is the rear of the spreader; the second radar is arranged at the right rear side of the spreader, and the signal emission direction of the second radar is the rear of the spreader; the third radar is arranged at the upper right side of the spreader, and the signal emission direction of the third radar is above the spreader; the fourth radar is arranged at the right front side of the spreader, and the signal emission direction of the fourth radar is in front of the spreader; the fifth radar is arranged at the left front side of the spreader, and the signal emission direction of the fifth radar is in front of the spreader; the sixth radar is arranged at the upper left side of the spreader, and the signal emission direction of the sixth radar is above the spreader; the seventh radar is arranged at the left front side of the vehicle body, and the signal emission direction of the seventh radar is the forward direction of the vehicle body; the eighth radar is arranged at the right front side of the vehicle body, and the signal emission direction of the eighth radar is the forward direction of the vehicle body.

[0141] Furthermore, it also includes:

[0142] a calibration module, used to obtain radar safety thresholds corresponding to the first radar, the second radar, the third radar, the fourth radar, the fifth radar, the sixth radar, the seventh radar, and the eighth radar; and also used to set the product of the radar safety threshold and the safety factor as the critical collision distance of the corresponding radar;

[0143] Among them, if the obstacle distance detected by any one or any several of the first radar, the second radar, the third radar, the fourth radar, the fifth radar and the sixth radar is less than the corresponding critical collision distance, the sling is in the first critical collision state; if the obstacle distance detected by the seventh radar and / or the eighth radar is less than the corresponding critical collision distance, the sling is in the second critical collision state.

[0144] Furthermore, if the spreader is in the second critical collision state, the process in which the control module performs corresponding control operations on the spreader and the boom includes: if the obstacle distance detected by the seventh radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retraction proportional valve of the boom is controlled to be 0, and the output current of the counterclockwise rotation solenoid valve of the spreader is controlled to be 0; if the obstacle distance detected by the eighth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retraction proportional valve of the boom is controlled to be 0, and the output current of the clockwise rotation solenoid valve of the spreader is controlled to be 0.

[0145] Further, if the spreader is in the first critical collision state, the process in which the control module performs corresponding control operations on the spreader and the boom includes: if the obstacle distance detected by the first radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the left shift solenoid valve, the opening solenoid valve and the counterclockwise rotation solenoid valve of the spreader is controlled to be 0; if the obstacle distance detected by the second radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the right shift solenoid valve, the opening solenoid valve and the clockwise rotation solenoid valve of the spreader is controlled to be 0; if the obstacle distance detected by the third radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve, the extension solenoid valve and the retracting proportional valve of the boom is controlled to be 0, And control the output current of the right shift solenoid valve and the opening solenoid valve of the spreader to be 0; if the obstacle distance detected by the fourth radar is less than the corresponding critical collision distance, control the output current of the lifting proportional valve and the retraction proportional valve of the boom to be 0, and control the output current of the right shift solenoid valve, the opening solenoid valve and the counterclockwise rotation solenoid valve of the spreader to be 0; if the obstacle distance detected by the fifth radar is less than the corresponding critical collision distance, control the output current of the lifting proportional valve and the retraction proportional valve of the boom to be 0, and control the output current of the left shift solenoid valve, the opening solenoid valve and the clockwise rotation solenoid valve of the spreader to be 0; if the obstacle distance detected by the sixth radar is less than the corresponding critical collision distance, control the output current of the lifting proportional valve, the extension solenoid valve and the retraction proportional valve of the boom to be 0, and control the output current of the left shift solenoid valve and the opening solenoid valve of the spreader to be 0.

[0146] Furthermore, the process of the calibration module obtaining the radar safety thresholds corresponding to the first radar, the second radar, the third radar, the fourth radar, the fifth radar, the sixth radar, the seventh radar and the eighth radar includes: controlling the lifting angle of the boom to reach the angle threshold, and controlling the spreader to rotate counterclockwise at the left extreme position; after receiving the first stop command, controlling the spreader to stop moving and setting the minimum obstacle distance detected by the first radar as the radar safety threshold corresponding to the first radar; controlling the lifting angle of the boom to reach the angle threshold, and controlling the spreader to rotate clockwise at the right extreme position; after receiving the second stop command, controlling The spreader stops moving and sets the minimum obstacle distance detected by the second radar as the radar safety threshold corresponding to the second radar; controls the lifting angle of the boom to reach 0°, controls the spreader to rotate 90° clockwise at the middle position, and controls the boom to lift; after receiving the third stop command, controls the spreader to stop moving and sets the minimum obstacle distance detected by the third radar as the radar safety threshold corresponding to the third radar; controls the lifting angle of the boom to reach the angle threshold, controls the spreader to rotate 180° clockwise at the middle position and then move to the right limit position, and controls the spreader to rotate counterclockwise at the right limit position; after receiving the fourth stop command, controls The spreader stops moving and sets the minimum obstacle distance detected by the fourth radar as the radar safety threshold corresponding to the fourth radar; controls the lifting angle of the boom to reach the angle threshold, controls the spreader to rotate 180° counterclockwise at the middle position and then move to the left limit position, and controls the spreader to rotate clockwise at the left limit position; after receiving the fifth stop command, controls the spreader to stop moving and sets the minimum obstacle distance detected by the fifth radar as the radar safety threshold corresponding to the fifth radar; controls the lifting angle of the boom to reach 0°, controls the spreader to rotate 90° counterclockwise at the middle position, and controls the boom to lift; after receiving the sixth stop command, controls The spreader stops moving and sets the minimum obstacle distance detected by the sixth radar to the radar safety threshold corresponding to the sixth radar; controls the lifting angle of the boom to reach 0°, and controls the spreader to rotate counterclockwise at the left extreme position; after receiving the seventh stop command, controls the spreader to stop moving and sets the minimum obstacle distance detected by the seventh radar to the radar safety threshold corresponding to the seventh radar; controls the lifting angle of the boom to reach 0°, and controls the spreader to rotate clockwise at the right extreme position; after receiving the eighth stop command, controls the spreader to stop moving and sets the minimum obstacle distance detected by the eighth radar to the radar safety threshold corresponding to the eighth radar.

[0147] Furthermore, it also includes:

[0148] An angle threshold determination module is used to determine the angle threshold according to the structure and size of the container reach crane before judging whether the lifting angle is greater than the angle threshold; wherein the angle threshold is the minimum lifting angle that meets the preset conditions, wherein the preset conditions are that the spreader or container does not collide with the vehicle body.

[0149] Since the embodiments of the system part correspond to the embodiments of the method part, please refer to the description of the embodiments of the method part for the embodiments of the system part, which will not be repeated here.

[0150] The present application also provides a storage medium on which a computer program is stored, and when the computer program is executed, the steps provided in the above embodiment can be implemented. The storage medium may include: a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk, and other media that can store program codes.

[0151] The present application also provides an electronic device, which may include a memory and a processor, wherein a computer program is stored in the memory, and when the processor calls the computer program in the memory, the steps provided in the above embodiment may be implemented. Of course, the electronic device may also include various network interfaces, power supplies and other components.

[0152] The various embodiments in the specification are described in a progressive manner, and each embodiment focuses on the differences from other embodiments. The same and similar parts between the various embodiments can be referred to each other. For the system disclosed in the embodiment, since it corresponds to the method disclosed in the embodiment, the description is relatively simple, and the relevant parts can be referred to the method part description. It should be pointed out that for ordinary technicians in this technical field, without departing from the principles of this application, several improvements and modifications can be made to the present application, and these improvements and modifications also fall within the scope of protection of this application.

[0153] It should also be noted that, in this specification, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "comprises", "comprising" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, an element defined by the statement "comprising a ..." does not exclude the presence of other identical elements in the process, method, article or device including the element.

Claims

1. A method for controlling the anti-collision of a container reach crane, characterized in that: The container reach stacker includes a body, a boom and a spreader, the body is provided with N body radars, the spreader is provided with M spreader radars, and the spreader anti-collision control method of the container reach stacker includes: Obtaining the lifting angle of the boom; Determining whether the lifting angle is greater than an angle threshold; If so, the spreader radar is used to detect whether the spreader is in a first critical collision state; wherein the first critical collision state is a critical collision state between the spreader and the boom; If not, the spreader radar is used to detect whether the spreader is in the first critical collision state, and the vehicle body radar is used to detect whether the spreader is in the second critical collision state; wherein the second critical collision state is a critical collision state between the spreader and the vehicle body; If the spreader is in the first critical collision state and / or the second critical collision state, corresponding control operations are performed on the spreader and the boom so that the distance between the vehicle body, the boom and the spreader reaches a safe distance.

2. The method for controlling the anti-collision of the spreader of a container front crane according to claim 1, characterized in that: The sling radar includes a first radar, a second radar, a third radar, a fourth radar, a fifth radar and a sixth radar, and the vehicle body radar includes a seventh radar and an eighth radar; Among them, the first radar is arranged at the left rear side of the spreader, and the signal emission direction of the first radar is the rear of the spreader; the second radar is arranged at the right rear side of the spreader, and the signal emission direction of the second radar is the rear of the spreader; the third radar is arranged at the upper right side of the spreader, and the signal emission direction of the third radar is above the spreader; the fourth radar is arranged at the right front side of the spreader, and the signal emission direction of the fourth radar is in front of the spreader; the fifth radar is arranged at the left front side of the spreader, and the signal emission direction of the fifth radar is in front of the spreader; the sixth radar is arranged at the upper left side of the spreader, and the signal emission direction of the sixth radar is above the spreader; the seventh radar is arranged at the left front side of the vehicle body, and the signal emission direction of the seventh radar is the forward direction of the vehicle body; the eighth radar is arranged at the right front side of the vehicle body, and the signal emission direction of the eighth radar is the forward direction of the vehicle body.

3. The method for controlling the anti-collision of the spreader of a container front crane according to claim 2, characterized in that: Before using the spreader radar to detect whether the spreader is in the first collision critical state and / or the second collision critical state, the method further includes: acquiring radar safety thresholds corresponding to the first radar, the second radar, the third radar, the fourth radar, the fifth radar, the sixth radar, the seventh radar, and the eighth radar; The product of the radar safety threshold and the safety factor is set as the collision critical distance of the corresponding radar; Among them, if the obstacle distance detected by any one or any several of the first radar, the second radar, the third radar, the fourth radar, the fifth radar and the sixth radar is less than the corresponding critical collision distance, the sling is in the first critical collision state; if the obstacle distance detected by the seventh radar and / or the eighth radar is less than the corresponding critical collision distance, the sling is in the second critical collision state.

4. The method for controlling the anti-collision of the spreader of the container reach crane according to claim 3 is characterized in that: If the spreader is in the second collision critical state, corresponding control operations are performed on the spreader and the boom, including: If the obstacle distance detected by the seventh radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the counterclockwise rotation solenoid valve of the spreader is controlled to be 0; If the obstacle distance detected by the eighth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the clockwise rotation solenoid valve of the spreader is controlled to be 0.

5. The method for controlling the anti-collision of the spreader of the container reach crane according to claim 3, characterized in that: If the spreader is in the first collision critical state, corresponding control operations are performed on the spreader and the boom, including: If the obstacle distance detected by the first radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the left shift solenoid valve, the opening solenoid valve and the counterclockwise rotation solenoid valve of the spreader is controlled to be 0; If the obstacle distance detected by the second radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the right shift solenoid valve, the opening solenoid valve and the clockwise rotation solenoid valve of the spreader is controlled to be 0; If the obstacle distance detected by the third radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve, the extension solenoid valve and the retraction proportional valve of the boom is controlled to be 0, and the output current of the right shift solenoid valve and the opening solenoid valve of the spreader is controlled to be 0; If the obstacle distance detected by the fourth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the right shift solenoid valve, the opening solenoid valve and the counterclockwise rotation solenoid valve of the spreader is controlled to be 0; If the obstacle distance detected by the fifth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve and the retracting proportional valve of the boom is controlled to be 0, and the output current of the left shift solenoid valve, the opening solenoid valve and the clockwise rotation solenoid valve of the spreader is controlled to be 0; If the obstacle distance detected by the sixth radar is less than the corresponding critical collision distance, the output current of the lifting proportional valve, the extension solenoid valve and the retraction proportional valve of the boom is controlled to be 0, and the output current of the left shift solenoid valve and the opening solenoid valve of the spreader is controlled to be 0.

6. The method for controlling the anti-collision of the spreader of the container reach crane according to claim 3, characterized in that: Acquiring radar safety thresholds corresponding to the first radar, the second radar, the third radar, the fourth radar, the fifth radar, the sixth radar, the seventh radar, and the eighth radar, including: Control the lifting angle of the boom to reach the angle threshold, and control the spreader to rotate counterclockwise at the left limit position; after receiving the first stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the first radar as the radar safety threshold corresponding to the first radar; Control the lifting angle of the boom to reach the angle threshold, and control the spreader to rotate clockwise at the right limit position; after receiving the second stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the second radar as the radar safety threshold corresponding to the second radar; Control the lifting angle of the boom to reach 0°, control the spreader to rotate 90° clockwise at the middle position, and control the boom to lift; after receiving the third stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the third radar as the radar safety threshold corresponding to the third radar; Control the lifting angle of the boom to reach the angle threshold, control the spreader to rotate 180° clockwise at the middle position and then move to the right limit position, and control the spreader to rotate counterclockwise at the right limit position; after receiving the fourth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the fourth radar as the radar safety threshold corresponding to the fourth radar; Control the lifting angle of the boom to reach the angle threshold, control the spreader to rotate 180° counterclockwise at the middle position and then move to the left limit position, and control the spreader to rotate clockwise at the left limit position; after receiving the fifth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the fifth radar as the radar safety threshold corresponding to the fifth radar; Control the lifting angle of the boom to reach 0°, control the spreader to rotate 90° counterclockwise at the middle position, and control the boom to lift; after receiving the sixth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the sixth radar as the radar safety threshold corresponding to the sixth radar; Control the lifting angle of the boom to reach 0°, and control the spreader to rotate counterclockwise at the left limit position; after receiving the seventh stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the seventh radar as the radar safety threshold corresponding to the seventh radar; Control the lifting angle of the boom to reach 0°, and control the spreader to rotate clockwise at the right extreme position; after receiving the eighth stop command, control the spreader to stop moving and set the minimum obstacle distance detected by the eighth radar as the radar safety threshold corresponding to the eighth radar.

7. The method for controlling the spreader anti-collision of a container reach crane according to any one of claims 1 to 6, characterized in that: Before determining whether the lifting angle is greater than the angle threshold, the method further includes: The angle threshold is determined according to the structure and size of the container reach crane; wherein the angle threshold is a minimum lifting angle that meets a preset condition, and the preset condition is that the spreader or container does not collide with the vehicle body.

8. A container reach crane anti-collision control system, characterized in that: The container reach stacker includes a body, a boom and a spreader, the body is provided with N body radars, the spreader is provided with M spreader radars, and the spreader anti-collision control system of the container reach stacker includes: An angle acquisition module, used to acquire the lifting angle of the boom; An angle judgment module, used to judge whether the lifting angle is greater than an angle threshold; a first detection module, configured to detect, by using the spreader radar, whether the spreader is in a first critical collision state if the lifting angle is greater than the angle threshold; wherein the first critical collision state is a critical collision state between the spreader and the boom; a second detection module, configured to detect whether the spreader is in the first critical collision state by using the spreader radar, and detect whether the spreader is in the second critical collision state by using the vehicle body radar if the lifting angle is less than or equal to the angle threshold; wherein the second critical collision state is a critical collision state between the spreader and the vehicle body; A control module is used to perform corresponding control operations on the spreader and the boom if the spreader is in the first collision critical state and / or the second collision critical state, so that the distance between the vehicle body, the boom and the spreader reaches a safe distance.

9. An electronic device, characterized in that: It comprises a memory and a processor, wherein the memory stores a computer program, and when the processor calls the computer program in the memory, it implements the steps of the method for anti-collision control of the spreader of the container front crane as claimed in any one of claims 1 to 7.

10. A storage medium, characterized in that: The storage medium stores computer executable instructions, and when the computer executable instructions are loaded and executed by the processor, the steps of the container reach crane's spreader anti-collision control method as claimed in any one of claims 1 to 7 are implemented.