Cage socket position detection method and cage handling and stacking method
By setting a reflector on the cage and using a 2D laser scanner to detect its position, the problem of low accuracy of jack position detection in the prior art is solved, and high accuracy and ease of use are achieved, and different specifications and environments are adapted to different specifications and environments. Change detection method.
Patent Information
- Application Number
- CN202011117759.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2020-10-19
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2040-10-19
AI Technical Summary
The existing material cage jack position detection technology has low accuracy, limited scope of application, poor maintenance, and is easily affected by environmental interference.
Set two reflectors on the cage and install a 2D laser scanner on the fork arm of the AGV. The jack position is calculated by scanning the distance and position information of the reflector, reducing the dependence on the cage size and improving the accuracy of detection and anti-interference ability.
It improves the accuracy of jack position detection, simplifies the operation process, enhances maintenance and anti-interference capabilities, and adapts to different specifications and environmental changes.
Smart Images

Figure CN112327320B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of intelligent and safe transportation technology, and in particular to a cage insertion hole posture detection method and a cage handling and stacking method. Background Art
[0002] At present, most of the automated guided vehicles (AGVs) on the market are used to stack cages. When stacking cages, the AGV must first detect the position of the cage's insertion hole, and then extend the fork on the AGV into the insertion hole to stack the cage.
[0003] The existing cage socket position detection technology solution usually enters the cage information into the AGV, scans the size of the cage vertical beam by laser, matches the cage information with the width, and then calculates the position of the socket, or first pastes a QR code with the entered information on the cage, and then calculates the position of the socket by reading the QR code information pasted on the cage;
[0004] However, when the sizes of the vertical beams of various types of cages are different, the detection distance of the traditional method will be limited by the performance of the sensor, and its scope of application will be restricted. At the same time, for the same batch of cages, the width of the vertical beams of the cages is consistent, but the position and width of the sockets are inconsistent, resulting in inaccurate calculation of the socket posture based entirely on the type of cage, and low accuracy. For different batches of the same type of cages with different specifications, the traditional method requires the use of equipment to enter the QR code information, which is complicated and difficult to operate. Information must be entered for each cage, with low maintainability and weak adaptability. In addition, the camera is easily affected by the surrounding environment when detecting the QR code information, and has poor anti-interference ability. Summary of the invention
[0005] Based on this, it is necessary to provide a method for detecting the position and posture of a cage socket and a method for transporting and stacking a cage to address the problem of low accuracy in the existing detection of the position and posture of the cage socket.
[0006] The present invention provides a method for detecting the position and posture of a cage plug hole, the method comprising:
[0007] Set the two reflectors correspondingly above the two sockets on the cage;
[0008] The 2D laser scanner is set on the fork arm of the counterbalanced AGV;
[0009] The counterbalanced AGV runs to the detection point, lifts the fork arm and turns on the 2D laser scanner, and when the 2D laser scanner scans the reflective element, the fork arm stops moving;
[0010] Scanning the two reflectors by the 2D laser scanner, calculating the distance between the two reflectors, the distance between the 2D laser scanner and the reflector, and the height information of the reflector from the horizontal plane;
[0011] The 2D laser scanner sends the distance between the two reflectors, the distance between the 2D laser scanner and the reflector, and the height information of the reflector from the horizontal plane to the controller on the counterbalanced AGV, and the controller obtains the position information of the socket based on the data information of the reflector.
[0012] The above-mentioned cage socket position detection method obtains the position information of the socket by detecting the position information of the reflector, and the overall detection result has high accuracy. Since the detection is no longer the vertical beam of the cage, it is not related to the size of the cage and will not affect the detection distance. At the same time, since the reflector is set directly above the cage socket, even if the specifications of the cage change, the socket position change detection result is still only related to the detected reflector position. Furthermore, since the detection method is only related to the position of the reflector, there is no need to enter any parameters related to the cage in advance. The overall method is simple and easy to use, and has strong maintainability. The reflector is a highly reflective material, which can be distinguished from the surrounding environment and is easy to distinguish, so it has strong anti-interference ability.
[0013] In one embodiment, after the counterbalanced AGV runs to the detection point, lifts the fork arm and turns on the 2D laser scanner, the method further includes:
[0014] When the 2D laser scanner fails to scan the reflector, the fork arm is lowered to scan again.
[0015] In one of the embodiments, the height of the reflective element from the horizontal plane is: the height to which the fork arm is lifted when scanning the reflective element.
[0016] In one embodiment, the controller obtains the position information of the jack according to the data information of the reflective element, including:
[0017] The controller acquires the distance between the two sockets according to the distance between the two reflective elements;
[0018] The controller acquires the distance between the socket and the fork arm according to the distance between the 2D laser scanner and the reflector;
[0019] The controller obtains the height of the jack from the horizontal plane according to the height of the reflector from the horizontal plane minus the width of the reflector.
[0020] In one embodiment, before the two reflectors are correspondingly arranged directly above the two insertion holes on the cage, the method further comprises:
[0021] The material cage is placed on a preset horizontal platform.
[0022] In one of the embodiments, the reflective element comprises a reflective tape, and the reflective tape is pasted directly above the insertion hole on the cage.
[0023] The present invention also provides a cage transport and stacking method, comprising the cage plug-in position detection method as described in any one of the embodiments of the present application, the method further comprising:
[0024] The counterbalanced AGV controls the fork arm to be inserted into the insertion hole and simultaneously lifts the fork arm;
[0025] Turning on the 2D laser scanner, the 2D laser scanner scans the position information of another cage and sends the scanned information to the controller;
[0026] The counterbalanced AGV moves to another material cage, and at the same time, the counterbalanced AGV controls the fork arm to stack the material cage on the fork arm onto another material cage.
[0027] In one embodiment, the 2D laser scanner scans the position information of another cage, including:
[0028] Determine whether the 2D laser scanner has scanned the position information of the reflective element on another material cage, and if the reflective element on the other material cage is not scanned, lower the fork arm to scan again;
[0029] If a reflective member on another material cage is scanned, the fork arm continues to be lifted at the same time. When the 2D laser scanner scans the top surface of another material cage, the fork arm stops moving, and the 2D laser scanner sends the scanned reflective member information on the other material cage and the top surface information of the other material cage to the controller.
[0030] In one embodiment, sending the scanned information to the controller includes:
[0031] After the 2D laser scanner sends the scanned reflective member information on another material cage and the top surface information of another material cage to the controller.
[0032] In one embodiment, after the counterbalanced AGV controls the fork arm to stack the cage on the fork arm onto another cage, the method further comprises:
[0033] The counterbalanced AGV controls the fork arm to return to the initial state. BRIEF DESCRIPTION OF THE DRAWINGS
[0034] Figure 1 A flow chart of cage plug position detection provided by one embodiment of the present invention;
[0035] Figure 2 A schematic diagram of a cage provided in accordance with an embodiment of the present invention;
[0036] Figure 3 A schematic diagram of the running trajectory of a counterbalanced AGV is provided for one embodiment of the present invention. DETAILED DESCRIPTION
[0037] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, the specific embodiments of the present invention are described in detail below in conjunction with the accompanying drawings. In the following description, many specific details are set forth to facilitate a full understanding of the present invention. However, the present invention can be implemented in many other ways different from those described herein, and those skilled in the art can make similar improvements without violating the connotation of the present invention, so the present invention is not limited by the specific embodiments disclosed below.
[0038] In the description of the present invention, it should be understood that the terms "center", "longitudinal", "lateral", "length", "width", "thickness", "up", "down", "front", "back", "left", "right", "vertical", "horizontal", "top", "bottom", "inside", "outside", "clockwise", "counterclockwise", "axial", "radial", "circumferential" and the like indicate orientations or positional relationships based on the orientations or positional relationships shown in the accompanying drawings, and are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the referred device or element must have a specific orientation, be constructed and operated in a specific orientation, and therefore should not be understood as limiting the present invention.
[0039] In addition, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Therefore, the features defined as "first" and "second" may explicitly or implicitly include at least one of the features. In the description of the present invention, the meaning of "plurality" is at least two, such as two, three, etc., unless otherwise clearly and specifically defined.
[0040] In the present invention, unless otherwise clearly specified and limited, the terms "installed", "connected", "connected", "fixed" and the like should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection or an indirect connection through an intermediate medium, it can be the internal connection of two elements or the interaction relationship between two elements, unless otherwise clearly defined. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0041] In the present invention, unless otherwise clearly specified and limited, a first feature being "above" or "below" a second feature may mean that the first and second features are in direct contact, or the first and second features are in indirect contact through an intermediate medium. Moreover, a first feature being "above", "above" or "above" a second feature may mean that the first feature is directly above or obliquely above the second feature, or simply means that the first feature is higher in level than the second feature. A first feature being "below", "below" or "below" a second feature may mean that the first feature is directly below or obliquely below the second feature, or simply means that the first feature is lower in level than the second feature.
[0042] It should be noted that when an element is referred to as being "fixed to" or "disposed on" another element, it may be directly on the other element or there may be a central element. When an element is considered to be "connected to" another element, it may be directly connected to the other element or there may be a central element at the same time. The terms "vertical", "horizontal", "upper", "lower", "left", "right" and similar expressions used herein are for illustrative purposes only and are not intended to be the only implementation method.
[0043] like Figure 1 Combined with Figure 2 , Figure 3 As shown, in one embodiment of the present invention, a method for detecting the position and posture of a cage plug hole is provided, the method comprising:
[0044] Step 110: The two reflective members 03 are correspondingly arranged directly above the two insertion holes 02 on the cage 01;
[0045] Step 120: Setting the 2D laser scanner 05 on the fork arm 041 on the counterweight AGV 04;
[0046] Specifically, the 2D laser scanner 05 is located between two forks 042 on the counterbalanced AGV, and the 2D laser scanner and the forks are located on the same horizontal plane;
[0047] Step 130: The counterweight AGV04 moves to the detection point, lifts the fork arm 041 and turns on the 2D laser scanner 05. When the 2D laser scanner 05 scans the reflective element, the fork arm 041 stops moving;
[0048] Specifically, when the counterbalanced AGV04 runs to the detection point, the counterbalanced AGV controls the fork arm to rise and turns on the 2D laser scanner. When the 2D laser scanner scans the reflective element, the counterbalanced AGV controls the fork arm to stop moving.
[0049] Step 140: Scan the two reflectors 03 with the 2D laser scanner 05 to calculate the distance between the two reflectors 03, the distance between the 2D laser scanner 05 and the reflector 03, and the height information of the reflector 03 from the horizontal plane;
[0050] Specifically, the two reflective elements 03 on the cage 01 are detected by the infrared laser pulses emitted by the 2D laser scanner, and the processor in the 2D laser scanner automatically calculates the distance between the two reflective elements 03;
[0051] The processor in the 2D laser scanner converts the time data into a distance value based on the time interval of the infrared laser pulse emitted by the 2D laser scanner and reflected from the reflector, thereby calculating the distance between the 2D laser scanner and the reflector.
[0052] The height of the reflector from the horizontal plane can be obtained by recording the height of the fork arm when it scans the reflector through the controller on the counterbalanced AGV;
[0053] Step 150: The 2D laser scanner 05 sends the distance between the two reflectors 03, the distance between the 2D laser scanner and the reflector, and the height information of the reflector from the horizontal plane to the controller on the counterweight AGV04, and the controller obtains the position information of the socket 02 based on the above data information.
[0054] By adopting the above technical scheme, the position information of the socket is obtained by detecting the position information of the reflector, and the overall detection result has a high accuracy rate. Since the detection is no longer the vertical beam of the cage, it is not related to the size of the cage and will not affect the detection distance. At the same time, since the reflector is set directly above the cage socket, even if the specifications of the cage change, the detection result of the socket position change is still only related to the detected reflector position. Furthermore, since the detection method is only related to the position of the reflector, there is no need to enter any parameters related to the cage in advance. The overall method is simple and easy to use, and has strong maintainability. The reflector is a highly reflective material, which can be distinguished from the surrounding environment and is easy to distinguish, so it has strong anti-interference ability.
[0055] In some embodiments, in order to avoid the 2D laser scanner failing to detect the reflective member, when the counterbalanced AGV of the present application runs to the detection point, the fork arm is raised and the 2D laser scanner is turned on, the method further includes:
[0056] When the 2D laser scanner does not scan the reflector, the fork arm is lowered to scan again.
[0057] In some embodiments, the controller in the present application obtains the position information of the jack according to the data information of the reflective member, including:
[0058] The controller obtains the distance between the two sockets according to the distance between the two reflectors;
[0059] The controller obtains the distance between the socket and the fork arm according to the distance between the 2D laser scanner and the reflector;
[0060] The controller obtains the height of the jack from the horizontal plane according to the height of the reflector from the horizontal plane minus the width of the reflector.
[0061] Specifically, Figure 2 As shown, since the two reflectors 03 are correspondingly arranged directly above the two sockets 02, when the distance between the two reflectors 03 is calculated by the processor in the 2D laser scanner, the distance is the distance between the two sockets. At this time, the processor in the 2D laser scanner sends the calculation result to the controller in the counterbalanced AGV, and the controller can obtain the distance between the two sockets.
[0062] like Figure 3 As shown, since the 2D laser scanner is arranged on the fork arm and the reflector is arranged just above the socket, the distance between the 2D laser scanner and the reflector is equal to the distance between the fork arm and the socket. After the processor in the 2D laser scanner calculates the distance between the 2D laser scanner and the reflector, the 2D laser scanner sends the result calculated by the processor to the controller in the counterbalanced AGV, and the controller can obtain the distance between the fork arm and the socket.
[0063] Since the height recorded by the controller on the counterbalanced AGV when the fork arm scans the reflector is equal to the height of the reflector from the horizontal plane, and the width of the reflector is a known quantity, when it is necessary to calculate the height of the socket from the horizontal plane, the height of the socket from the horizontal plane can be obtained by subtracting the width of the reflector from the height of the reflector from the horizontal plane through the controller.
[0064] In some embodiments, in order to facilitate the insertion and removal of the cage, Figure 3 As shown, before the two reflective members are correspondingly arranged directly above the two insertion holes on the material cage, the method also includes: placing the material cage on a preset horizontal platform 07.
[0065] In some embodiments, the reflective member in the present application includes a reflective tape, which is pasted directly above the insertion hole on the cage.
[0066] It should be noted that the reflective tape material of the reflective member in the embodiment of the present application is only an example, and other materials may be used in other alternative solutions, for example, the reflective member is a reflector. The present application does not impose any special restrictions on the specific material of the reflective member, as long as the above material can achieve the purpose of the present application.
[0067] The present invention also provides a cage transport and stacking method, including a cage plug position detection method as described in any one of the embodiments of the present application. Figure 3 As shown, the method also includes:
[0068] The counterweight AGV04 controls the fork arm 041 to move to the material cage 01, and controls the fork 042 on the fork arm 041 to be inserted into the socket 02, and lifts the fork arm 041 at the same time;
[0069] Then the 2D laser scanner is turned on to scan the position information of the reflective element on another material cage 06 .
[0070] Among them, the 2D laser scanner scans the position information of the reflector on another material cage, including: judging whether the 2D laser scanner scans the position information of the reflector on another material cage, if the reflector on the other material cage is not scanned, lowering the fork arm to rescan; if the reflector on the other material cage is scanned, the fork arm continues to be lifted at the same time, when the 2D laser scanner scans the top surface of the other material cage, the fork arm stops moving, and the 2D laser scanner sends the scanned reflector information on the other material cage and the top surface information of the other material cage to the controller.
[0071] After the 2D laser scanner sends the scanned reflector information on another cage and the top surface information of another cage to the controller, Figure 3 As shown, the counterbalanced AGV moves to another material cage 06 , and at the same time, the counterbalanced AGV controls the fork arm to stack the material cage 01 on the fork arm onto another material cage 06 .
[0072] In some embodiments, after the counterbalanced AGV controls the fork arm to stack the material cage on the fork arm onto another material cage, the method further includes: the counterbalanced AGV controls the fork arm to return to an initial state.
[0073] The technical features of the above-described embodiments may be arbitrarily combined. To make the description concise, not all possible combinations of the technical features in the above-described embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.
[0074] The above-mentioned embodiments only express several implementation methods of the present invention, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the invention patent. It should be pointed out that, for ordinary technicians in this field, several variations and improvements can be made without departing from the concept of the present invention, and these all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention shall be subject to the attached claims.
Claims
1. A method for detecting the position and posture of a cage plug hole, characterized in that: The method includes: Set the two reflectors correspondingly above the two sockets on the cage; The 2D laser scanner is set on the fork arm of the counterbalanced AGV; The counterbalanced AGV runs to the detection point, lifts the fork arm and turns on the 2D laser scanner, and when the 2D laser scanner scans the reflective element, the fork arm stops moving; Scanning the two reflectors by the 2D laser scanner, calculating the distance between the two reflectors, the distance between the 2D laser scanner and the reflector, and the height information of the reflector from the horizontal plane; The 2D laser scanner sends the distance between the two reflectors, the distance between the 2D laser scanner and the reflector, and the height information of the reflector from the horizontal plane to the controller on the counterbalanced AGV, and the controller obtains the position information of the socket according to the data information of the reflector; The controller obtains the position information of the jack according to the data information of the reflective element, including: The controller acquires the distance between the two sockets according to the distance between the two reflective elements; The controller acquires the distance between the socket and the fork arm according to the distance between the 2D laser scanner and the reflector; The controller obtains the height of the jack from the horizontal plane according to the height of the reflector from the horizontal plane minus the width of the reflector.
2. The method for detecting the position and posture of the cage jack according to claim 1, characterized in that: After the counterbalanced AGV runs to the detection point, the fork arm is lifted and the 2D laser scanner is turned on, the method further includes: When the 2D laser scanner fails to scan the reflector, the fork arm is lowered to scan again.
3. The method for detecting the position and posture of the cage jack according to claim 1, characterized in that: The height of the reflector from the horizontal plane is: the height to which the fork arm is lifted when scanning the reflector.
4. The method for detecting the position and posture of the cage jack according to claim 1, characterized in that: Before the two reflectors are correspondingly arranged directly above the two insertion holes on the cage, the method further comprises: The material cage is placed on a preset horizontal platform.
5. The method for detecting the position and posture of the cage jack according to claim 1, characterized in that: The reflective element comprises a reflective sticker, and the reflective sticker is pasted just above the insertion hole on the cage.
6. A method for transporting and stacking material cages, characterized in that: The method for detecting the position and posture of a cage plug hole according to any one of claims 1 to 5 further comprises: The counterbalanced AGV controls the fork arm to be inserted into the insertion hole and simultaneously lifts the fork arm; Turning on the 2D laser scanner, the 2D laser scanner scans the position information of another cage and sends the scanned information to the controller; The counterbalanced AGV moves to another material cage, and at the same time, the counterbalanced AGV controls the fork arm to stack the material cage on the fork arm onto another material cage.
7. The cage transport and stacking method according to claim 6, characterized in that: The 2D laser scanner scans the position information of another cage, including: Determine whether the 2D laser scanner has scanned the position information of the reflective element on another material cage, and if the reflective element on the other material cage is not scanned, lower the fork arm to scan again; If a reflective member on another material cage is scanned, the fork arm continues to be lifted at the same time. When the 2D laser scanner scans the top surface of another material cage, the fork arm stops moving, and the 2D laser scanner sends the scanned reflective member information on the other material cage and the top surface information of the other material cage to the controller.
8. The cage transport and stacking method according to claim 7, characterized in that: The step of sending the scanned information to the controller includes: The 2D laser scanner sends the scanned reflective member information on another material cage and the top surface information of another material cage to the controller.
9. The cage transporting and stacking method according to claim 6, characterized in that: After the counterbalanced AGV controls the fork arm to stack the material cage on the fork arm onto another material cage, the method further includes: the counterbalanced AGV controls the fork arm to return to an initial state.
