A point cloud sampling system and method based on laser radar scanning angle switching

Through the point cloud sampling system with lidar scanning angle switching, the three-dimensional lidar scanning system is realized quickly, accurately locking and efficient acquisition, solving the problem of low data storage and identification efficiency in driverless vehicles, reducing costs and improving Recognition accuracy.

CN114322828BActive Publication Date: 2024-12-03YUNNAN KUNGANG ELECTRONICS INFORMATION TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202111535589.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-12-15
Publication Date
2024-12-03
Estimated Expiration
2041-12-15

AI Technical Summary

Technical Problem

The prior art is difficult to quickly and accurately control the three-dimensional lidar scanning system to lock the target, collect high-density raw point cloud data, shorten the scanning and sampling period, reduce data storage space and improve identification efficiency.

Method used

Adopt a point cloud sampling system based on lidar scanning angle switching, and control the gimbal and two-dimensional lidar scanner through the control module to realize large-angle and small-angle scanning interval switching, collect point cloud data in the stacking area and packaging area, combined with The identification calculation module calculates the stacking position and coordinates of the object to be hung.

Benefits of technology

It realizes fast and accurate identification of driverless driving systems, reduces data storage space requirements, improves identification efficiency, solves tasks that can only be completed by combining multiple system modules, and reduces costs.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114322828B_ABST
    Figure CN114322828B_ABST
Patent Text Reader

Abstract

The present invention relates to a point cloud sampling system and method based on laser radar scanning angle switching, and belongs to the technical field of unmanned driving of steel stacking. The system includes a control system, a three-dimensional laser radar scanning system and a human-machine interface; the control system includes a control module, a power module, a storage module and an identification calculation module; the three-dimensional laser radar scanning system includes a pan-tilt head and a two-dimensional laser radar scanner; the control module of the present invention controls the three-dimensional laser radar scanning system to accurately scan the profile bundles, bar bundles or disc bundles and their stacking positions in the packaging area; flexibly switch the scanning angle interval and select the appropriate scanning point; so as to realize the small-angle range scanning of the packaging area, the panoramic scanning of the stacking area and the small-angle range scanning of the stacking position in the stacking area. The system of the present invention is practical and novel, with low equipment cost and easy to promote and apply.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of unmanned driving of steel stacking vehicles, and in particular relates to a point cloud sampling system and method based on laser radar scanning angle switching. Background Art

[0002] With the development of automation and identification and positioning technology, unmanned driving in steel mills has become a trend. The 3D laser radar scanning system is like the eyes of the unmanned driving vehicle. It scans and identifies the location coordinates of profile bundles, bar bundles, coil bundles and their stacks, and transmits them to the PLC through the network to control the automatic operation of the driving vehicle.

[0003] Profile bundles are rectangular in cross-section and are stacked in multiple layers in a close forward direction. Bar bundles are elliptical in cross-section and are stacked in multiple layers in a cross-shaped pattern. Round bundles are placed on the arc side of a hollow cylinder and are stacked in multiple layers side by side in a close and ascending layer. The warehouse environment is gray and black, and the identification between the hoisted objects and the environment is weak. Image recognition technology is greatly affected by light, so 3D laser radar scanning recognition technology is selected.

[0004] "A method and system for recognizing contours and calculating coordinates based on a plane-like multi-height layer" solves the problems of inputting raw point clouds, recognizing and calculating, and outputting position coordinates. However, how to control the 3D laser radar scanning system to quickly and accurately scan the target, collect effective and high-density raw point cloud data, shorten the scanning and sampling cycle, reduce data storage space, and improve recognition efficiency is an urgent problem to be solved. Summary of the invention

[0005] The purpose of the present invention is to solve the deficiencies of the prior art and provide a point cloud sampling system and method based on laser radar scanning angle switching. The method solves how the control module of the unmanned driving system controls the three-dimensional laser radar scanning system to quickly and accurately lock the target scan, collect effective and high-density original point clouds, ensure recognition accuracy, shorten the scanning and sampling cycle, reduce the storage space of sampled data and improve recognition efficiency.

[0006] To achieve the above purpose, the technical solution adopted by the present invention is as follows:

[0007] A point cloud sampling system based on laser radar scanning angle switching, including a control system, a three-dimensional laser radar scanning system and a human-machine interface;

[0008] The control system includes a control module, a power module, a storage module and an identification and calculation module;

[0009] The 3D LiDAR scanning system includes a gimbal and a 2D LiDAR scanner;

[0010] The power module is used to supply power to the control system;

[0011] The control module is used to control the operation of the pan / tilt and the two-dimensional laser radar scanner, and collect the three-dimensional point cloud data samples obtained by the three-dimensional laser radar scanning system and store them in the storage module;

[0012] The recognition and calculation module is used to recognize and calculate the small-angle scanning points in the stacking area, the coordinates of the stacking position in the stacking area, and the coordinates of the objects being hoisted in the packaging area;

[0013] The storage module is also used to record the absolute coordinates of the small-angle scanning points in the stacking area obtained by the recognition calculation module and the current scanning angle interval mark of the pan / tilt switch controlled by the power-off storage control module;

[0014] The gimbal is used to carry a two-dimensional laser radar scanner and rotate it to form a three-dimensional scanning area;

[0015] The 2D LiDAR scanner is installed on the traveling trolley;

[0016] The human-machine interface is used to set the absolute coordinates of the large-angle scanning points in the stacking area and the small-angle scanning points in the packaging area, and transmit them to the PLC of the driving;

[0017] When the vehicle drives to the large-angle scanning point, small-angle scanning point and small-angle scanning point of the stacking area, the PLC of the vehicle sends an arrival signal to the control module. The control module controls the pan / tilt and two-dimensional laser radar scanner to collect data. The recognition and calculation module performs recognition and calculation based on the collected data to obtain the coordinates of the next small-angle scanning point of the stacking area, the stacking position coordinates of the stacking area and the coordinates of the objects to be hoisted in the packaging area.

[0018] Furthermore, preferably, the human-machine interface is also used to send automatic operation start, automatic operation stop and reset instructions for the crane, switch the crane's automatic operation or manual remote control operation mode, perform zero point correction of the crane's absolute xyz coordinate system (to clear the encoder's accumulated errors), and display the coordinate data sent by the control system to the crane's PLC.

[0019] Furthermore, preferably, the pan / tilt rotation direction is perpendicular to the trolley beam, and the laser scanning direction is parallel to the trolley beam; when the three-dimensional laser radar scanning system scans, the three-dimensional laser radar scanning system is used as the reference xyz relative coordinate system origin, and the trolley zero (right) limit point, the trolley zero (right) limit point and the lifting height limit point of the lifting mechanism of the crane are used as the reference xyz absolute coordinate system origin, the x-axis corresponds to the trolley movement direction, the y-axis corresponds to the trolley movement direction, and the z-axis corresponds to the lifting mechanism lifting direction.

[0020] Furthermore, preferably, the pan-tilt rotation direction is parallel to the vehicle beam, and the laser scanning direction is perpendicular to the vehicle beam.

[0021] The present invention also provides a point cloud sampling method based on laser radar scanning angle switching, using the above-mentioned point cloud sampling system based on laser radar scanning angle switching, comprising the following steps:

[0022] S1. Laser radar initialization: The control module sends a command to initialize the gimbal, set the scanning start angle, end angle and angular velocity; the control module reads the system parameters, status and initial value of the gimbal angle code of the two-dimensional laser scanner, and waits for the laser radar to be ready;

[0023] S2. Automatic laser radar scanning: When receiving the arrival signal from the driving PLC that the driving vehicle has reached a large-angle scanning point, a small-angle scanning point in the stacking area, or a small-angle scanning point in the packaging area, the control module controls the 3D laser radar scanning system to start scanning; the 3D laser radar scanning system scans according to the scanning angle intervals corresponding to different scanning points of the driving vehicle, and completes the point cloud data collection in the stacking area and packaging area scanning area;

[0024] Among them, the scanning range and scanning speed of the large-angle scanning point are 100-160°, 5° / s, the scanning range and scanning speed of the small-angle scanning point in the stacking area are 110-120°, 5° / s, 110-126°, 8° / s or 110-130°, 10° / s, and the scanning range and scanning speed of the small-angle scanning point in the packaging area are 60-70°, 5° / s.

[0025] Furthermore, preferably, when switching from large-angle scanning to small-angle scanning of the stacking area, the current number of stacking layers is used for judgment; if the number of stacking layers is 0 to 2, switch to the angle interval [110 to 120°, 5° / s]; if the number of stacking layers is 3 to 4, switch to the angle interval [110 to 126°, 8° / s]; if the number of stacking layers is 5 to 6, switch to the angle interval [110 to 130°, 10° / s].

[0026] Furthermore, preferably, when collecting point cloud data, the control module controls the three-dimensional laser radar scanning system to scan, and stores the three-dimensional point cloud data collected in real time in the original data table of the storage module; the rows in the original data table represent the dimension of the gimbal rotation angle coefficient, the columns in the original data table represent the dimension of the laser scanning angle coefficient, and the values ​​in the original data table represent the dimension of the laser point range distance.

[0027] Further, preferably, the point cloud sampling of the profile stack is directed toward the center line of the stack, and n columns of point cloud data are collected and stored at equal intervals in the region in the length direction of the stack, where n≥5;

[0028] The point cloud sampling of the bar stack at a large angle is facing the center line of the stack. N columns of point cloud data are collected at equal intervals in the horizontal area of ​​the stack, and m rows of point cloud data are collected every 1.2° in the scanning area. The horizontal direction of the stack is parallel to the traveling beam (that is, the columns in the original data table represent perpendicularity to the traveling beam, and the rows represent parallelity to the traveling beam); m ≥ 50;

[0029] The point cloud sampling of the large-angle scanning disk stack is facing the center line of the stack, and p columns of point cloud data are collected and stored every 1° in the length direction of the stack row; the length direction of the disk bundle and the length direction of the stack row are parallel to the traveling beam; p ≥ 120;

[0030] Small-angle scanning of the stacking area and the packaging area collects and stores 50 rows and 720 columns of point cloud data for profiles, bars, coils and their stacking.

[0031] The specific steps of automatic laser radar scanning are as follows:

[0032] When the vehicle drives to the large-angle scanning point in the stacking area, the PLC of the vehicle sends a large-angle scanning point arrival signal to the control module. The control module controls the 3D laser radar scanning system to start large-angle scanning and collect point cloud data of the large-angle scanning area. When the collection is completed, the recognition and calculation module calculates the coordinates of the small-angle scanning point of the first stacking area and sends them to the PLC of the vehicle. The vehicle controls the vehicle to continue driving.

[0033] When driving to the first small-angle scanning point in the stacking area, the PLC of the driving vehicle sends the arrival signal of the first small-angle scanning point in the stacking area to the control module, and the control module controls the 3D laser radar scanning system to start the small-angle scanning of the stacking area, and collects the point cloud data of the small-angle scanning area of ​​the stacking area. When the collection is completed, the recognition and calculation module calculates the stacking position coordinates of the stacking area, calculates the coordinates of the next small-angle scanning point in the stacking area, stores them, and sends the stacking position coordinates to the PLC of the driving vehicle, and the driving vehicle continues to drive;

[0034] When the vehicle reaches the small-angle scanning point in the packaging area, the PLC of the driving vehicle sends a signal of arrival at the small-angle scanning point in the packaging area to the control module. The control module controls the 3D laser radar scanning system to start the small-angle scanning of the packaging area and collect the point cloud data of the small-angle scanning area in the packaging area. When the collection is completed, the recognition and calculation module calculates the coordinates of the objects to be hoisted in the packaging area and sends them to the PLC of the driving vehicle. The driving vehicle controls the driving vehicle to continue driving.

[0035] When the crane lifts the object in the packaging area, the PLC of the crane sends a signal that the object has been lifted to the control module. The control module sends the coordinates of the second small-angle scanning point in the stacking area to the PLC of the crane, and the control crane continues to move;

[0036] The above process of driving to the small-angle scanning point in the stacking area for scanning and collecting, and then driving to the small-angle scanning point in the packaging area for scanning and collecting is repeated until the stack is filled with the crane, the crane fails, or the operator sends an automatic operation stop command on the human-machine interface, the crane stops and the automatic operation state is released.

[0037] In the present invention, the human-machine interface, the control system, the three-dimensional laser radar scanning system and the PLC of the driving are connected in a star shape through a network switch, and the three-dimensional laser radar scanning system logically communicates only with the control system.

[0038] The coordinate data sent by the control system to the crane PLC includes the small-angle scanning points in the stacking area, and may also include the coordinate data of the midpoint of the hoisted object and the stacking position point, but is not limited thereto.

[0039] In the art, currently the unmanned driving crane includes a driving trolley, a driving carriage installed on the driving trolley, and a lifting mechanism installed on the carriage; the present invention does not improve the specific structure of the current unmanned driving crane. The operation of the trolley, carriage, and lifting mechanism of the unmanned driving crane are all controlled by the PLC of the driving crane.

[0040] The data sampled by the large-angle scanning of the stacking area of ​​the present invention is used to preliminarily identify and calculate the current stacking position of the stack, thereby calculating the initial small-angle scanning point of the stacking area, and preliminarily judge the initial state of the stack (such as the empty, full, not full, full state and number of layers of the profile stack). The data sampled by the small-angle scanning of the stacking area and the packaging area are all identified and calculated by the identification and calculation module of "a method for recognizing and calculating the contours of multi-height layers based on a quasi-plane"; the data sampled by the small-angle scanning of the stacking area is used to accurately identify and calculate the coordinates of the current stacking position of the stack, and is sent to the PLC to control the driving to stack the suspended objects, and the next small-angle scanning point of the stacking area is calculated through the stacking position coordinates; the data sampled by the small-angle scanning of the packaging area is used to accurately calculate the coordinates of the suspended objects in the packaging area, and is sent to the PLC to control the driving to lift the suspended objects.

[0041] Compared with the prior art, the present invention has the following beneficial effects:

[0042] (1) This system is practical, novel and easy to implement;

[0043] (2) The equipment cost of this system is low;

[0044] (3) The present invention effectively solves the problems of panoramic scanning of the stacking area, small-angle scanning of the stacking position, small-angle scanning and point cloud sampling of the packaging area by unmanned driving of profiles, bars or round stacks, as well as the selection of corresponding scanning points and corresponding angle ranges, thereby realizing the identification and calculation of the stacking position in the stacking area and the lifting objects in the packaging area.

[0045] The present invention solves the problem that the recognition and calculation module of the previous "a method and system based on plane-like multi-height layer contour recognition and coordinate calculation" can only recognize the objects to be hoisted in the packaging area with a single scan at a fixed angle, or recognize the stacking position with a single scan. The problem that the original need to combine multiple system modules (although not installed on the driving crane) can be solved with one system, which reduces the cost. The two actions of unmanned driving crane lifting and stacking are realized in principle and technology. BRIEF DESCRIPTION OF THE DRAWINGS

[0046] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.

[0047] Figure 1 It is a schematic diagram of the application scenario. In the figure, 1 is a driving trolley, 2 is a driving trolley, 3 is a laser radar, 4 is a stacking area 1, 5 is a packing area 1, 6 is a stacking area 2, 7 is a packing area 2, 8 is a large-angle scanning point in a stacking area 1, 9 is a small-angle scanning point in a stacking area 1 (variable), 10 is a small-angle scanning point in a packing area 1, 11 is a large-angle scanning point in a stacking area 2, 12 is a small-angle scanning point in a stacking area 2 (variable), 13 is a small-angle scanning point in a packing area 2;

[0048] Figure 2 Flowchart for switching the laser radar scanning angle;

[0049] Figure 3 It is a structural schematic diagram of the point cloud sampling system based on laser radar scanning angle switching of the present invention. DETAILED DESCRIPTION

[0050] The present invention is further described in detail below in conjunction with embodiments.

[0051] Those skilled in the art will understand that the following examples are only used to illustrate the present invention and should not be considered to limit the scope of the present invention. If no specific technology, connection relationship or condition is specified in the examples, the technology, connection relationship, condition described in the literature in the field or the product specification is used. If the manufacturer of the materials, instruments or equipment used is not specified, they are all conventional products that can be purchased.

[0052] Those skilled in the art will appreciate that, unless expressly stated, the singular forms "a", "an", "said" and "the" used herein may also include plural forms. It should be further understood that the term "comprising" used in the specification of the present invention refers to the presence of the features, integers, steps, operations, elements and / or components, but does not exclude the presence or addition of one or more other features, integers, steps, operations, elements, components and / or groups thereof. It should be understood that when we refer to an element as being "connected" to another element, it may be directly connected to the other element, or there may be intermediate elements. In addition, the "connection" used here may include wireless connections. The term "and / or" used here includes any unit and all combinations of one or more associated listed items.

[0053] In the description of the present invention, unless otherwise specified, "plurality" means two or more than two. The terms "inside", "upper", "lower", etc., indicating positions or state relationships, are based on the positions or state relationships shown in the drawings, and are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific position, be constructed and operate in a specific position, and therefore cannot be understood as limiting the present invention.

[0054] In the description of the present invention, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected", and "provided with" 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. For ordinary technicians in this field, the specific meanings of the above terms in the present invention will be understood according to specific circumstances.

[0055] It will be understood by those skilled in the art that, unless otherwise defined, all terms (including technical and scientific terms) used herein have the same meaning as generally understood by those skilled in the art in the field to which the present invention belongs. It should also be understood that terms such as those defined in common dictionaries should be understood to have meanings consistent with the meanings in the context of the prior art, and will not be interpreted with idealized or overly formal meanings unless defined as herein.

[0056] like Figure 3 As shown, a point cloud sampling system based on laser radar scanning angle switching includes a control system, a three-dimensional laser radar scanning system and a human-machine interface;

[0057] The control system includes a control module, a power module, a storage module and an identification and calculation module;

[0058] The 3D LiDAR scanning system includes a gimbal and a 2D LiDAR scanner;

[0059] The power module is used to supply power to the control system;

[0060] The control module is used to control the operation of the pan / tilt and the two-dimensional laser radar scanner, and collect the three-dimensional point cloud data samples obtained by the three-dimensional laser radar scanning system and store them in the storage module;

[0061] The recognition and calculation module is used to recognize and calculate the small-angle scanning points in the stacking area, the coordinates of the stacking position in the stacking area, and the coordinates of the objects being hoisted in the packaging area;

[0062] The storage module is also used to record the absolute coordinates of the small-angle scanning points in the stacking area obtained by the recognition calculation module and the current scanning angle interval mark of the pan / tilt switch controlled by the power-off storage control module;

[0063] The gimbal is used to carry a two-dimensional laser radar scanner and rotate it to form a three-dimensional scanning area;

[0064] The 2D LiDAR scanner is installed on the traveling trolley;

[0065] The human-machine interface is used to set the absolute coordinates of the large-angle scanning points in the stacking area and the small-angle scanning points in the packaging area, and transmit them to the PLC of the driving;

[0066] When the vehicle drives to the large-angle scanning point, small-angle scanning point and small-angle scanning point of the stacking area, the PLC of the vehicle sends an arrival signal to the control module. The control module controls the pan / tilt and two-dimensional laser radar scanner to collect data. The recognition and calculation module performs recognition and calculation based on the collected data to obtain the coordinates of the next small-angle scanning point of the stacking area, the stacking position coordinates of the stacking area and the coordinates of the objects to be hoisted in the packaging area.

[0067] Preferably, the human-machine interface is also used to send automatic operation start, automatic operation stop and reset instructions for the crane, switch the crane's automatic operation or manual remote control operation mode, perform zero point correction of the crane's absolute xyz coordinate system (to clear the encoder's accumulated errors), and display the coordinate data sent by the control system to the crane's PLC.

[0068] Preferably, the pan / tilt rotation direction is perpendicular to the crane trolley beam, and the laser scanning direction is parallel to the trolley beam; when the 3D laser radar scanning system scans, the 3D laser radar scanning system is used as the reference xyz relative coordinate system origin, and the crane trolley zero (right) limit point, the trolley zero (right) limit point and the lifting height limit point of the crane's lifting mechanism are used as the reference xyz absolute coordinate system origin, the x-axis corresponds to the trolley movement direction, the y-axis corresponds to the trolley movement direction, and the z-axis corresponds to the lifting mechanism lifting direction.

[0069] Preferably, the pan-tilt rotation direction is parallel to the vehicle beam, and the laser scanning direction is perpendicular to the vehicle beam.

[0070] Preferably, the recognition and calculation module is used to process the three-dimensional point cloud data in the storage module, and according to a method based on plane-like multi-height layer contour recognition and coordinate calculation, the contours of the height layers of interest of the suspended objects in the packaging area and the stacking positions in the stacking area are identified and the relative coordinates of the suspended objects and the stacking positions are calculated, and the absolute coordinates of the first or next small-angle scanning points in the stacking area are deduced based on the relative coordinates of the stacking positions.

[0071] (1) The absolute coordinates of the large-angle scanning point in the stacking area are transmitted to the PLC of the unmanned driving vehicle through the human-machine interface to select different stacking positions (i.e., stacking areas); click the [Auto Run] button on the human-machine interface to start the automatic operation of the unmanned driving vehicle, and the PLC directly controls the driving vehicle to drive to the large-angle scanning point in the stacking area (the large-angle scanning of the stacking area only performs a panoramic scan of the stacking once after the automatic operation of the driving vehicle is turned on, and identifies the approximate stacking position in the stacking area, which is used to identify and calculate the coordinates of the initial small-angle scanning point in the stacking area). The absolute coordinates of the small-angle scanning point in the packaging area are also transmitted to the PLC through the human-machine interface to select different packaging areas; after the driving vehicle has stacked the objects to be hoisted, the PLC directly controls the driving vehicle to drive to the previously given small-angle scanning point in the packaging area. The large-angle scanning point in the stacking area cannot be modified in the automatic operation state, but the small-angle scanning point in the packaging area can be modified as needed.

[0072] (2) When the vehicle drives to the large-angle scanning point in the stacking area, the small-angle scanning point in the stacking area, or the small-angle scanning point in the packaging area, the PLC of the vehicle will send the corresponding scanning point arrival signal to the control module, and the control module will control the 3D laser radar scanning system to start scanning.

[0073] (3) The recognition and calculation method of the initial small-angle scanning point in the stacking area: When the vehicle scans the absolute coordinates (Xa, Ya, Za) of the large-angle scanning point in the stacking area, the control module controls the three-dimensional laser radar scanning system (referred to as laser radar) to perform large-angle scanning, collect N (N ≥ 5 for profile stacking, N ≥ 120 for round plate stacking) columns and 300 rows of point cloud data, store them in the original data table of the storage module, and convert them into a height table. The recognition and calculation module searches the height table column by column, finds the height value, number of points and the first and last boundary points of each height segment in the column, and merges the heights of each height segment into a new column. Sequence, use the sorted interest height to find the height layer profile composed of the first and last boundary points in the same height segment in the N columns, calculate the coordinates (x1, y1, z1) of the midpoint of the contour boundary line close to the laser radar side (the relative coordinates of the stacking position point when the vehicle scans the point at a large angle), take the stacking area small angle scanning interval [110~120°, 5° / s], the stacking point height z1=10000mm as an example, the stacking area small angle scanning distance Dx (the midpoint of the scanning angle interval is aligned with the stacking point) = 10000*tan[(110+120°) / 2 -90° =4663mm. Calculate the relative coordinates of the initial small angle scanning point in the stacking area (x1-Dx, y=0, z=0), where the coordinate z=0 means that the lifting height maintains the y-axis Ya value during large angle scanning, and the Za height remains unchanged.

[0074] (4) Calculation method for identifying the next small-angle scanning point in the stacking area: Given the relative coordinates of the initial small-angle scanning point in the stacking area (x1-Dx, y=0, z=0), the control system transmits the coordinates to the PLC to control the vehicle to drive to the scanning point, and at the same time controls the gimbal to switch the scanning angle to the small-angle scanning interval of the stacking area [110~120°, 5° / s]. When the vehicle drives to the initial small-angle scanning point in the stacking area, the PLC of the vehicle sends a scanning point arrival signal to the control module. The control module controls the laser radar to perform a small-angle scan, collects 50 rows and 720 columns of point cloud data, stores them in the original data table of the storage module, converts them into an altimeter, searches the rows in the altimeter, finds the height value, number of points and the first and last boundary points of each height segment in the row, merges the similar heights of each height segment and sorts them, and uses the sorted interest height to search for the height layer consisting of the first and last boundary points in the same height segment in N rows. The control module reads the absolute value coordinates (Xb, Yb, Zb) of the initial small-angle scanning point of the vehicle in the stacking area, the coordinate deviation coefficient (dx, dy, dz) of the absolute coordinate system and the relative coordinate system from the PLC, and calculates the absolute value coordinates of the current stacking position point (x2+dx+Xb, y2+dy+Yb, z2+dz+Zb), and then deduces the absolute coordinates of the next small-angle scanning point in the stacking area (x2+dx+Xb-Dx-W, Ya, Za) and records and stores them; among them, Ya maintains the y-axis absolute coordinate of the large-angle scanning point, aligning with the midpoint of the stacking y-axis direction, Za maintains the z-axis absolute coordinate height of the large-angle scanning point, W is the width of the object being hoisted, and W=0 when there is no object being hoisted. When the crane lifts the object in the packaging area, the control module sends the absolute coordinates of the next small-angle scanning point in the stacking area to the PLC of the crane. Each subsequent scan at the small-angle scanning point in the stacking area updates the absolute coordinate record value of the next small-angle scanning point in the stacking area, and W is updated to the current width of the object, which is identified and calculated during the small-angle scanning in the packaging area.

[0075] A point cloud sampling method based on laser radar scanning angle switching adopts the above-mentioned point cloud sampling system based on laser radar scanning angle switching, comprising the following steps:

[0076] S1. Laser radar initialization: The control module sends a command to initialize the gimbal, set the scanning start angle, end angle and angular velocity; the control module reads the system parameters, status and initial value of the gimbal angle code of the two-dimensional laser scanner, and waits for the laser radar to be ready;

[0077] S2. Automatic laser radar scanning: When receiving the arrival signal from the driving PLC that the driving vehicle has reached a large-angle scanning point, a small-angle scanning point in the stacking area, or a small-angle scanning point in the packaging area, the control module controls the 3D laser radar scanning system to start scanning; the 3D laser radar scanning system scans according to the scanning angle intervals corresponding to different scanning points of the driving vehicle, and completes the point cloud data collection in the stacking area and packaging area scanning area;

[0078] Among them, the scanning range and scanning speed of the large-angle scanning point are 100-160°, 5° / s, the scanning range and scanning speed of the small-angle scanning point in the stacking area are 110-120°, 5° / s, 110-126°, 8° / s or 110-130°, 10° / s, and the scanning range and scanning speed of the small-angle scanning point in the packaging area are 60-70°, 5° / s.

[0079] Preferably, when switching from large-angle scanning to small-angle scanning in the stacking area, the current number of stacking layers is used for judgment; if the number of stacking layers is 0 to 2, switch to the angle interval [110 to 120°, 5° / s]; if the number of stacking layers is 3 to 4, switch to the angle interval [110 to 126°, 8° / s]; if the number of stacking layers is 5 to 6, switch to the angle interval [110 to 130°, 10° / s].

[0080] Preferably, when collecting point cloud data, the control module controls the three-dimensional laser radar scanning system to scan, and stores the three-dimensional point cloud data collected in real time in the original data table of the storage module; the rows in the original data table represent the dimension of the gimbal rotation angle coefficient, the columns in the original data table represent the dimension of the laser scanning angle coefficient, and the values ​​in the original data table represent the dimension of the laser point range distance.

[0081] Preferably, the point cloud sampling of the profile stack is directed toward the center line of the stack, and n columns of point cloud data are collected and stored at equal intervals in the length direction of the stack, where n≥5;

[0082] The point cloud sampling of the bar stack at a large angle is facing the center line of the stack, and n columns of point cloud data are collected at equal intervals in the horizontal area of ​​the stack, and m rows of point cloud data are collected every 1.2° in the scanning area; the horizontal direction of the stack is parallel to the traveling beam; m ≥ 50;

[0083] The point cloud sampling of the large-angle scanning disk stack is facing the center line of the stack, and p columns of point cloud data are collected and stored every 1° in the length direction of the stack row; the length direction of the disk bundle and the length direction of the stack row are parallel to the traveling beam; p ≥ 120;

[0084] Small-angle scanning of the stacking area and small-angle scanning of the packaging area both collect and store 50 rows and 720 columns of point cloud data.

[0085] Preferably, the specific steps of automatic laser radar scanning are as follows:

[0086] The specific steps of automatic laser radar scanning are as follows:

[0087] When the vehicle drives to the large-angle scanning point in the stacking area, the PLC of the vehicle sends a large-angle scanning point arrival signal to the control module. The control module controls the 3D laser radar scanning system to start large-angle scanning and collect point cloud data of the large-angle scanning area. When the collection is completed, the recognition and calculation module calculates the coordinates of the small-angle scanning point of the first stacking area and sends them to the PLC of the vehicle. The vehicle controls the vehicle to continue driving.

[0088] When driving to the first small-angle scanning point in the stacking area, the PLC of the driving vehicle sends the arrival signal of the first small-angle scanning point in the stacking area to the control module, and the control module controls the 3D laser radar scanning system to start the small-angle scanning of the stacking area, and collects the point cloud data of the small-angle scanning area of ​​the stacking area. When the collection is completed, the recognition and calculation module calculates the stacking position coordinates of the stacking area, calculates the coordinates of the next small-angle scanning point in the stacking area, stores them, and sends the stacking position coordinates to the PLC of the driving vehicle, and the driving vehicle continues to drive;

[0089] When the vehicle reaches the small-angle scanning point in the packaging area, the PLC of the driving vehicle sends a signal of arrival at the small-angle scanning point in the packaging area to the control module. The control module controls the 3D laser radar scanning system to start the small-angle scanning of the packaging area and collect the point cloud data of the small-angle scanning area in the packaging area. When the collection is completed, the recognition and calculation module calculates the coordinates of the objects to be hoisted in the packaging area and sends them to the PLC of the driving vehicle. The driving vehicle controls the driving vehicle to continue driving.

[0090] When the crane lifts the object in the packaging area, the PLC of the crane sends a signal that the object has been lifted to the control module. The control module sends the coordinates of the second small-angle scanning point in the stacking area to the PLC of the crane, and the control crane continues to move;

[0091] The above process of driving to the small-angle scanning point in the stacking area for scanning and collecting, and then driving to the small-angle scanning point in the packaging area for scanning and collecting is repeated until the stack is filled with the crane, the crane fails, or the operator sends an automatic operation stop command on the human-machine interface, the crane stops and the automatic operation state is released.

[0092] The control module of the present invention controls the three-dimensional laser radar scanning system through the network to accurately scan the profile bundles, bar bundles or round bundles and their stacking positions in the packaging area; flexibly switch the scanning angle range and select the appropriate scanning point; so as to realize the small angle range scanning of the packaging area (referred to as the small angle scanning of the packaging area), the panoramic scanning of the stacking area (referred to as the large angle scanning) and the small angle range scanning of the stacking position in the stacking area (referred to as the small angle scanning of the stacking area). And the selected small angle scanning point of the packaging area, the large angle scanning point and the small angle scanning point of the stacking area are transmitted to the PLC to control the driving vehicle to automatically drive to the scanning point and stop for scanning.

[0093] Preferably, the power module and the three-dimensional laser radar scanning system are both connected to a 220VAC power supply.

[0094] In view of the uneven density of LiDAR point clouds, the longer the scanning distance or the more oblique the angle, the sparser the point cloud density. Therefore, the scanning angle range is required to be as close to the bottom of the LiDAR as possible (90°); however, due to the obstruction of the hoist directly below, it is necessary to avoid the obstruction area, and the higher the lifting height of the hoist, the closer the distance to the LiDAR, and the larger the obstruction angle range. The LiDAR scanning angle range is fixed, and the closer the scanning distance, the smaller the scanning area (in a pyramid shape); as the number of stacking layers increases, the scanning distance decreases, and the scanning area becomes smaller, which will cause the problem of incomplete scanning of the stacking position; therefore, it is necessary to increase the small angle scanning interval of the stacking area by segmenting by judging the number of stacking layers, and appropriately increase the scanning angular velocity to maintain the scanning cycle unchanged, while taking into account that the point cloud density is within an acceptable range. In summary, the large-angle scanning interval [100-160°, 5° / s] is selected; the small-angle scanning intervals in the stacking area [110-120°, 5° / s], [110-126°, 8° / s], [110-130°, 10° / s]; the small-angle scanning interval in the packaging area [60-70°, 5° / s]; and the above five angle intervals are switched in pairs through the angle switching function. Of course, the five scanning angle intervals can be adjusted according to actual conditions, and the determined values ​​are given here for the sake of description.

[0095] The absolute coordinates of the large-angle scanning point are transmitted to the PLC through the human-machine interface, and different stacking positions can be selected through the scanning point (that is, different stacking areas (stacking positions) correspond to different large-angle scanning point coordinates. The PLC controls the driving vehicle to travel to a large-angle scanning point corresponding to a certain stacking area for scanning, which means that stacking is to be carried out on the stacking position. After the stacking position is full, the driving vehicle stops and waits, and then the operator sets the absolute coordinates of the large-angle point corresponding to another stacking position on the human-machine interface, or the control system selects the large-angle scanning coordinates according to the stacking position number sequence and sends them to the driving vehicle PLC). The absolute coordinates of the small-angle scanning point of the packaging area are also transmitted to the PLC through the human-machine interface to select different packaging areas (different packaging areas correspond to different absolute coordinates of the small-angle scanning point of the packaging area, and different packaging areas are selected by setting the absolute coordinates). The relative coordinates of the small-angle scanning point of the stacking area are obtained by the first and only large-angle scanning after the automatic operation is turned on, and the stacking area (initial) small-angle scanning recognition calculation; the subsequent small-angle scanning points of the stacking area (next time) are calculated from the results of the last small-angle scanning of the stacking area.

[0096] The angle switching function is turned on when a large-angle scanning point performs large-angle scanning and recognition of the stacking area (switching to a small-angle scanning interval of the stacking area according to the number of stacking layers), when a small-angle scanning point in the stacking area performs small-angle scanning and recognition of the stacking area (switching to a small-angle scanning interval of the packaging area), when a small-angle scanning point in the packaging area performs small-angle scanning and recognition of the packaging area (switching to a small-angle scanning interval of the stacking area according to the number of stacking layers), or when the control module is initialized, reset, or the driving automatic operation is started and stopped (switching to a large-angle scanning interval). Different scanning angle intervals are selected for switching under the above different conditions.

[0097] The control module controls the 3D laser radar scanning system to scan, and collects 3D point cloud data samples in real time and stores them in the original data table. The point cloud sampling method varies depending on the scanning method, such as small-angle scanning or large-angle scanning, and the scanning object, such as profiles, bars or coils and their stacking: the point cloud sampling method is basically the same for small-angle scanning in the packaging area and the stacking area; for large-angle scanning, the point cloud sampling method varies depending on the stacking method of the scanning object, such as profiles, bars or coils.

[0098] The present invention installs a 3D laser radar scanning system, a control system and a PLC of the driving vehicle on the unmanned driving vehicle, preferably connects to the network through a wireless network module and a switch, and establishes communication with a remote human-machine interface. The functions of the system of the present invention are as follows:

[0099] LiDAR initialization function: The control module acts as a TCP client to establish network connections with the gimbal and two-dimensional laser scanner respectively; sends instructions to initialize the gimbal, sets the scanning start angle, end angle and angular velocity, and preferably activates the heartbeat to avoid network interruption; reads the system parameters, status and initial value of the gimbal angle code of the two-dimensional laser scanner, and waits for the three-dimensional LiDAR scanning system to be ready.

[0100] Automatic laser radar scanning function: When the vehicle drives to the large-angle scanning point, the small-angle scanning point in the stacking area or the small-angle scanning point in the packaging area, or the human-machine interface sends an automatic scanning command (for debugging only), the control module controls the 3D laser radar scanning system to start scanning. The 3D laser radar scanning system automatically performs a single forward or reverse scan according to the position before scanning. The control module collects the start, end, forward or reverse state signs of the 3D laser radar scanning system, and combines the point cloud data collection completion sign to determine the end of this scan; then the recognition and calculation module is started to perform recognition and calculation (in the case of large-angle scanning, the stacking state and the approximate stacking position point must be identified, and the relative coordinates of the initial small-angle scanning point must be calculated. The small-angle scanning in the stacking area must identify the stacking state and the precise stacking position point for stacking, and the absolute coordinate record of the next small-angle scanning point must be calculated. The small-angle scanning in the packaging area must identify the position coordinates of the objects to be hoisted in the packaging area for hoisting.) After the recognition and calculation are completed, the 3D laser radar scanning system is started for the next scan, and the cycle continues. When the recognition calculation module notifies that the coordinate recognition is correct, it stops scanning and switches to the next scanning angle interval. After switching, it waits for the next start. For example, after the small-angle scanning in the packaging area identifies the objects to be hoisted in the packaging area and obtains the correct coordinates, the vehicle can drive over to lift them, avoiding the vehicle stopping at the scanning point to scan and reduce the lifting and stacking rhythm, and the three-dimensional laser radar scanning system needs to be switched to the next scanning angle interval; for example, after the small-angle scanning in the stacking area identifies the stacking position and obtains the correct coordinates, the vehicle can drive over to stack, for the same reason; in addition, from the perspective of energy saving and reducing mechanical wear of the pan / tilt head, it is preferred to turn off automatic scanning when scanning is identified, and angle switching is required. After the switching is completed, wait for the vehicle to drive to the next scanning point, and the PLC of the vehicle sends a scanning point arrival signal to the control module to start the laser radar automatic scanning)

[0101] Angle switching function: realize large-angle scanning interval [100-160°, 5° / s], small-angle scanning interval [110-120°, 5° / s], [110-126°, 8° / s], [110-130°, 10° / s] in stacking area, small-angle scanning interval [60-70°, 5° / s] in packaging area, a total of 5 angle intervals are switched in pairs, that is, it includes 10 sub-angle switching functions; according to the large-angle scanning point scanning recognition, the stacking area small-angle scanning point scanning recognition and the number of stacking layers, the packaging area small-angle scanning point scanning recognition, the control system reset, initialization and the automatic start and stop of the driving operation, these 10 sub-angle switching logics are selected. The 10 sub-angles are: ①[100~160°]←→[110~120°], ②[100~160°]←→[110~126°], ③[100~160°]←→[110~130°], ④[100~160°]←→[60~70°], ⑤[110~120°]←→[60~70°], ⑥[110~126°]←→[60~70°], ⑦[110~130°]←→[60~70°], ⑧[110~120°]←→[110~126°], ⑨[110~126°]←→[110~130°], ⑩[110~120°]←→[110~130°].

[0102] Angle switching logic for control system reset, initialization or automatic start and stop of driving: the control module reads the current scanning angle interval flag stored in the storage module (including the 5 angle intervals mentioned above), and initializes the scanning angle interval according to the scanning angle interval number; waits for the 3D laser radar scanning system to be initialized, then switches from the current angle interval to the large angle scanning interval, and updates the current angle interval number value in the storage module.

[0103] The angle switching logic recognized by the large-angle scanning point scanning is as follows: switch from the large-angle scanning interval to the small-angle scanning interval in the stacking area, based on the current number of stacking layers; if the number of stacking layers is 0 to 2, switch to the angle interval [110 to 120°, 5° / s]; if the number of stacking layers is 3 to 4, switch to the angle interval [110 to 126°, 8° / s]; if the number of stacking layers is 5 to 6, switch to the angle interval [110 to 130°, 10° / s].

[0104] Angle switching logic of the stacking area small-angle scanning point scanned and identified: switch from the current stacking area small-angle scanning interval to the packaging area small-angle scanning interval.

[0105] Angle switching logic of the small-angle scanning point in the packaging area: switch from the small-angle scanning interval in the packaging area to the small-angle scanning interval in the stacking area, determine the current number of stacking layers, and switch to the corresponding angle interval.

[0106] Sub-angle switching logic: Taking the switching between the angle intervals [100-160°, 5° / s] and [110-120°, 5° / s] as an example, select [100-120°, 5° / s] as the transition interval. Forward switching: the current angle range is [100-160°, 5° / s], the 3D laser radar scanning system is turned on for automatic scanning, when the gimbal is in reverse operation (i.e., rotating from 160° to 100°), turn off automatic scanning (after turning off automatic scanning, the gimbal will reverse to the starting angle of 100° before stopping, and will no longer run automatically after stopping. The subsequent switching process must be controlled by a single scan. Usually the gimbal will only stop at the starting angle and the ending angle); wait for the gimbal to stop at the starting angle, and the control module sends a transition interval setting instruction of [100-120°, 5° / s] to the gimbal; after the setting is successful, start a single scan, the gimbal runs to the ending angle and stops, set the angle range [110-120°, 5° / s], and after the setting is successful, start a single scan again, wait for the gimbal to run to the starting angle and stop, read the 2D laser radar scanner status and the initial value of the encoding of the gimbal starting angle in the 2D laser radar scanner, and update the current angle interval flag in the storage module. Reverse switching: When the current angle range is [110-120°, 5° / s], the 3D laser radar scanning system is turned on for automatic scanning. When the gimbal is in forward operation (i.e. the gimbal rotates from 110° to 120°), the automatic scanning is turned off (the principle is the same as above), and the gimbal is waited to stop at the end angle, and the transition range is set to [100-120°, 5° / s]. After the setting is successful, a single scan is started, and when the gimbal stops at the starting angle, the angle range is set to [100-160°, 5° / s]. After the setting is successful, the 2D laser radar scanner status and the initial value of the gimbal starting angle in the 2D laser radar scanner are read, and the current angle range flag in the storage module is updated. The logic of the other 9 sub-angle switching is similar and will not be repeated.

[0107] Point cloud sampling logic: The control module controls the scanning of the 3D laser radar scanning system, and collects 3D point cloud data samples in real time and stores them in the original data table of the storage module: each pan-tilt rotation angle resolution collects a set of point cloud data of the 2D laser radar scanner and stores them as a row of the table; that is, the rows in the table represent the pan-tilt rotation angle coefficient dimension, the columns in the table represent the 2D laser radar scanner scanning angle coefficient dimension, and the values ​​in the table represent the laser point range distance dimension. The point cloud sampling method for small-angle scanning in the packaging area and the stacking area is the same, and all rows in the scanning area are collected and stored row by row in the original data table. The point cloud sampling method for large-angle scanning varies according to the different stacking and stacking methods of the scanning object, such as profiles, bars or coils:

[0108] The point cloud sampling of the profile stack is scanned at a large angle toward the center line of the stack, and n columns (n ​​≥ 5) of point cloud data are collected and stored at equal intervals in the area along the length direction of the profile.

[0109] The point cloud sampling of the bar stack at a large angle is facing the center line of the stack. N columns of point cloud data are collected at equal intervals in the horizontal area of ​​the stack, and m rows of point cloud data are collected every 1.2° in the scanning area for storage; the horizontal direction of the stack is parallel to the traveling beam (i.e., the columns in the corresponding original data table represent perpendicularity to the traveling beam, and the rows represent parallelity to the traveling beam); m ≥ 50;

[0110] The point cloud sampling of the large-angle scanning coil stack faces the center line of the stack, and p columns (p ≥ 120) of point cloud data are collected and stored every 1° in the length direction of the stack row. (The length direction of the coil bundle and the row length are parallel to the crane beam)

[0111] Small-angle scanning of the stacking area and the packaging area collects and stores 50 rows and 720 columns of point cloud data for profiles, bars, coils and their stacking.

[0112] The above shows and describes the basic principles, main features and advantages of the present invention. It should be understood by those skilled in the art that the present invention is not limited to the above embodiments, and the above embodiments and descriptions are only for explaining the principles of the present invention. Without departing from the spirit and scope of the present invention, the present invention may have various changes and improvements, which fall within the scope of the present invention to be protected. The scope of protection of the present invention is defined by the attached claims and their equivalents.

Claims

1. A point cloud sampling system based on laser radar scanning angle switching, characterized in that: Includes control system, 3D LiDAR scanning system and human-machine interface; The control system includes a control module, a power module, a storage module and an identification and calculation module; The 3D LiDAR scanning system includes a gimbal and a 2D LiDAR scanner; The power module is used to supply power to the control system; The control module is used to control the operation of the pan / tilt and the two-dimensional laser radar scanner, and collect the three-dimensional point cloud data samples obtained by the three-dimensional laser radar scanning system and store them in the storage module; The recognition and calculation module is used to recognize and calculate the small-angle scanning points in the stacking area, the coordinates of the stacking position in the stacking area, and the coordinates of the objects being hoisted in the packaging area; The storage module is also used to record the absolute coordinates of the small-angle scanning points in the stacking area obtained by the recognition calculation module and the current scanning angle interval mark of the pan / tilt switch controlled by the power-off storage control module; The gimbal is used to carry a two-dimensional laser radar scanner and rotate it to form a three-dimensional scanning area; The 2D LiDAR scanner is installed on the traveling trolley; The human-machine interface is used to set the absolute coordinates of the large-angle scanning points in the stacking area and the small-angle scanning points in the packaging area, and transmit them to the PLC of the driving; When the vehicle drives to the large-angle scanning point, small-angle scanning point and small-angle scanning point of the stacking area, the PLC of the vehicle sends an arrival signal to the control module. The control module controls the pan / tilt and two-dimensional laser radar scanner to collect data. The recognition and calculation module performs recognition and calculation based on the collected data to obtain the coordinates of the next small-angle scanning point of the stacking area, the stacking position coordinates of the stacking area and the coordinates of the objects to be hoisted in the packaging area.

2. The point cloud sampling system based on laser radar scanning angle switching according to claim 1 is characterized in that: The human-machine interface is also used to send automatic start, automatic stop and reset instructions for the crane, switch the crane's automatic operation or manual remote control operation mode, perform zero point correction of the crane's absolute xyz coordinate system, and display the coordinate data sent by the control system to the crane PLC.

3. The point cloud sampling system based on laser radar scanning angle switching according to claim 1 is characterized in that: The pan / tilt rotation direction is perpendicular to the crane trolley beam, and the laser scanning direction is parallel to the trolley beam; when the 3D laser radar scanning system scans, the 3D laser radar scanning system is used as the reference xyz relative coordinate system origin, and the crane trolley zero limit point, trolley zero limit point and crane lifting mechanism's rising height limit point are used as the reference xyz absolute coordinate system origin, the x-axis corresponds to the trolley moving direction, the y-axis corresponds to the trolley moving direction, and the z-axis corresponds to the lifting mechanism's lifting direction.

4. The point cloud sampling system based on laser radar scanning angle switching according to claim 1, characterized in that: The pan-tilt rotation direction is parallel to the vehicle beam, and the laser scanning direction is perpendicular to the vehicle beam.

5. A point cloud sampling method based on laser radar scanning angle switching, using the point cloud sampling system based on laser radar scanning angle switching according to any one of claims 1 to 4, characterized in that: The steps include: S1. Laser radar initialization: The control module sends a command to initialize the gimbal, set the scanning start angle, end angle and angular velocity; the control module reads the system parameters, status and initial value of the gimbal angle code of the two-dimensional laser scanner, and waits for the laser radar to be ready; S2. Automatic laser radar scanning: When receiving the arrival signal from the driving PLC that the driving vehicle has reached a large-angle scanning point, a small-angle scanning point in the stacking area, or a small-angle scanning point in the packaging area, the control module controls the 3D laser radar scanning system to start scanning; the 3D laser radar scanning system scans according to the scanning angle intervals corresponding to different scanning points of the driving vehicle, and completes the point cloud data collection in the stacking area and packaging area scanning area; Among them, the scanning range and scanning speed of the large-angle scanning point are 100-160°, 5° / s, the scanning range and scanning speed of the small-angle scanning point in the stacking area are 110-120°, 5° / s, 110-126°, 8° / s or 110-130°, 10° / s, and the scanning range and scanning speed of the small-angle scanning point in the packaging area are 60-70°, 5° / s.

6. The point cloud sampling method based on laser radar scanning angle switching according to claim 5 is characterized in that: When switching from large-angle scanning to small-angle scanning in the stacking area, the current number of stacking layers is used for judgment; if the number of stacking layers is 0 to 2, the angle interval is switched to [110 to 120°, 5° / s]; if the number of stacking layers is 3 to 4, the angle interval is switched to [110 to 126°, 8° / s]; if the number of stacking layers is 5 to 6, the angle interval is switched to [110 to 130°, 10° / s].

7. The point cloud sampling method based on laser radar scanning angle switching according to claim 5 is characterized in that: When collecting point cloud data, the control module controls the 3D laser radar scanning system to scan, and stores the 3D point cloud data collected in real time in the original data table of the storage module; the rows in the original data table represent the dimension of the gimbal rotation angle coefficient, the columns in the original data table represent the dimension of the laser scanning angle coefficient, and the values ​​in the original data table represent the dimension of the laser point range distance.

8. The point cloud sampling method based on laser radar scanning angle switching according to claim 7 is characterized in that: The point cloud sampling of the profile stack at a large angle is facing the center line of the stack, and n columns of point cloud data are collected and stored at equal intervals in the area along the length direction of the stack, where n ≥ 5; The point cloud sampling of the bar stack at a large angle is facing the center line of the stack, and n columns of point cloud data are collected at equal intervals in the horizontal area of ​​the stack, and m rows of point cloud data are collected every 1.2° in the scanning area; the horizontal direction of the stack is parallel to the traveling beam; m ≥ 50; The point cloud sampling of the large-angle scanning disk stack is facing the center line of the stack, and p columns of point cloud data are collected and stored every 1° in the length direction of the stack row; the length direction of the disk bundle and the length direction of the stack row are parallel to the traveling beam; p ≥ 120; Small-angle scanning of the stacking area and small-angle scanning of the packaging area both collect and store 50 rows and 720 columns of point cloud data.

9. The point cloud sampling method based on laser radar scanning angle switching according to claim 5, characterized in that: The specific steps of automatic laser radar scanning are as follows: When the vehicle drives to the large-angle scanning point in the stacking area, the PLC of the vehicle sends a large-angle scanning point arrival signal to the control module. The control module controls the 3D laser radar scanning system to start large-angle scanning and collect point cloud data of the large-angle scanning area. When the collection is completed, the recognition and calculation module calculates the coordinates of the small-angle scanning point of the first stacking area and sends them to the PLC of the vehicle. The vehicle controls the vehicle to continue driving. When driving to the first small-angle scanning point in the stacking area, the PLC of the driving vehicle sends the arrival signal of the first small-angle scanning point in the stacking area to the control module, and the control module controls the 3D laser radar scanning system to start the small-angle scanning of the stacking area, and collects the point cloud data of the small-angle scanning area of ​​the stacking area. When the collection is completed, the recognition and calculation module calculates the stacking position coordinates of the stacking area, calculates the coordinates of the next small-angle scanning point in the stacking area, stores them, and sends the stacking position coordinates to the PLC of the driving vehicle, and the driving vehicle continues to drive; When the vehicle reaches the small-angle scanning point in the packaging area, the PLC of the driving vehicle sends a signal of arrival at the small-angle scanning point in the packaging area to the control module. The control module controls the 3D laser radar scanning system to start the small-angle scanning of the packaging area and collect the point cloud data of the small-angle scanning area in the packaging area. When the collection is completed, the recognition and calculation module calculates the coordinates of the objects to be hoisted in the packaging area and sends them to the PLC of the driving vehicle. The driving vehicle controls the driving vehicle to continue driving. When the crane lifts the object in the packaging area, the PLC of the crane sends a signal that the object has been lifted to the control module. The control module sends the coordinates of the second small-angle scanning point in the stacking area to the PLC of the crane, and the control crane continues to move; The above process of driving to the small-angle scanning point in the stacking area for scanning and collecting, and then driving to the small-angle scanning point in the packaging area for scanning and collecting is repeated until the stack is filled with the crane, the crane fails, or the operator sends an automatic operation stop command on the human-machine interface, the crane stops and the automatic operation state is released.