Flattening effect detection method and device

Through lidar scanning and three-dimensional coordinate conversion technology, the granary effect is automatically detected, which solves the problems of manual judgment error and high labor intensity, and achieves efficient and accurate assessment of the closing effect and automated operations.

CN119090813APending Publication Date: 2024-12-06XINHE ROBOT (SHENZHEN) CO LTD +1
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202411081144.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-07
Publication Date
2024-12-06

AI Technical Summary

Technical Problem

The current technology of COFCO's surface liquidation effect mainly relies on manual judgment, which is prone to errors and cannot meet the needs of automated operations of the closing robot. Moreover, the labor intensity of manpower liquidation is low, and the environment is harsh, and there is a risk of a grain pile collapse and burying people.

Method used

Lidar scanning is used to obtain the surface point cloud data of the granary, convert it into a three-dimensional coordinate system, calculate evaluation indicators to evaluate the closing effect, and realize automated detection.

Benefits of technology

It improves detection accuracy and efficiency, reduces manual errors, meets the needs of automated operations of closing robots, and reduces labor intensity and environmental risks.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119090813A_ABST
    Figure CN119090813A_ABST
Patent Text Reader

Abstract

The invention provides a flattening effect detection method and device. The method comprises the following steps: acquiring point cloud data obtained by scanning a grain surface by a laser radar; converting each point cloud data coordinate into each three-dimensional coordinate in a granary three-dimensional space coordinate system; calculating an index value of each preset evaluation index based on each height coordinate value representing the grain surface height in the three-dimensional coordinates; and based on a preset weight corresponding to each evaluation index and each index value, calculating to obtain an evaluation value representing the leveling effect. In the scheme, the point cloud data of the grain surface is obtained by using the laser radar, the coordinate of each data point is converted to obtain the coordinate in the three-dimensional space coordinate system, the evaluation index is calculated by using the height coordinate value corresponding to each data point, and finally the evaluation value of the leveling effect is obtained by weighting. Compared with the prior art, the automatic detection device has the advantage that the detection accuracy and efficiency are remarkably improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of three-dimensional sensing technology, and in particular to a method and device for detecting a position closing effect. Background Art

[0002] Food security is related to national security and social stability, and grain storage operations are an important means to ensure the safety of grain storage. After the grain is stored in the warehouse, it is necessary to carry out the leveling operation in a timely manner to make the grain surface (i.e. the upper surface of the stored grain) as flat as possible to ensure the subsequent standardized management and the application of new grain storage technologies. At present, the leveling operation mainly based on manpower has high labor intensity, low work efficiency, flying dust, poor working environment, and the risk of grain pile collapse and burying people. The demand for leveling robots in grain depots is imminent. The leveling robot's perception of the leveling effect of the grain surface is related to the execution of its leveling strategy, and plays a key role in the final flatness of the grain surface.

[0003] In the prior art, the grain surface flatness is judged manually, mainly by human observation and experience. Another method is to set the rope to a horizontal state and use this as a reference to judge the flatness of the grain surface. Manual judgment of the flatness of the grain surface is prone to errors and can no longer meet the needs of automated operations of flattening robots. Summary of the invention

[0004] In view of this, an embodiment of the present invention provides a method and device for detecting the effect of a liquidation position, so as to achieve the purpose of automatically detecting the effect of a liquidation position.

[0005] To achieve the above objectives, the embodiments of the present invention provide the following technical solutions:

[0006] A first aspect of an embodiment of the present invention discloses a method for detecting a position closing effect, which is applied to a position closing robot. The method includes:

[0007] Obtain point cloud data obtained by scanning the surface of grain in the granary by a laser radar; the point cloud data includes point cloud data coordinates corresponding to each data point in a Cartesian coordinate system;

[0008] Converting each of the point cloud data coordinates into each of the three-dimensional coordinates in the three-dimensional space coordinate system of the granary; the three-dimensional space coordinate system of the granary is pre-established inside the granary;

[0009] For each of the three-dimensional coordinates corresponding to the data point, obtaining a height coordinate value representing the height of the grain surface from the three-dimensional coordinates;

[0010] Based on each of the height coordinate values, calculating the index value of each preset evaluation index;

[0011] Based on the preset weight corresponding to each of the evaluation indicators and the indicator values, an evaluation value characterizing the liquidation effect is calculated.

[0012] Preferably, the step of obtaining point cloud data obtained by scanning the surface of grain in the granary by a laser radar comprises:

[0013] Obtain target point cloud data of the grain surface obtained from each laser radar scanning portion in the granary; each of the laser radars is arranged on the top of the granary, and the combination of the scanning ranges of each of the laser radars completely covers the grain surface;

[0014] The target point cloud data obtained by scanning each laser radar are spliced ​​to obtain complete point cloud data of the grain surface.

[0015] Preferably, after using a laser radar to scan the surface of the grain in the granary to obtain point cloud data, the method further includes:

[0016] Identifying interference data in the point cloud data; the interference data includes: point cloud data of interfering objects on the surface of grain obtained during the process of the laser radar scanning the surface of grain in the granary;

[0017] Removing the interference data from the point cloud data to obtain the point cloud data with data gaps;

[0018] Interpolation processing is performed on the point cloud data with data gaps to obtain complete point cloud data.

[0019] Preferably, the step of converting the coordinates of each point cloud data into three-dimensional coordinates in the three-dimensional space coordinate system of the granary includes:

[0020] For each of the point cloud data coordinates, rotation processing and translation processing are performed to obtain the three-dimensional coordinates of each of the point cloud data coordinates in the three-dimensional space coordinate system of the granary.

[0021] Preferably, the calculating of the index value of each preset evaluation index based on each of the height coordinate values ​​includes:

[0022] Calculate the mean of each of the height coordinate values;

[0023] For each of the height coordinate values, subtract the mean of the height coordinate values ​​to obtain the grain surface height difference;

[0024] Arrange the grain surface height differences in descending order;

[0025] The first m grain surface height differences and the last m grain surface height differences are used as index values ​​of the evaluation index; m is a positive integer;

[0026] and / or,

[0027] Selecting the largest grain surface height difference and the smallest grain surface height difference from the grain surface height differences, calculating the difference between the largest grain surface height difference and the smallest grain surface height difference to obtain the maximum height difference, and using the maximum height difference as the index value of the evaluation index;

[0028] and / or,

[0029] Calculate and obtain the mean of each of the height coordinate values;

[0030] Based on the mean value and each of the height coordinate values, variance calculation or standard deviation calculation is performed to obtain the flatness of the grain surface, and the flatness is used as an index value of the evaluation index.

[0031] Preferably, the method further comprises:

[0032] When the evaluation value is less than a preset evaluation threshold, calculating the average of each of the height coordinate values;

[0033] For each of the height coordinate values, subtract the mean of the height coordinate values ​​to obtain the grain surface height difference;

[0034] Selecting the largest grain surface height difference or the smallest grain surface height difference from the grain surface height differences to obtain a target grain surface height difference;

[0035] Calculate the product of the target grain surface height difference point cloud and the inverse tangent function value of the grain flow angle to obtain the operating radius;

[0036] Based on the operation radius, an operation range is generated with the three-dimensional coordinates corresponding to the target grain surface height difference as the center of the circle;

[0037] The position closing operation is performed based on the operation scope.

[0038] A second aspect of an embodiment of the present invention discloses a liquidation effect detection device, which is applied to a liquidation robot. The device comprises:

[0039] The first acquisition unit is used to acquire point cloud data obtained by scanning the surface of grain in the granary by a laser radar; the point cloud data includes point cloud data coordinates corresponding to each data point in a Cartesian coordinate system;

[0040] A conversion unit, used for converting each of the point cloud data coordinates into each three-dimensional coordinate in a three-dimensional space coordinate system of a granary; the three-dimensional space coordinate system of the granary is pre-established inside the granary;

[0041] A second acquisition unit is used to acquire a height coordinate value representing the height of the grain surface from the three-dimensional coordinate corresponding to each of the data points;

[0042] A calculation unit, used for calculating the index value of each preset evaluation index based on each of the height coordinate values;

[0043] The evaluation unit is used to calculate the evaluation value representing the liquidation effect based on the preset weight corresponding to each evaluation indicator and each indicator value.

[0044] Preferably, the device further comprises:

[0045] The identification unit is used to identify interference data in the point cloud data after obtaining point cloud data by scanning the surface of the grain in the granary with the laser radar; the interference data includes: point cloud data of interference objects on the surface of the grain obtained in the process of scanning the surface of the grain in the granary with the laser radar;

[0046] Removing the interference data from the point cloud data to obtain the point cloud data with data gaps;

[0047] Interpolation processing is performed on the point cloud data with data gaps to obtain complete point cloud data.

[0048] A third aspect of an embodiment of the present invention discloses a storage medium for storing a computer program. When the computer program is executed, it is specifically used to implement any method for detecting a liquidation effect as described in the first aspect of an embodiment of the present invention.

[0049] A fourth aspect of an embodiment of the present invention discloses an electronic device, including: a memory and a processor;

[0050] The memory is used to store computer programs;

[0051] The processor is used to execute the computer program, specifically to implement the liquidation effect detection method described in any one of the first aspects of the embodiments of the present invention.

[0052] Based on the above-mentioned embodiment of the present invention, a method and device for detecting the effect of closing a warehouse is provided, which is applied to a warehouse closing robot. The method includes: obtaining point cloud data obtained by scanning the grain surface in the grain silo by a laser radar; the point cloud data contains the point cloud data coordinates corresponding to each data point in the Cartesian coordinate system; converting each of the point cloud data coordinates into each three-dimensional coordinate in the three-dimensional space coordinate system of the grain silo; the three-dimensional space coordinate system of the grain silo is pre-established inside the grain silo; for each of the three-dimensional coordinates corresponding to the data point, obtaining the height coordinate value representing the height of the grain surface from the three-dimensional coordinate; based on each of the height coordinate values, calculating the index value of each preset evaluation index; based on the preset weight corresponding to each of the evaluation indexes and each of the index values, calculating the evaluation value representing the effect of closing a warehouse. In this scheme, the point cloud data of the grain surface is obtained by using a laser radar, and the coordinates of each data point are converted to obtain the coordinates in the three-dimensional space coordinate system, and then the height coordinate values ​​corresponding to each data point are used to calculate the evaluation index, and finally the evaluation value of the effect of closing a warehouse is obtained by weighting, so as to achieve the purpose of automatic detection of the effect of closing a warehouse, which has significantly improved the detection accuracy and efficiency compared with the prior art. BRIEF DESCRIPTION OF THE DRAWINGS

[0053] 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 embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on the provided drawings without paying creative work.

[0054] Figure 1 A flow chart of a method for detecting a position closing effect disclosed in an embodiment of the present invention;

[0055] Figure 2 This is a laser radar vertical silo scanning and denoising effect diagram disclosed in an embodiment of the present invention;

[0056] Figure 3 This is a laser radar flat warehouse scanning and denoising effect diagram disclosed in an embodiment of the present invention;

[0057] Figure 4 It is a structural diagram of a liquidation effect detection device disclosed in an embodiment of the present invention;

[0058] Figure 5 The present invention is a structural diagram of an electronic device disclosed in an embodiment of the present invention. DETAILED DESCRIPTION

[0059] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0060] In this application, the terms "comprises", "comprising" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device comprising a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, an element defined by the sentence "comprising a ..." does not exclude the presence of other identical elements in the process, method, article or device comprising the element.

[0061] As can be seen from the background technology, in the prior art, the grain surface flatness is judged manually, specifically mainly by human observation and judgment based on experience. Another method is to set the rope to a horizontal state and use this as a reference to judge the flatness of the grain surface. Manual judgment of the flatness of the grain surface is prone to errors and can no longer meet the needs of automated operations of flattening robots.

[0062] Therefore, an embodiment of the present invention discloses a method and device for detecting the closing effect. In this scheme, a laser radar is used to obtain point cloud data of the grain surface, and the coordinates of each data point are converted to obtain coordinates in a three-dimensional space coordinate system, and then the height coordinate values ​​corresponding to each data point are used to calculate the evaluation index, and finally the evaluation value of the closing effect is weighted to achieve the purpose of automatically detecting the closing effect. Compared with the existing technology, the detection accuracy and efficiency are significantly improved.

[0063] like Figure 1 As shown, it is a flow chart of a method for detecting a position closing effect disclosed in an embodiment of the present invention, and the detection method is applied to a position closing robot.

[0064] It can be understood that the grain-leveling robot is used in the granary to level the surface of grain, making the grain surface as flat as possible to facilitate grain storage management.

[0065] The method for detecting the liquidation effect mainly includes the following steps:

[0066] Step S101: Obtain point cloud data obtained by scanning the surface of grain in the granary by laser radar.

[0067] Among them, laser radar has a fast detection speed. Laser radar can obtain point cloud data of the grain surface within tens of seconds. The detection speed is much higher than the manual detection method, which can meet the needs of the closing robot for rapid perception of the grain surface.

[0068] In addition, LiDAR is suitable for dusty and dim granary environments. In dusty environments such as granary entry, exit, and closing operations, LiDAR has excellent anti-interference capabilities against dust and light, and can successfully obtain point cloud data on the grain surface.

[0069] It should be noted that point cloud data is a data set consisting of a large number of data points, which describe the surface of an object or the shape of the environment in three-dimensional space. Each point usually consists of its spatial coordinates and possible other information (such as color information, intensity information, etc.).

[0070] There are many types of lidar to choose from, such as single-thread lidar, multi-thread lidar, and solid-state lidar.

[0071] LiDAR can be installed on the top of different types of granaries, such as bungalows, shallow round silos, vertical silos, etc.

[0072] The embodiment of the present invention lists the installation positions and scanning effects of the vertical silo and flat warehouse laser radars, as follows:

[0073] like Figure 2 As shown, a laser radar vertical silo scanning and denoising effect diagram disclosed in an embodiment of the present invention.

[0074] Among them, the laser radar is set at the centroid position of the top of the vertical silo to scan the surface of the grain in the silo to obtain point cloud data.

[0075] like Figure 3 As shown, a laser radar flat warehouse scanning and denoising effect diagram disclosed in an embodiment of the present invention.

[0076] Among them, the laser radar is set at the centroid position of the top of the bungalow to scan the surface of the grain in the bungalow to obtain point cloud data.

[0077] In the specific implementation process of step S101, the target point cloud data of the grain surface obtained from each laser radar scanning part in the granary is obtained; the target point cloud data obtained from each laser radar scanning are spliced ​​to obtain complete point cloud data of the grain surface.

[0078] Among them, each laser radar is set on the top of the granary, and the combination of the scanning range of each laser radar completely covers the grain surface;

[0079] It is understandable that, considering that some granaries are too large and have different shapes, the scanning range of a single lidar cannot cover the entire grain surface in the granary. Therefore, multiple lidars need to be set up in the granary. Each lidar is responsible for scanning the corresponding part of the grain surface to obtain the target point cloud data of that part of the grain surface. Finally, the target point cloud data of each part of the grain surface are spliced ​​together to obtain the complete point cloud data of the grain surface.

[0080] For example, Figure 3 The bungalow shown in the figure is relatively long, and a single laser radar set at the top centroid may not be able to scan the entire grain surface. At this time, it is necessary to set a laser radar on the top of both sides of the bungalow (i.e., the two sides farthest from the centroid position), and finally splice the point cloud data scanned by each laser radar to obtain the point cloud data of the complete grain surface of the bungalow.

[0081] In one embodiment, the laser radar is mechanically connected to a motor, and the motor drives the laser radar to rotate and scan, so as to obtain point cloud data of a larger range of grain surface.

[0082] In step S101 , the point cloud data includes the point cloud data coordinates corresponding to each data point in a Cartesian coordinate system.

[0083] It should be noted that the laser radar scans the surface of the grain in the granary to obtain point cloud data in the spherical coordinate system, and then the preset driver in the laser radar converts the point cloud data in the spherical coordinate system into the corresponding point cloud data coordinates in the Cartesian coordinate system.

[0084] In one embodiment, after using a laser radar to scan the surface of grain in a granary to obtain point cloud data, interference data in the point cloud data is identified, the interference data is removed from the point cloud data to obtain point cloud data with data gaps, and the point cloud data with data gaps is interpolated to obtain complete point cloud data.

[0085] It should be noted that there are usually interfering objects on the surface of grain, such as closing robots and cables connected to closing robots. When the lidar is scanning the surface of grain in the granary, it is inevitable that these interfering objects will be scanned. Even due to the large scanning range, the walls of the granary will be scanned, resulting in the final point cloud data. There will be point cloud data of these interfering objects, that is, interference data. These interference data need to be removed from the point cloud data to ensure the accuracy of the closing effect detection.

[0086] After the interference data is removed, there will be gaps in the point cloud data at the positions of the original interference data. Therefore, the point cloud data with data gaps are interpolated to make the missing parts transition smoothly and ensure the integrity of the point cloud data.

[0087] Step S102: converting the coordinates of each point cloud data into three-dimensional coordinates in the three-dimensional space coordinate system of the granary.

[0088] In step S102, the three-dimensional space coordinate system of the granary is pre-established inside the granary.

[0089] Preferably, a three-dimensional spatial coordinate system of the granary is established with the centroid position of the bottom of the granary as the origin and the height direction of the granary as the Z axis.

[0090] like Figure 2 and Figure 3 As shown, it shows the effect of establishing a three-dimensional spatial coordinate system of the granary with the centroid position of the bottom of the granary as the origin and the height direction of the granary as the Z axis.

[0091] In the specific implementation process of step S102, rotation processing and translation processing are performed on each point cloud data coordinate to obtain the three-dimensional coordinates of each point cloud data coordinate in the three-dimensional space coordinate system of the granary.

[0092] More specifically, each point cloud data coordinate is transformed from the Cartesian coordinate system to the three-dimensional space coordinate system of the granary, and needs to be rotated and translated. The rotation matrix is ​​R and the translation matrix is ​​T. The final rotation and translation transformation forms are:

[0093]

[0094] Among them, [X l Y l Z l ] is the coordinates of each point cloud data in the Cartesian coordinate system, These are the three-dimensional coordinates of the granary in the three-dimensional space coordinate system.

[0095] Based on the high-precision point cloud data and precise coordinate changes of the lidar, high-precision grain surface coordinates, that is, each three-dimensional coordinate, can be obtained, thereby achieving a higher detection accuracy of the grain surface height, with an error of ±3mm, and the measurement accuracy is much higher than that of manual methods.

[0096] Step S103: For each data point corresponding to the three-dimensional coordinates, a height coordinate value representing the height of the grain surface is obtained from the three-dimensional coordinates.

[0097] It should be noted that the height coordinate value representing the height of the grain surface is the coordinate value on the coordinate axis in the granary's height direction in the granary's three-dimensional space coordinate system. Generally speaking, when establishing a granary's three-dimensional space coordinate system in the granary, the granary's height direction is used as the Z axis. Therefore, the coordinate value on the Z axis can reflect the grain surface height.

[0098] For example, assuming that the three-dimensional coordinates corresponding to the data point are (5, 3, 5), the coordinate value in the Z-axis direction is 5, that is, the height coordinate value is 5, indicating that the height of the grain surface at the data point (5, 3) is 5 meters.

[0099] Step S104: Calculate the index value of each preset evaluation index based on each height coordinate value.

[0100] In step S104, each preset evaluation index is set according to the evaluation strategy required by the user.

[0101] Preferably, each preset evaluation index includes one or more of the following: m largest grain surface height differences, m smallest grain surface height differences, the maximum height difference value among each grain surface height difference, and the flatness of the grain surface.

[0102] It should be noted that m is a positive integer, that is, the grain surface height differences are sorted in descending order. The m largest grain surface height differences refer to the m grain surface height differences ranked at the front, and the m smallest grain surface height differences refer to the m grain surface height differences ranked at the back.

[0103] The following specifically describes the process of performing data processing on each height coordinate value to obtain the index values ​​of the evaluation indexes listed above.

[0104] 1. The calculation process of m largest grain surface height differences and m smallest grain surface height differences:

[0105] First, calculate the mean of each height coordinate value. The formula is as follows:

[0106]

[0107] in, is the mean grain height, Z gn is the height of each point on the grain surface at the nth point, and n is the number of data points.

[0108] Then, for each height coordinate value, subtract the mean of the height coordinate value to get the grain surface height difference. The formula is as follows:

[0109]

[0110] Finally, the height differences of each grain surface are sorted in descending order, and the first m grain surface height differences and the last m grain surface height differences are used as the index values ​​of the evaluation index.

[0111] It should be noted that the maximum value of ΔZ max The average value of the highest point of the grain pile and the grain surface height For the case of multiple grain piles, the m items with the maximum value of ΔZ are given as the index value of the evaluation index. Similarly, the minimum value of ΔZ is ΔZ minis the average of the lowest point height and grain surface height For the case of multiple pits, the minimum value of the first m items of ΔZ is given as the index value of the evaluation index.

[0112] 2. Calculation process of the maximum height difference among the grain surface height differences:

[0113] The largest grain surface height difference and the smallest grain surface height difference are selected from various grain surface height differences, and the difference between the largest grain surface height difference and the smallest grain surface height difference is calculated to obtain the maximum height difference, which is used as the index value of the evaluation index. The formula is as follows:

[0114] R=ΔZ max -ΔZ min

[0115] Where R is the maximum height difference, ΔZ max ΔZ is the difference between the highest point of the grain pile and the mean grain surface height Z. min It is the difference between the height of the lowest point on the grain surface and the mean height Z of the grain surface.

[0116] 3. Calculation process of grain surface flatness:

[0117] First, calculate the mean of each height coordinate value.

[0118] It should be noted that the calculation process of the mean of each height coordinate value has been explained above, and it is not necessary to repeat it here.

[0119] Then, based on the mean and each height coordinate value, the variance calculation or standard deviation calculation is performed to obtain the flatness of the grain surface, and the flatness is used as the index value of the evaluation index. The formula is as follows:

[0120]

[0121] Among them, σ is the flatness, n is the number of data points, Z is the mean grain surface height, and Z gn is the height of each point on the grain surface at the nth point.

[0122] Step S105: Based on the preset weight corresponding to each evaluation indicator and each indicator value, an evaluation value representing the liquidation effect is calculated.

[0123] In the specific implementation process of step S105, the index value corresponding to each evaluation index is multiplied by the preset weight of the corresponding evaluation index and then summed up to obtain the evaluation value representing the liquidation effect.

[0124] For example, it is assumed that the evaluation indicators are: m largest grain surface height differences, m smallest grain surface height differences, the maximum height difference value among all grain surface height differences, and the flatness of the grain surface. The evaluation value calculation formula is as follows:

[0125] φ=a1σ+a2R+a3ΔZ max +a4ΔZ max +...+a n-1 ΔZ min +a n ΔZ min

[0126] Among them, φ is the evaluation value; a1 to a n is the weight corresponding to each evaluation index, and the sum of the weights is 1.

[0127] It should be noted that the ellipsis in the formula indicates that for the m largest grain surface height differences ΔZ max And m minimum grain surface height differences ΔZ min Multiply them by the corresponding weights and sum them.

[0128] It should be noted that the evaluation value can reflect the closing effect of the closing robot, provide a basis for its closing strategy decision-making, and guide the closing robot to perform closing operations, which specifically includes the following steps:

[0129] Step S201: when the evaluation value is less than a preset evaluation threshold, the average of each height coordinate value is calculated.

[0130] Step S202: For each height coordinate value, subtract the mean value of the height coordinate value to obtain the grain surface height difference.

[0131] Step S203: Filter out the largest grain surface height difference or the smallest grain surface height difference from various grain surface height differences to obtain a target grain surface height difference.

[0132] Step S204: Calculate the product of the target grain surface height difference point cloud and the inverse tangent function value of the grain flow angle to obtain the operating radius.

[0133] In step S204, the calculation formula is as follows:

[0134] r=ΔZ·arctanθ

[0135] Among them, ΔZ is the target grain surface height difference, r is the radius of the operating range, and θ is the grain flow angle.

[0136] It should be noted that the grain self-flow angle is a measure of grain scattering. The grain self-flow angle is the angle at which grain particles begin to move and slide on the inclined plane, that is, the extreme angle of the sliding of grain particles.

[0137] Step S205: Based on the operation radius, an operation range is generated with the three-dimensional coordinates corresponding to the target grain surface elevation difference as the center of the circle.

[0138] In step S205 , the target grain surface height difference is calculated based on the height coordinate value reflecting the grain surface height in the three-dimensional coordinates, so there is a corresponding relationship between the target grain surface height difference and the three-dimensional coordinates.

[0139] For example,

[0140] ΔZ max or ΔZ min The corresponding coordinate position [X g Y g ] max / min It is the center of the highest grain pile or the center of the lowest pit, that is, the highest point and the lowest point on the grain surface.

[0141] Step S206: Perform position closing operations based on the operation scope.

[0142] In one embodiment, after the liquidation operation is completed, the process returns to step S101 to perform the next liquidation effect detection.

[0143] Based on a method for detecting the effect of warehouse closing disclosed in the above-mentioned embodiment of the present invention, point cloud data obtained by scanning the grain surface in the granary by a laser radar is obtained; the point cloud data includes the point cloud data coordinates corresponding to each data point in the Cartesian coordinate system; each point cloud data coordinate is converted into each three-dimensional coordinate in the three-dimensional space coordinate system of the granary; the three-dimensional space coordinate system of the granary is pre-established inside the granary; for each three-dimensional coordinate corresponding to each data point, the height coordinate value representing the height of the grain surface is obtained from the three-dimensional coordinate; based on each height coordinate value, the index value of each preset evaluation index is calculated; based on the preset weight corresponding to each evaluation index and each index value, the evaluation value representing the warehouse closing effect is calculated. In this scheme, the point cloud data of the grain surface is obtained by using a laser radar, and the coordinates of each data point are converted to obtain the coordinates in the three-dimensional space coordinate system, and then the height coordinate values ​​corresponding to each data point are used to calculate the evaluation index, and finally the evaluation value of the warehouse closing effect is obtained by weighting, so as to achieve the purpose of automatic detection of the warehouse closing effect, which has significantly improved the detection accuracy and efficiency compared with the prior art.

[0144] Corresponding to the above-mentioned embodiment of the present invention, as Figure 4 As shown, it is a structural diagram of a liquidation effect detection device disclosed in an embodiment of the present invention. The detection device is applied to a liquidation robot, and includes: a first acquisition unit 401, a conversion unit 402, a second acquisition unit 403, a calculation unit 404 and an evaluation unit 405.

[0145] The first acquisition unit 401 is used to acquire point cloud data obtained by scanning the surface of grain in the granary by a laser radar; the point cloud data includes point cloud data coordinates corresponding to each data point in a Cartesian coordinate system.

[0146] Preferably, the first acquiring unit 401 is specifically used for:

[0147] The target point cloud data of the grain surface obtained from each laser radar scanning part in the granary is obtained; each laser radar is set on the top of the granary, and the combination of the scanning ranges of each laser radar completely covers the grain surface; the target point cloud data obtained by each laser radar scanning are spliced ​​to obtain complete point cloud data of the grain surface.

[0148] The conversion unit 402 is used to convert each point cloud data coordinate into each three-dimensional coordinate in the three-dimensional space coordinate system of the granary; the three-dimensional space coordinate system of the granary is pre-established inside the granary.

[0149] Preferably, the conversion unit 402 is specifically used for:

[0150] For each point cloud data coordinate, rotation and translation processing are performed to obtain the three-dimensional coordinates of each point cloud data coordinate in the three-dimensional space coordinate system of the granary.

[0151] The second acquisition unit 403 is used to acquire a height coordinate value representing the height of the grain surface from the three-dimensional coordinate corresponding to each data point.

[0152] The calculation unit 404 is used to calculate the index value of each preset evaluation index based on each height coordinate value.

[0153] Preferably, the calculation unit 404 is specifically used for:

[0154] Calculate the mean of each height coordinate value; for each height coordinate value, subtract the mean of the height coordinate value to obtain the grain surface height difference; sort the grain surface height differences in descending order; take the first m grain surface height differences and the last m grain surface height differences as the index values ​​of the evaluation index; m is a positive integer;

[0155] and / or,

[0156] The largest grain surface height difference and the smallest grain surface height difference are selected from various grain surface height differences, the difference between the largest grain surface height difference and the smallest grain surface height difference is calculated, the maximum height difference is obtained, and the maximum height difference is used as the index value of the evaluation index;

[0157] and / or,

[0158] The mean of each height coordinate value is calculated; based on the mean and each height coordinate value, variance calculation or standard deviation calculation is performed to obtain the flatness of the grain surface, and the flatness is used as an index value of the evaluation index.

[0159] The evaluation unit 405 is used to calculate the evaluation value representing the liquidation effect based on the preset weight corresponding to each evaluation indicator and each indicator value.

[0160] Preferably, the detection device further comprises:

[0161] The identification unit is used to identify interference data in the point cloud data after obtaining point cloud data by scanning the surface of the grain in the granary with a laser radar; the interference data includes: point cloud data of interfering objects on the surface of the grain obtained during the process of scanning the surface of the grain in the granary with a laser radar; remove the interference data from the point cloud data to obtain point cloud data with data gaps; interpolate the point cloud data with data gaps to obtain complete point cloud data.

[0162] Preferably, the detection device further comprises:

[0163] The operation trigger unit is used to obtain the grain surface height difference by subtracting the mean value of the height coordinate value from each height coordinate value; to select the largest grain surface height difference or the smallest grain surface height difference from each grain surface height difference to obtain the target grain surface height difference; to calculate the product of the target grain surface height difference point cloud and the inverse tangent function value of the grain self-flow angle to obtain the operation radius; based on the operation radius, an operation range is generated with the three-dimensional coordinates corresponding to the target grain surface height difference as the center of the circle; and a closing operation is performed based on the operation range.

[0164] Based on the above-mentioned embodiment of the present invention, a device for detecting the effect of closing a warehouse is disclosed, and point cloud data obtained by scanning the grain surface in the grain silo by a laser radar is obtained; the point cloud data includes the point cloud data coordinates corresponding to each data point in the Cartesian coordinate system; each point cloud data coordinate is converted into each three-dimensional coordinate in the three-dimensional space coordinate system of the grain silo; the three-dimensional space coordinate system of the grain silo is pre-established inside the grain silo; for each three-dimensional coordinate corresponding to each data point, a height coordinate value representing the height of the grain surface is obtained from the three-dimensional coordinate; based on each height coordinate value, the index value of each preset evaluation index is calculated; based on the preset weight corresponding to each evaluation index and each index value, the evaluation value representing the effect of closing a warehouse is calculated. In this scheme, the point cloud data of the grain surface is obtained by using a laser radar, and the coordinates of each data point are converted to obtain the coordinates in the three-dimensional space coordinate system, and then the height coordinate values ​​corresponding to each data point are used to calculate the evaluation index, and finally the evaluation value of the effect of closing a warehouse is obtained by weighting, so as to achieve the purpose of automatic detection of the effect of closing a warehouse, which has significantly improved the detection accuracy and efficiency compared with the prior art.

[0165] The present invention also provides an electronic device, please refer to Figure 5 , the electronic device includes a memory 501 and a processor 502.

[0166] Wherein, the memory 501 is used to store computer programs;

[0167] Processor 502 is used to execute a computer program, specifically to implement the liquidation effect detection method provided in any embodiment of the present application.

[0168] The present application also provides a computer storage medium for storing a computer program. When the computer program is executed, it is specifically used to implement the liquidation effect detection method provided in any embodiment of the present application.

[0169] Each embodiment in this specification is described in a progressive manner, and the same or similar parts between the embodiments can refer to each other, and each embodiment focuses on the differences from other embodiments. In particular, for the system or system embodiment, since it is basically similar to the method embodiment, the description is relatively simple, and the relevant parts can refer to the partial description of the method embodiment. The system and system embodiments described above are merely schematic, wherein the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the scheme of this embodiment. Ordinary technicians in this field can understand and implement it without creative work.

[0170] Professionals may further appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, computer software, or a combination of the two. In order to clearly illustrate the interchangeability of hardware and software, the composition and steps of each example have been generally described in the above description according to function. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professionals and technicians may use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of the present invention.

[0171] The above description of the disclosed embodiments enables one skilled in the art to implement or use the present invention. Various modifications to these embodiments will be apparent to one skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present invention. Therefore, the present invention will not be limited to the embodiments shown herein, but rather to the widest scope consistent with the principles and novel features disclosed herein.

Claims

1. A method for detecting the effect of liquidation, characterized in that: Applied to a position closing robot, the method comprises: Obtain point cloud data obtained by scanning the surface of grain in the granary by a laser radar; the point cloud data includes point cloud data coordinates corresponding to each data point in a Cartesian coordinate system; Converting each of the point cloud data coordinates into each of the three-dimensional coordinates in the three-dimensional space coordinate system of the granary; the three-dimensional space coordinate system of the granary is pre-established inside the granary; For each of the three-dimensional coordinates corresponding to the data point, obtaining a height coordinate value representing the height of the grain surface from the three-dimensional coordinates; Based on each of the height coordinate values, calculating the index value of each preset evaluation index; Based on the preset weight corresponding to each of the evaluation indicators and the indicator values, an evaluation value characterizing the liquidation effect is calculated.

2. The method according to claim 1, characterized in that The point cloud data obtained by scanning the grain surface in the granary by a laser radar includes: Obtain target point cloud data of the grain surface obtained from each laser radar scanning portion in the granary; each of the laser radars is arranged on the top of the granary, and the combination of the scanning ranges of each of the laser radars completely covers the grain surface; The target point cloud data obtained by scanning each laser radar are spliced ​​to obtain complete point cloud data of the grain surface.

3. The method according to claim 1, characterized in that After scanning the surface of the grain in the granary with a laser radar to obtain point cloud data, the method further includes: Identifying interference data in the point cloud data; the interference data includes: point cloud data of interfering objects on the surface of grain obtained during the process of the laser radar scanning the surface of grain in the granary; Removing the interference data from the point cloud data to obtain the point cloud data with data gaps; Interpolation processing is performed on the point cloud data with data gaps to obtain complete point cloud data.

4. The method according to claim 1, characterized in that: The step of converting the coordinates of each point cloud data into three-dimensional coordinates in the three-dimensional space coordinate system of the granary includes: For each of the point cloud data coordinates, rotation processing and translation processing are performed to obtain the three-dimensional coordinates of each of the point cloud data coordinates in the three-dimensional space coordinate system of the granary.

5. The method according to claim 1, characterized in that The step of calculating the index value of each preset evaluation index based on each of the height coordinate values ​​includes: Calculate the mean of each of the height coordinate values; For each of the height coordinate values, subtract the mean of the height coordinate values ​​to obtain the grain surface height difference; Arrange the grain surface height differences in descending order; The first m grain surface height differences and the last m grain surface height differences are used as index values ​​of the evaluation index; m is a positive integer; and / or, Selecting the largest grain surface height difference and the smallest grain surface height difference from the grain surface height differences, calculating the difference between the largest grain surface height difference and the smallest grain surface height difference to obtain the maximum height difference, and using the maximum height difference as the index value of the evaluation index; and / or, Calculate and obtain the mean of each of the height coordinate values; Based on the mean value and each of the height coordinate values, variance calculation or standard deviation calculation is performed to obtain the flatness of the grain surface, and the flatness is used as an index value of the evaluation index.

6. The method according to any one of claims 1 to 5, characterized in that: The method further comprises: When the evaluation value is less than a preset evaluation threshold, calculating the average of each of the height coordinate values; For each of the height coordinate values, subtract the mean of the height coordinate values ​​to obtain the grain surface height difference; Selecting the largest grain surface height difference or the smallest grain surface height difference from the grain surface height differences to obtain a target grain surface height difference; Calculate the product of the target grain surface height difference point cloud and the inverse tangent function value of the grain flow angle to obtain the operating radius; Based on the operation radius, an operation range is generated with the three-dimensional coordinates corresponding to the target grain surface height difference as the center of the circle; The position closing operation is performed based on the operation scope.

7. A liquidation effect detection device, characterized in that: Applied to a liquidation robot, the device comprises: The first acquisition unit is used to acquire point cloud data obtained by scanning the surface of grain in the granary by a laser radar; the point cloud data includes point cloud data coordinates corresponding to each data point in a Cartesian coordinate system; A conversion unit, used for converting each of the point cloud data coordinates into each three-dimensional coordinate in a three-dimensional space coordinate system of a granary; the three-dimensional space coordinate system of the granary is pre-established inside the granary; A second acquisition unit is used to acquire a height coordinate value representing the height of the grain surface from the three-dimensional coordinate corresponding to each of the data points; A calculation unit, used for calculating the index value of each preset evaluation index based on each of the height coordinate values; The evaluation unit is used to calculate the evaluation value representing the liquidation effect based on the preset weight corresponding to each evaluation indicator and each indicator value.

8. The device according to claim 7, characterized in that The device also includes: The identification unit is used to identify interference data in the point cloud data after obtaining point cloud data by scanning the surface of the grain in the granary with the laser radar; the interference data includes: point cloud data of interference objects on the surface of the grain obtained in the process of scanning the surface of the grain in the granary with the laser radar; Removing the interference data from the point cloud data to obtain the point cloud data with data gaps; Interpolation processing is performed on the point cloud data with data gaps to obtain complete point cloud data.

9. A storage medium, characterized in that: Used to store a computer program, which, when executed, is specifically used to implement the liquidation effect detection method as described in any one of claims 1 to 6.

10. An electronic device, characterized in that: include: Memory and processor; The memory is used to store computer programs; The processor is used to execute the computer program, specifically to implement the liquidation effect detection method as described in any one of claims 1 to 6.

Citation Information

Cited By

  • Grain surface flatness active monitoring system for leveling robot

    CN121948166A