Coarse positioning system and method for automatic docking system of automatic loading arm

Through laser radar technology scanning and data processing, the position coordinates of the target flange at the rear of the tank truck are obtained, which solves the shortcomings of manual operation docking in the existing technology, realizes the rough positioning and precise docking of the automatic loading arm, and improves the docking efficiency and Accuracy.

CN118884401APending Publication Date: 2024-11-01CHINA PETROLEUM & CHEMICAL CORP +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410979546.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-11-01

AI Technical Summary

Technical Problem

The prior art cannot achieve automatic docking of the end of the LNG loading arm and the target flange at the rear of the tank truck. It requires manual operation for rough positioning and precise docking, and it is difficult to obtain the coordinates of the target flange at the rear of the tank truck.

Method used

The lidar calibration module and the lidar positioning flange module are used to scan point cloud data and perform slice projection, conditional European clustering and least squares circle fitting to obtain the position coordinates of the target flange at the rear of the tank truck to realize automatic loading of the vehicle. thick positioning of the arm.

Benefits of technology

The rough positioning of the target flange position at the rear of the tanker is achieved, providing the basis for guiding the end of the LNG loading arm to the vicinity of the target flange, and improving the docking efficiency and accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118884401A_ABST
    Figure CN118884401A_ABST
Patent Text Reader

Abstract

The invention discloses a coarse positioning system for an automatic docking system of an automatic loading arm. The coarse positioning system comprises a laser radar calibration module, a laser radar, a laser radar positioning flange module and an industrial personal computer, the laser radar calibration module is used for calibrating a conversion matrix between a laser radar coordinate system and a loading arm base coordinate system; the laser radar is used for scanning the tank car tail area where the target flange is located to form point cloud data; the laser radar positioning flange module is used for positioning the position coordinates of the target flange on the tank car under the loading arm base coordinate system from the point cloud data; and the industrial personal computer is connected with the laser radar positioning flange module and a driving mechanism of the LNG loading arm. The invention further discloses a coarse positioning method for the automatic docking system of the automatic loading arm. According to the method, the position coordinates of the target flange at the tail of the tank car can be obtained, that is, the approximate position of the target flange at the tail of the tank car is roughly obtained, and therefore a foundation is provided for guiding the tail end of an LNG loading arm to the position near the target flange at the tail of the tank car.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of natural gas transportation at LNG receiving stations, and in particular relates to a coarse positioning system and a coarse positioning method for an automatic loading arm automatic docking system. Background Art

[0002] When loading and unloading LNG trucks at LNG receiving stations, the end of the LNG loading arm needs to dock with the target flange at the rear of the tank truck. Currently, docking between the end of the LNG loading arm and the target flange at the rear of the tank truck is mostly done manually, and automated docking is not possible. To achieve automated docking between the end of the LNG loading arm and the target flange at the rear of the tank truck, the end of the LNG loading arm must first be guided to the vicinity of the target flange, that is, to achieve coarse positioning between the end of the LNG loading arm and the target flange, and then achieve precise docking between the end of the LNG loading arm and the target flange. To achieve coarse positioning between the end of the LNG loading arm and the target flange, the position of the target flange at the rear of the tank truck must be clearly determined, so obtaining the position coordinates of the target flange at the rear of the tank truck is crucial.

[0003] Based on the above problems, this application proposes a coarse positioning system and coarse positioning method for an automated loading arm automatic docking system, which can realize the acquisition of the position coordinates of the target flange at the rear of the tank truck, that is, roughly obtain the approximate position of the target flange at the rear of the tank truck, thereby providing a basis for guiding the end of the LNG loading arm to the vicinity of the target flange at the rear of the tank truck. Summary of the Invention

[0004] The purpose of the present invention is to overcome the above-mentioned deficiencies in the prior art and to provide a coarse positioning system and a coarse positioning method for an automatic loading arm automatic docking system.

[0005] To achieve the above object, the present invention adopts the following technical solutions:

[0006] A coarse positioning system for an automated loading arm automatic docking system, comprising a laser radar calibration module, a laser radar, a laser radar positioning flange module, and an industrial computer;

[0007] The laser radar calibration module is used to calibrate the conversion matrix between the laser radar coordinate system and the loading arm base coordinate system, and transmit the conversion matrix to the laser radar positioning flange module;

[0008] The laser radar is used to scan the rear area of ​​the tank truck where the target flange is located to form point cloud data, and transmit the point cloud data to the laser radar positioning flange module;

[0009] The laser radar flange positioning module is used to locate the position coordinates of the target flange on the tank truck in the loading arm base coordinate system from the point cloud data;

[0010] The industrial computer is connected to the laser radar positioning flange module and the driving mechanism of the LNG loading arm.

[0011] Preferably, the laser radar is installed in an explosion-proof box, and a light exit window is provided on the explosion-proof box.

[0012] The present invention also provides a rough positioning method for an automatic loading arm automatic docking system.

[0013] A rough positioning method for an automatic loading arm automatic docking system is implemented using an automatic loading arm automatic docking system rough positioning method, comprising the following steps:

[0014] Step 1: Calibrate the conversion matrix between the laser radar coordinate system and the loading arm base coordinate system through the laser radar calibration module;

[0015] Step 2: The laser radar scans the tank truck to obtain point cloud data, and transmits the point cloud data to the laser radar positioning flange module;

[0016] Step 3: The laser radar positioning flange module converts the point cloud data into the loading arm base coordinate system according to the conversion matrix, and filters the converted point cloud to obtain the point cloud of the tank truck tail area;

[0017] Step 4: Perform a slice projection operation on the point cloud of the tank truck tail area obtained in step 3 to obtain n slice point clouds;

[0018] Step 5: Perform conditional Euclidean clustering on the slice point cloud obtained in step 4 to obtain several point cloud clusters;

[0019] Step 6: Filter out the point cloud cluster combination as the target flange at the rear of the tank truck from the several point cloud clusters obtained in step 5;

[0020] In step 7, the point cloud cluster of the target flange at the rear of the tank truck obtained in step 6 is combined, and based on the original X-axis coordinates of each point in the point cloud cluster in the loading arm base coordinate system, the center point coordinates of the target flange at the rear of the tank truck are obtained by least squares circle fitting.

[0021] Preferably, step 1 includes the following sub-steps:

[0022] Step 1.1, obtain the coordinates and homogeneous matrices of N non-collinear points in the laser radar coordinate system and the loading arm base coordinate system respectively;

[0023] Step 1.2, calculate the transformation matrix between the lidar coordinate system and the loading arm base coordinate system based on the N-aligned matrix obtained in step 1.1.

[0024] Preferably, N≥3.

[0025] Preferably, step 4 includes the following sub-steps:

[0026] Step 4.1: Divide the point cloud of the tank truck rear area obtained in step 3 into n areas along the X-axis direction of the loading arm base coordinate system, where the X-axis direction of the loading arm base coordinate system is parallel to the front-to-back direction of the tank truck;

[0027] The number of divided regions n is:

[0028] n=[x / δd] (1)

[0029] Where x is the total length of the point cloud of the tank car tail area along the X-axis direction of the loading arm base coordinate system obtained in step 3, δd is the segmentation spacing along the X-axis direction of the loading arm base coordinate system, and [x / δd] is the rounding function;

[0030] Step 4.2: Name the n divided regions as region i in sequence along the positive direction of the X-axis of the loading arm base coordinate system, where i is the sequence number, i = 1, 2, 3…n;

[0031] Step 4.3, reassign the X-axis coordinates of the points in each area after segmentation in the loading arm base coordinate system, so that the point cloud segmented into n areas forms a slice point cloud, specifically,

[0032] The midpoint p in region i ij The original X-axis coordinate p xij Replace with P′ xij , click p ij The original X-axis coordinate p xij Normalized to p norm ij and store, and keep the original X-axis coordinate, normalized coordinate and point p ij One-to-one correspondence, the Y and Z axis coordinates remain unchanged; among them, point p ij represents the jth point in region i, where j is the serial number, j = 1, 2, 3…; p xij Represents point p ij The original X-axis coordinate in the loading arm base coordinate system, P′ xij Represents point p ij Reassign the X-axis coordinate; p norm ij represents point p ij Normalized coordinates of the X-axis coordinate in the loading arm base coordinate system;

[0033] P′ ij =x×i / δd (2)

[0034] p norm ij=p xij ×i / x (3)

[0035] Preferably, step 5 includes the following sub-steps:

[0036] Step 5.1: treat all slice point clouds as the whole point cloud and set the distance threshold l for Euclidean clustering, l<δd;

[0037] Step 5.2, the normalized X-axis coordinates of each point in the loading arm base coordinate system are used as another constraint condition, namely Δp norm <l norm , l norm is the specified threshold, where Δp norm is the absolute value of the difference between the normalized coordinates of two points;

[0038] In step 5.3, Euclidean clustering is performed according to the conditions in steps 5.1 and 5.2 to obtain multiple point cloud cluster combinations, each of which includes two point cloud clusters.

[0039] Preferably, step 6 includes the following sub-steps:

[0040] Step 6.1, calculate the centroid coordinates of each point cloud cluster;

[0041] Step 6.2: Calculate the distance between the centroids of the two point cloud clusters in each point cloud cluster combination. If the distance between the centroids of the two point cloud clusters in a point cloud cluster combination does not meet the distance requirement between the gas phase flange and the liquid phase flange at the rear of the tank truck, remove the point cloud cluster combination to obtain a point cloud cluster combination that meets the Y-axis constraint condition.

[0042] Step 6.3: For each point cloud cluster combination that meets the Y-axis constraint condition obtained in step 6.2, calculate the distance between the center of mass of each point cloud cluster and the ground. If the distance between the center of mass of a point cloud cluster and the ground does not meet the distance requirement between the gas phase flange and the liquid phase flange at the rear of the tank truck and the ground, remove the point cloud cluster combination containing that point cloud cluster, and obtain a point cloud cluster combination that meets the Y-axis constraint condition and the Z-axis constraint condition.

[0043] In step 6.4, a point cloud cluster combination is selected from the point cloud cluster combinations obtained in step 6.3 as the point cloud cluster combination of the target flange at the rear of the tank truck.

[0044] The beneficial effects of the present invention are:

[0045] The present invention proposes a coarse positioning system and a coarse positioning method for an automated loading arm automatic docking system, which can realize the acquisition of the position coordinates of the target flange at the rear of the tank truck, that is, roughly obtain the approximate position of the target flange at the rear of the tank truck, thereby providing a basis for guiding the end of the LNG loading arm to the vicinity of the target flange at the rear of the tank truck. BRIEF DESCRIPTION OF THE DRAWINGS

[0046] The drawings in the specification, which constitute a part of this application, are used to provide further understanding of this application. The illustrative embodiments of this application and their descriptions are used to explain this application and do not constitute improper limitations on this application.

[0047] Figure 1 This is a connection diagram of the coarse positioning system of the automatic loading arm automatic docking system of the present invention;

[0048] Figure 2 It is a schematic flow chart of the rough positioning method of the automatic loading arm automatic docking system of the present invention;

[0049] in:

[0050] 1-LiDAR calibration module, 2-LiDAR, 3-LiDAR positioning flange module, 4-Industrial computer. DETAILED DESCRIPTION

[0051] It should be noted that the following detailed descriptions are illustrative and intended to provide further explanation of the present application. Unless otherwise specified, all technical and scientific terms used herein have the same meaning as commonly understood by those skilled in the art to which the present application belongs.

[0052] It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit the exemplary embodiments according to the present application. As used herein, unless the context clearly indicates otherwise, the singular form is also intended to include the plural form. In addition, it should be understood that when the terms "comprise" and / or "include" are used in this specification, they indicate the presence of features, steps, operations, devices, components and / or combinations thereof.

[0053] In the present invention, the directions or positional relationships indicated by terms such as "upper", "lower", "bottom", and "top" are based on the directions or positional relationships shown in the accompanying drawings. They are relational words determined only for the convenience of describing the structural relationships of the various parts or elements of the present invention. They do not specifically refer to any part or element in the present invention and cannot be understood as limitations on the present invention.

[0054] In the present invention, terms such as "connected" and "connection" should be interpreted broadly to mean a fixed connection, an integral connection, or a detachable connection; a direct connection or an indirect connection through an intermediary. Relevant researchers or technicians in this field may determine the specific meanings of these terms in the present invention based on specific circumstances, and they should not be construed as limitations on the present invention.

[0055] The present invention will be further described below with reference to the accompanying drawings and examples.

[0056] Example 1:

[0057] like Figure 1 As shown, a coarse positioning system of an automatic loading arm automatic docking system includes a laser radar calibration module 1, a laser radar 2, a laser radar positioning flange module 3, and an industrial computer 4;

[0058] The laser radar calibration module 1 is used to calibrate the conversion matrix between the laser radar coordinate system and the loading arm base coordinate system, and transmit the conversion matrix to the laser radar positioning flange module 3;

[0059] The laser radar 2 is used to scan the rear area of ​​the tank truck where the target flange is located to form point cloud data, and transmit the point cloud data to the laser radar positioning flange module 3;

[0060] The laser radar flange positioning module 3 is used to locate the position coordinates of the target flange on the tank truck in the loading arm base coordinate system from the point cloud data;

[0061] The industrial computer 4 is connected to the laser radar positioning flange module 3 and the driving mechanism of the LNG loading arm. According to the position coordinates of the target flange on the tank truck located by the laser radar positioning flange module 3 in the loading arm base coordinate system, the end of the LNG loading arm is guided to the vicinity of the target flange, providing a basis for the precise positioning of the LNG loading arm.

[0062] Preferably, the laser radar 2 is installed in an explosion-proof box, and a light exit window is provided on the explosion-proof box.

[0063] Example 2:

[0064] A rough positioning method for an automatic loading arm automatic docking system is implemented using the rough positioning system for the automatic loading arm automatic docking system in Example 1, such as Figure 2 As shown, the following steps are included:

[0065] Step 1: Calibrate the conversion matrix between the laser radar coordinate system and the loading arm base coordinate system through the laser radar calibration module;

[0066] Specifically, step 1 includes the following sub-steps:

[0067] Step 1.1, obtain the coordinates and homogeneous matrices of N non-collinear points in the laser radar coordinate system and the loading arm base coordinate system respectively;

[0068] Step 1.2, calculate the transformation matrix between the laser radar coordinate system and the loading arm base coordinate system based on the N-aligned matrix obtained in step 1.1;

[0069] Specifically, N≥3;

[0070] Step 2: The laser radar 2 scans the tank truck to obtain point cloud data, and transmits the point cloud data to the laser radar positioning flange module 3;

[0071] Step 3: The laser radar positioning flange module 3 converts the point cloud data into the loading arm base coordinate system according to the conversion matrix, and filters the converted point cloud to remove non-working areas and outliers to obtain the point cloud of the tank truck tail area;

[0072] Step 4: Perform a slice projection operation on the point cloud of the tank truck tail area obtained in step 3 to obtain n slice point clouds;

[0073] Specifically, step 4 includes the following sub-steps:

[0074] Step 4.1: Divide the point cloud of the tank truck rear area obtained in step 3 into n areas along the X-axis direction of the loading arm base coordinate system, where the X-axis direction of the loading arm base coordinate system is parallel to the front-to-back direction of the tank truck;

[0075] The number of divided regions n is:

[0076] n=[x / δd] (1)

[0077] Where x is the total length of the point cloud of the tank car tail area along the X-axis direction of the loading arm base coordinate system obtained in step 3, δd is the segmentation spacing along the X-axis direction of the loading arm base coordinate system, and [x / δd] is the rounding function;

[0078] Step 4.2: Name the n divided regions as region i in sequence along the positive direction of the X-axis of the loading arm base coordinate system, where i is the sequence number, i = 1, 2, 3…n;

[0079] Step 4.3, reassign the X-axis coordinates of the points in each area after segmentation in the loading arm base coordinate system, so that the point cloud segmented into n areas forms a slice point cloud, specifically,

[0080] The midpoint p in region i ij The original X-axis coordinate p xij Replace with P′ xij , click p ij The original X-axis coordinate p xij Normalized to p norm ij and store, and keep the original X-axis coordinate, normalized coordinate and point p ij One-to-one correspondence, the Y and Z axis coordinates remain unchanged; among them, point p ij represents the jth point in region i, where j is the serial number, j = 1, 2, 3…; p xij Represents point p ij The original X-axis coordinate in the loading arm base coordinate system, P′ xij Represents point p ij Reassign the X-axis coordinate; p norm ij represents point p ij Normalized coordinates of the X-axis coordinate in the loading arm base coordinate system;

[0081] P′ xij =x×i / δd (2)

[0082] p norm ij=pxij ×i / x (3)

[0083] Step 5: Perform conditional Euclidean clustering on the slice point cloud obtained in step 4 to obtain several point cloud clusters;

[0084] Specifically, step 5 includes the following sub-steps:

[0085] Step 5.1: treat all slice point clouds as the whole point cloud and set the distance threshold l for Euclidean clustering, l<δd;

[0086] Step 5.2, the normalized X-axis coordinates of each point in the loading arm base coordinate system are used as another constraint condition, namely Δp norm <l norm , l norm is the specified threshold, where Δp norm is the absolute value of the difference between the normalized coordinates of two points;

[0087] Step 5.3: Perform Euclidean clustering based on the conditions in steps 5.1 and 5.2 to obtain multiple point cloud cluster combinations, each of which includes two point cloud clusters. The specific method of Euclidean clustering is known from the prior art and will not be described in detail here.

[0088] Step 6: Filter out the point cloud cluster combination as the target flange at the rear of the tank truck from the several point cloud clusters obtained in step 5;

[0089] Specifically, step 6 includes the following sub-steps:

[0090] Step 6.1, calculate the centroid coordinates of each point cloud cluster;

[0091] Step 6.2: Calculate the distance between the centroids of the two point cloud clusters in each point cloud cluster combination. If the distance between the centroids of the two point cloud clusters in a point cloud cluster combination does not meet the distance requirement between the gas phase flange and the liquid phase flange at the rear of the tank truck, remove the point cloud cluster combination to obtain a point cloud cluster combination that meets the Y-axis constraint condition.

[0092] Step 6.3: For each point cloud cluster combination that meets the Y-axis constraint condition obtained in step 6.2, calculate the distance between the center of mass of each point cloud cluster and the ground. If the distance between the center of mass of a point cloud cluster and the ground does not meet the distance requirement between the gas phase flange and the liquid phase flange at the rear of the tank truck and the ground, remove the point cloud cluster combination containing that point cloud cluster, and obtain a point cloud cluster combination that meets the Y-axis constraint condition and the Z-axis constraint condition.

[0093] Step 6.4, selecting a point cloud cluster combination from the point cloud cluster combinations obtained in step 6.3 as the point cloud cluster combination of the target flange at the rear of the tank truck;

[0094] Specifically, the point cloud cluster combination with the smallest X-axis coordinate is selected from the point cloud cluster combinations that meet the requirements as the point cloud cluster combination of the target flange at the rear of the tank truck;

[0095] In step 7, the point cloud cluster of the target flange at the rear of the tank truck obtained in step 6 is combined, and based on the original X-axis coordinates of each point in the point cloud cluster in the loading arm base coordinate system, the center point coordinates of the target flange at the rear of the tank truck are obtained by least squares circle fitting.

[0096] The coarse positioning method of the automatic loading arm automatic docking system of the present invention can realize the acquisition of the position coordinates of the target flange at the rear of the tank truck, that is, roughly obtain the approximate position of the target flange at the rear of the tank truck, thereby providing a basis for guiding the end of the LNG loading arm to the vicinity of the target flange at the rear of the tank truck.

[0097] Although the above describes the specific embodiments of the present invention in conjunction with the accompanying drawings, it is not a limitation of the present invention. Those skilled in the art should understand that various modifications or variations that can be made by those skilled in the art on the basis of the technical solution of the present invention without any creative work are still within the scope of protection of the present invention.

Claims

1. A rough positioning system for an automated loading arm automatic docking system, characterized in that: Including laser radar calibration module, laser radar, laser radar positioning flange module, industrial computer; The laser radar calibration module is used to calibrate the conversion matrix between the laser radar coordinate system and the loading arm base coordinate system, and transmit the conversion matrix to the laser radar positioning flange module; The laser radar is used to scan the rear area of ​​the tank truck where the target flange is located to form point cloud data, and transmit the point cloud data to the laser radar positioning flange module; The laser radar flange positioning module is used to locate the position coordinates of the target flange on the tank truck in the loading arm base coordinate system from the point cloud data; The industrial computer is connected to the laser radar positioning flange module and the driving mechanism of the LNG loading arm.

2. The rough positioning system of the automatic loading arm automatic docking system according to claim 1, characterized in that: The laser radar is installed in an explosion-proof box, and a light exit window is arranged on the explosion-proof box.

3. A rough positioning method for an automatic loading arm automatic docking system, implemented by using the rough positioning system for an automatic loading arm automatic docking system as claimed in any one of claims 1 to 2, characterized in that: The following steps are involved: Step 1, calibrating the conversion matrix between the laser radar coordinate system and the loading arm base coordinate system through the laser radar calibration module; Step 2: The laser radar scans the tank truck to obtain point cloud data, and transmits the point cloud data to the laser radar positioning flange module; Step 3: The laser radar positioning flange module converts the point cloud data to the loading arm base coordinate system according to the conversion matrix, and performs filtering on the converted point cloud to obtain the point cloud of the tank truck tail area; Step 4, performing a slice projection operation on the point cloud of the tank truck tail area obtained in step 3 to obtain n slice point clouds; Step 5, conditionally clustering the slice point cloud obtained in step 4 to obtain several point cloud clusters; Step 6, selecting a point cloud cluster combination as the target flange at the rear of the tank truck from the plurality of point cloud clusters obtained in step 5; Step 7, combining the point cloud clusters of the target flange at the rear of the tank truck obtained in step 6, and obtaining the center point coordinates of the target flange at the rear of the tank truck by least squares circle fitting based on the original X-axis coordinates of each point in the point cloud cluster in the loading arm base coordinate system.

4. The rough positioning method of the automatic loading arm automatic docking system according to claim 3, characterized in that: The step 1 includes the following sub-steps: Step 1.1, respectively obtain the coordinates and homogeneous matrices of N non-collinear points in the laser radar coordinate system and the loading arm base coordinate system; Step 1.2, calculate the transformation matrix between the laser radar coordinate system and the loading arm base coordinate system based on the N-aligned matrix obtained in step 1.

1.

5. The rough positioning method of the automatic loading arm automatic docking system according to claim 4, characterized in that: N≥3。 6. The rough positioning method of the automatic loading arm automatic docking system according to claim 4, characterized in that: The step 4 includes the following sub-steps: Step 4.1, the point cloud of the tank truck tail area obtained in step 3 is evenly divided into n areas along the X-axis direction of the loading arm base coordinate system, and the X-axis direction of the loading arm base coordinate system is parallel to the front and rear direction of the tank truck; The number of regions n that are divided is: n=[x / δd] (1) Where x is the total length of the point cloud of the tank car tail area obtained in step 3 along the X-axis direction of the loading arm base coordinate system, δd is the segmentation spacing along the X-axis direction of the loading arm base coordinate system, and [x / δd] is the rounding function; Step 4.2, the n divided regions are named region i in sequence along the positive direction of the X-axis of the loading arm base coordinate system, where i is a sequence number, i = 1, 2, 3...n; Step 4.3, reassign the X-axis coordinates of the points in each area after segmentation in the loading arm base coordinate system, so that the point cloud segmented into n areas forms a slice point cloud, specifically, The midpoint p of region i ij The original X-axis coordinate p xij Replace with P′ xij , click p ij The original X-axis coordinate p xij Normalized to p norm ij and store, and keep the original X-axis coordinates, normalized coordinates and point p ij One-to-one correspondence, the Y and Z axis coordinates remain unchanged; among them, point p ij represents the jth point in region i, where j is the serial number, j = 1, 2, 3…; p xij Represents point p ij The original X-axis coordinate in the loading arm base coordinate system, P′ xij Represents point p ij Reassign the X-axis coordinate; p norm ij represents point p ij Normalized coordinates of the X-axis coordinates in the loading arm base coordinate system; P′ xij =x×i / δd (2) p norm ij=p xij ×i / x (3) 7. The rough positioning method of the automatic loading arm automatic docking system according to claim 6, characterized in that: The step 5 comprises the following sub-steps: Step 5.1, take all the slice point clouds as the whole point cloud, and set the distance threshold l of Euclidean clustering, l<δd; Step 5.2, the normalized coordinates of the X-axis coordinates of each point in the loading arm base coordinate system are used as another constraint condition, that is, Δp norm <l norm , l norm is the specified threshold, where Δp norm is the absolute value of the difference between the normalized coordinates of two points; Step 5.3, performing Euclidean clustering according to the conditions in step 5.1 and step 5.2, to obtain multiple point cloud cluster combinations, each of which includes two point cloud clusters.

8. The rough positioning method of the automatic loading arm automatic docking system according to claim 7, characterized in that: The step 6 comprises the following sub-steps: Step 6.1, calculate the centroid coordinates of each point cloud cluster; Step 6.2, calculating the distance between the centroids of two point cloud clusters in each point cloud cluster combination. When the distance between the centroids of two point cloud clusters in a point cloud cluster combination does not meet the distance requirement between the gas phase flange and the liquid phase flange at the rear of the tank truck, the point cloud cluster combination is eliminated to obtain a point cloud cluster combination that meets the Y-axis constraint condition. Step 6.3, in each point cloud cluster combination that meets the Y-axis constraint condition obtained in step 6.2, calculate the distance between the centroid of each point cloud cluster and the ground. When the distance between the centroid of the point cloud cluster and the ground does not meet the distance requirement between the gas phase flange and the liquid phase flange at the rear of the tank truck and the ground, the point cloud cluster combination where the point cloud cluster is located is eliminated to obtain a point cloud cluster combination that meets the Y-axis constraint condition and the Z-axis constraint condition; Step 6.4, selecting a point cloud cluster combination from the point cloud cluster combinations obtained in step 6.3 as the point cloud cluster combination of the target flange at the rear of the tank truck.