WO2021087751A1

WO2021087751A1 - Distance measurement method, distance measurement device, autonomous moving platform, and storage medium

Info

Publication number: WO2021087751A1
Application number: PCT/CN2019/115741
Authority: WO
Inventors: 祝煌剑; 王俊喜; 王石荣
Original assignee: 深圳市大疆创新科技有限公司
Priority date: 2019-11-05
Filing date: 2019-11-05
Publication date: 2021-05-14
Also published as: CN112313535A

Abstract

Embodiments of the present application provide a distance measurement method, a distance measurement device, an autonomous moving platform, and a storage medium. The method comprises: obtaining a first distance between a first radar and a target point and a second distance between a second radar and the target point, wherein both the first radar and the second radar are provided on an autonomous moving platform, and the type of the first radar is different from that of the second radar; and determining a target distance between the autonomous moving platform and the target point according to the first distance and the second distance. The technical solution provided by the present embodiment ensures safety and reliability of operations performed by the autonomous moving platform.

Description

Distance detection method, distance detection equipment, autonomous mobile platform and storage medium

Technical field

The embodiments of the present invention relate to the technical field of autonomous mobile platforms, and in particular to a distance detection method, distance detection equipment, autonomous mobile platforms and storage media.

Background technique

With the rapid development of science and technology, the application fields of autonomous mobile platforms have become more and more extensive. For example, aircraft represented by drones can assist in professional aerial photography, agricultural irrigation, power line inspections, and security monitoring operations. In the process of using drones for flight operations, it is necessary to detect the flying height of the drones in order to ensure the safety of the drones. Existing technologies mostly use downward-looking flat-panel radars, ultrasonic sensors or laser ranging modules to detect the height of the drone relative to the target point below. However, the efficiency and accuracy of this detection method are low, and thus the safety and reliability of the UAV's flight operations cannot be guaranteed.

Summary of the invention

The embodiment of the present invention provides a distance detection method, a distance detection device, an autonomous mobile platform and a storage medium.

The first aspect of the present invention is to provide a distance detection method for an autonomous mobile platform, including:

Acquiring the first distance of the first radar relative to the target point and the second distance of the second radar relative to the target point, wherein the first radar and the second radar are both set on the autonomous mobile platform, And the first radar and the second radar are of different types;

According to the first distance and the second distance, the target distance of the autonomous mobile platform relative to the target point is determined.

The second aspect of the present invention is to provide a target surface information modeling method, including:

The distance detection method of the autonomous mobile platform described in the first aspect;

After determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the method further includes:

The target distance is used to perform modeling processing on the target surface where the target point is located, and the model information corresponding to the shape information of the target surface is obtained.

The third aspect of the present invention is to provide a control method of an autonomous mobile platform, including:

The target distance is used to control the autonomous mobile platform so as to maintain a preset distance between the autonomous mobile platform and the target point.

The fourth aspect of the present invention is to provide a distance detection device, where the distance detection device is a first radar or a second radar, and includes:

Memory, used to store computer programs;

The processor is configured to run a computer program stored in the memory to realize:

Acquire the first distance of the first radar relative to the target point and the second distance of the second radar relative to the target point, wherein the first radar and the second radar are both set on an autonomous mobile platform, and The type of the first radar is different from that of the second radar;

The fifth aspect of the present invention is to provide a target surface information modeling device, including:

Memory, used to store computer programs;

After determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the processor is further configured to:

Modeling processing is performed on the target surface where the target point is located by using the target distance to obtain model information corresponding to the shape information of the target surface.

The sixth aspect of the present invention is to provide a control device for an autonomous mobile platform, including:

Memory, used to store computer programs;

The seventh aspect of the present invention is to provide an autonomous mobile platform, including:

body;

The first radar is set on the autonomous mobile platform and is used to obtain the first distance of the first radar relative to the target point;

The second radar is set on the autonomous mobile platform and is used to obtain a second distance of the second radar relative to the target point, wherein the first radar and the second radar are of different types;

At least one of the first radar and the second radar is further configured to determine the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance.

The eighth aspect of the present invention is to provide a computer-readable storage medium, the storage medium is a computer-readable storage medium, the computer-readable storage medium stores program instructions, and the program instructions are used in the first aspect. The distance detection method of the autonomous mobile platform described above.

The distance detection method, distance detection device, autonomous mobile platform and storage medium provided by the embodiments of the present invention effectively ensure the reliability of detecting the distance between the autonomous mobile platform and the target point.

Description of the drawings

The drawings described here are used to provide a further understanding of the application and constitute a part of the application. The exemplary embodiments and descriptions of the application are used to explain the application, and do not constitute an improper limitation of the application. In the attached picture:

FIG. 1 is a front view of a scanning area of a radar provided by an embodiment of the present invention;

2 is a top view of a scanning area of a radar provided by an embodiment of the present invention;

3 is a schematic flowchart of a distance detection method for an autonomous mobile platform according to an embodiment of the present invention;

4 is a schematic diagram of a process of obtaining a first distance of a first radar relative to the target point according to an embodiment of the present invention;

FIG. 5 is a schematic flow chart of performing plane fitting on a target surface where the target point is located according to a plurality of the target information values according to an embodiment of the present invention to obtain plane information corresponding to the target surface;

FIG. 6 is a schematic flowchart of obtaining effective target information corresponding to the target surface where the target point is located according to the characteristic information according to an embodiment of the present invention;

FIG. 7 is a schematic flowchart of obtaining a second distance of a second radar relative to the target point according to an embodiment of the present invention;

FIG. 8 is a schematic flowchart of obtaining a second distance of a second radar relative to the target point based on the second distance information and target energy information according to an embodiment of the present invention;

FIG. 9 is a schematic flowchart of obtaining a second distance of a second radar relative to the target point according to the height normalization result and the energy normalization result according to an embodiment of the present invention;

10 is a schematic diagram 1 of the process of determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance according to an embodiment of the present invention;

FIG. 11 is a schematic flowchart of obtaining a first weighting factor corresponding to the first distance according to an embodiment of the present invention;

FIG. 12 is a schematic flowchart of determining the first weighting factor according to the first variance information and the second variance information according to an embodiment of the present invention;

FIG. 13 is a schematic flowchart of obtaining a second weighting factor corresponding to the second distance according to an embodiment of the present invention;

FIG. 14 is a schematic flowchart of determining the second weighting factor according to the first variance information and the second variance information according to an embodiment of the present invention;

15 is a schematic diagram 2 of the process of determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance according to an embodiment of the present invention;

16 is a schematic diagram 3 of the process of determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance according to an embodiment of the present invention;

FIG. 17 is a schematic flowchart of a distance detection method for an autonomous mobile platform provided by an application embodiment of the present invention;

FIG. 18 is a schematic diagram of a beam horizontal plane used by a radar device to detect a target object according to an application embodiment of the present invention;

19 is a schematic diagram of the relative position between the radar device and the grating disc provided by the application embodiment of the present invention;

20 is a schematic structural diagram of a distance detection device provided by an embodiment of the present invention;

FIG. 21 is a schematic structural diagram of a target plane information modeling apparatus provided by an embodiment of the present invention;

22 is a schematic structural diagram of a control device of an autonomous mobile platform provided by an embodiment of the present invention;

FIG. 23 is a schematic structural diagram of an autonomous mobile platform provided by an embodiment of the present invention.

Detailed ways

In order to make the objectives, technical solutions, and advantages of the embodiments of the present invention clearer, the following will clearly and completely describe the technical solutions in the embodiments of the present invention with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments These are a part of the embodiments of the present invention, but not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative work shall fall within the protection scope of the present invention.

Unless otherwise defined, all technical and scientific terms used herein have the same meaning as commonly understood by those skilled in the technical field of the present invention. The terms used in the description of the present invention herein are only for the purpose of describing specific embodiments, and are not intended to limit the present invention.

The technical solution provided in this embodiment effectively realizes the use of two different types of radar equipment to obtain the target distance of the autonomous mobile platform relative to the target point/target surface, and effectively solves the detection blind area that exists in the radar equipment. The problem of untimely and accurate data detection ensures the rapid accuracy of the target distance detection of the autonomous mobile platform relative to the target point/target surface, and ensures the safety and reliability of the autonomous mobile platform's operations.

In the process of distance detection using radar equipment, because the radar equipment is limited by the horizontal field of view (Field Of View, FOV for short), there will be a certain detection blind area under the radar equipment, as shown in Figure 1 to Figure 2, and , The size of the detection blind zone can be increased as the distance between the radar equipment and the object/ground below increases. Due to the existence of the detection blind zone, there is a huge safety threat to the operations of autonomous vehicles, unmanned aerial vehicles, and autonomous operation robots.

In specific applications, the relative distance between the radar and the obstacle can be detected by the radar device. The detection process can include: in the process of scanning a preset area by the radar device, the return data corresponding to the radar device can be obtained , And then perform spectrum extraction, processing and analysis on the return data of the radar equipment, so that the relative spatial position between the radar and the obstacle can be calculated. As for the relative spatial position or terrain distribution of the detection blind area, the data of the previous few frames can be used to predict the relative spatial position or terrain distribution of the detection blind area at the current moment. However, the above implementation of using the data of the previous few frames to predict the terrain distribution of the detection blind area at the current moment has the following problems:

(1) When using the previous frames of data for prediction, it is necessary to consider the problem of data fusion between frames, including data splicing and matching, etc., and accurate estimation of the motion model is required, and the algorithm is often very complicated;

(2) If the data quality of the first few frames is relatively low or the prediction model is inaccurate, the prediction result will deviate greatly from the actual result;

(3) Using the previous few frames of data for prediction, the detection result will have a certain delay, which is not suitable for systems with high real-time requirements;

(4) Not applicable to the moment when the autonomous mobile platform is in a relatively static state.

Hereinafter, some embodiments of the present invention will be described in detail with reference to the accompanying drawings. As long as there is no conflict between the various embodiments, the following embodiments and the features in the embodiments can be combined with each other.

Figure 3 is a schematic flowchart of a distance detection method for an autonomous mobile platform provided by an embodiment of the present invention; referring to Figure 3, this embodiment provides a distance detection method for an autonomous mobile platform, where the autonomous mobile platform can Including at least one of the following: unmanned aerial vehicle, manned aircraft, etc.; this method can accurately obtain the automatic mobile platform relative to the target point/target surface by fusing the scanning results of the two types of radar equipment set on the autonomous mobile platform The target distance. Specifically, the method may include:

Step S301: Obtain the first distance of the first radar relative to the target point and the second distance of the second radar relative to the target point, wherein the first radar and the second radar are both set on the autonomous mobile platform, and the first radar is connected to the The type of the second radar is different.

Wherein, the first radar may include at least one of the following: millimeter wave radar, lidar, and ultrasonic radar; and the second radar may include down-looking radar. In specific applications, in order to ensure the accuracy and reliability of the detection of target points, the first radar can achieve 360° omnidirectional scanning detection, for example: the first radar can be a rotating millimeter-wave radar (omnidirectional radar); or A radar can be a lidar or an ultrasonic radar. At this time, the number of the first radar can be multiple, and multiple lidars or multiple ultrasonic radars can be evenly distributed on the autonomous mobile platform to achieve 360° omnidirectional scanning Detection. Of course, those skilled in the art can also set the first radar and the second radar to other types according to specific application requirements, as long as it can ensure that the types of the first radar and the second radar are different, which will not be repeated here.

In addition, the target point may be located on a target surface, and the target surface on which the target point is located may be the ground, an inclined surface, a slope surface, or the plane of other target objects. Those skilled in the art may select different target surfaces according to specific application scenarios; When acquiring the first distance of the first radar relative to the target point and the second distance of the second radar relative to the target point, the first distance and the second distance may be distance information for the same effective target point on the target surface, and The first distance may be a first vertical distance, and the second distance may be a second vertical distance. For example, when the target surface where the target point is located is the ground, the effective target point A is set on the ground. When the first distance between the first radar and the target point is obtained, the effective distance between the first radar and the ground can be obtained. The first vertical distance between the target point A; in the same way, when the second distance between the second radar and the target point is obtained, the second vertical distance between the second radar and the effective target point A on the ground can be obtained .

Step S302: Determine the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance.

After the first distance and the second distance are obtained, the first distance and the second distance can be fused and analyzed, so that the target distance of the autonomous mobile platform relative to the target point can be determined; for example, the target point at the target point When the surface is the ground, the first distance and the second distance are both vertical distances, and both the first distance and the second distance are the distance information of the autonomous mobile platform relative to the effective target A on the ground, by comparing the first distance and the second distance Through the analysis and processing of, the target distance of the autonomous mobile platform relative to the effective target A on the ground can be obtained, and the target distance is the vertical distance.

The distance detection method of the autonomous mobile platform provided by this embodiment is to obtain the first distance of the first radar relative to the target point and the second distance of the second radar relative to the target point, and then determine according to the first distance and the second distance The target distance of the autonomous mobile platform relative to the target point effectively realizes the use of two different types of radar equipment to obtain the target distance of the autonomous mobile platform relative to the target point, which effectively solves the problem of radar equipment due to the detection blind area below. The problem of untimely and accurate data detection ensures the rapid and accurate detection of the target distance of the autonomous mobile platform relative to the target point, and effectively improves the safety and reliability of the autonomous mobile platform's operations.

Fig. 4 is a schematic diagram of the process of obtaining the first distance of the first radar relative to the target point according to an embodiment of the present invention; on the basis of the above embodiment, referring to Fig. 4, in this embodiment, for the first radar The specific acquisition method of the first distance relative to the target point is not limited, and those skilled in the art can set it according to specific application requirements and design requirements. Preferably, when the first radar is a rotatable radar device, this implementation In the example, acquiring the first distance of the first radar relative to the target point may include:

Step S401: Acquire multiple first energy information values of the reflected radar signal, and the multiple first energy information values correspond to the first radar.

Step S402: Determine the rotation angle of the first radar relative to the radar rotation center, the first distance information and the azimuth angle of the first radar relative to the target point according to the first energy information value.

Step S403: Perform coordinate conversion processing on the first distance information based on the rotation angle and the azimuth angle to obtain multiple target information values in the geodetic coordinate system.

Step S404: Perform plane fitting on the target surface where the target point is located according to multiple target information values to obtain plane information corresponding to the target surface.

Step S405: Obtain the first distance of the first radar relative to the target point according to the plane information.

Among them, after the first radar sends the radar signal to the target point, the target point can reflect the radar signal, so that the reflected radar signal can be obtained, and the reflected radar signal is analyzed and processed to identify the first radar relative to the radar rotation center. Rotation angle, first distance information and azimuth angle of the first radar relative to the target point.

After obtaining the rotation angle and the azimuth angle, the first distance information can be subjected to coordinate conversion processing based on the rotation angle and the azimuth angle, and the first distance information can be projected from the radar coordinate system to the geodetic coordinate system to obtain the first distance information relative to the first distance information. Corresponding multiple target information values, where the target information value is the information energy value corresponding to the target point. Then, effective target points can be selected based on multiple target information value pairs. In other words, the information energy value corresponding to the target point is used to filter out effective target points. And further perform plane fitting processing on the target surface where the effective target point is located, and obtain the plane information corresponding to the target surface; the first distance of the first radar relative to the target point can be obtained according to the plane information, and the first distance can be Vertical distance or direct distance.

In this embodiment, the plane fitting operation of the target surface where the target point is located is realized through the distance and azimuth of the reflected radar signal, which effectively guarantees the accuracy and reliability of obtaining the plane information corresponding to the target plane, and then, the plane information is obtained based on the plane information. The first distance to the first radar relative to the target point effectively ensures the accuracy and reliability of the first distance acquisition.

5 is a schematic diagram of a flow chart of performing plane fitting on a target surface where a target point is located according to multiple target information values according to an embodiment of the present invention to obtain plane information corresponding to the target surface; on the basis of the foregoing embodiment, continue to refer to the appendix As shown in FIG. 5, this embodiment does not limit the specific implementation process of obtaining the plane information corresponding to the target surface where the target point is located. Those skilled in the art can set according to specific application requirements and design requirements. Preferably, this In the embodiment, performing plane fitting on the target surface where the target point is located according to multiple target information values, and obtaining plane information corresponding to the target surface may include:

Step S501: Perform clustering processing on multiple target information values to obtain multiple clustering results.

Step S502: Obtain feature information corresponding to each clustering result.

Step S503: Obtain valid target information corresponding to the target surface where the target point is located according to the feature information.

Step S504: Perform plane fitting on the target surface where the target point is located according to the effective target information to obtain plane information corresponding to the target surface.

Since multiple target information values often include some noise point information and noise information, after obtaining multiple target information values, in order to ensure the quality and accuracy of the plane fitting to the target surface where the target point is located, you can Remove noise point information and noise point information in multiple target information values. Specifically, multiple target information values can be clustered to obtain multiple clustering results. At this time, each clustering result can include multiple target information values; then, the corresponding to each clustering result can be obtained The feature information may include at least one of the following: the number of valid target information (valid target points) in the clustering result in the current frame; the height average of the valid target information in the current frame is the same as that of the previous frame The difference in the fusion distance of the autonomous mobile platform relative to the target point; the height variance of the effective target point in the current frame. The current frame may refer to the collection of point cloud information obtained by the radar device at the current moment; the previous frame may refer to the collection of point cloud information obtained by the radar device at the previous moment.

In addition, when the feature information includes the number of effective target information in the clustering result in the current frame, acquiring feature information corresponding to each clustering result may include: according to the first energy information value, the first distance information, and the azimuth angle Determine the amount of valid target information in the clustering result.

Specifically, the weighting factors corresponding to the first energy information value, the first distance information, and the azimuth angle can be respectively obtained, and then a weighting factor is determined based on the first energy information value, the first distance information, the azimuth angle, and the corresponding weighting factors. Energy threshold information; and then analyze and compare all the target information values included in each clustering result with the energy threshold information, and when the target information value is greater than or equal to the energy threshold information, it can be determined that the target information is valid target information; When the target information value is less than the energy threshold information, it can be determined that the target information value is invalid target information; then the analysis and comparison results of all target information values are counted, so that the number of valid target information in the clustering result can be determined. Of course, those skilled in the art can also use other methods to obtain the number of effective target information in the clustering result, as long as the accuracy and reliability of obtaining the number of effective target information in the clustering result can be guaranteed. Go into details again.

After obtaining the feature information corresponding to each clustering result, the effective target information corresponding to the target surface where the target point is located can be obtained according to the feature information; specifically, referring to FIG. Obtaining effective target information corresponding to the target surface where the target point is located may include:

Step S601: Perform normalization processing on the characteristic information to obtain a normalization result corresponding to the characteristic information.

Step S602: Perform weighted summation processing on all normalized results to obtain weight information corresponding to the clustering results.

Step S603: Determine the target information value included in the clustering result with the largest weight information as the effective target information corresponding to the target plane where the target point is located.

Specifically, after the feature information corresponding to each clustering result is obtained, the feature information can be normalized, so that the normalized result corresponding to the feature information can be obtained; it should be noted that each cluster The feature information corresponding to the class result includes: the number of effective target information, the difference between the average height of the effective target information in the current frame and the fusion distance of the autonomous mobile platform in the previous frame relative to the target point, and the effective target in the current frame The height variance of the point; then, the normalization result corresponding to the feature information includes: the number normalization result corresponding to the number of valid target information, and the height average of the valid target information in the current frame and the previous frame The difference normalization result corresponding to the difference of the fusion distance of the autonomous mobile platform relative to the target point, and the height variance normalization result corresponding to the height variance of the effective target point in the current frame.

After obtaining the normalized results of all the feature information, all normalized results can be weighted and summed, so that the weight information corresponding to the clustering results can be obtained; and then the cluster with the largest weight information The target information value included in the result is determined as the effective target information corresponding to the target surface where the target point is located. For example, the clustering result includes clustering result one, clustering result two, and clustering result three. The weight information corresponding to the above-mentioned clustering result is weight information one, weight information two, and weight information three, respectively. Among them, the weight information 2 is greater than the weight information 3, and the weight information 3 is greater than the weight information 1. Then, the clustering result 2 corresponding to the weight information 2 can be determined as the final target clustering result, and the target clustering The target information value included in the class result is the effective target information corresponding to the target surface where the target point is located.

In this embodiment, multiple clustering results are obtained by clustering multiple target information values, and then multiple clustering results are analyzed and processed to obtain weight information corresponding to each clustering result, and The target information value included in the clustering result with the largest weight information is determined as the effective target information corresponding to the target surface where the target point is located, which effectively removes the noise point information and the noise information from the multiple target information values, The accuracy and reliability of the acquisition of effective target information is guaranteed, and the quality and accuracy of plane fitting to the target surface where the target point is located based on the effective target information is further improved.

FIG. 7 is a schematic diagram of the process of acquiring the second distance of the second radar relative to the target point according to an embodiment of the present invention; on the basis of the above-mentioned embodiment, referring to FIG. 7 continuously, this embodiment is for acquiring the second distance relative to the second radar. The specific implementation manner of the second distance to the target point is not limited, and those skilled in the art can set it according to specific application requirements and design requirements. Preferably, the acquisition of the second distance of the second radar relative to the target point in this embodiment Two distances can include:

Step S701: Acquire multiple second energy information values of the reflected radar signal, where the multiple second energy information values correspond to the second radar.

Step S702: Determine the second distance information and target energy information of the second radar relative to the target point according to the multiple second energy information values.

Step S703: Obtain a second distance of the second radar relative to the target point based on the second distance information and the target energy information.

Wherein, after the second radar sends the radar signal to the target point, the target point can reflect the radar signal, so that multiple second energy information values of the reflected radar signal can be obtained; after the multiple second energy information values are obtained, A plurality of second energy information values can be analyzed and processed, so that the second distance information and target energy information of the second radar relative to the target point can be obtained, where each target energy information corresponds to a second distance information; and then The second distance of the second radar relative to the target point can be obtained based on the second distance information and the target energy information; specifically, referring to FIG. 8, the second distance is obtained based on the second distance information and the target energy information in this embodiment. The second distance of the radar relative to the target point may include:

Step S801: Obtain the height difference between the second distance information and the historical height of the autonomous mobile platform relative to the target point.

Step S802: Perform normalization processing on the height difference and the target energy information respectively, and obtain the height normalization result and the energy normalization result corresponding to the height difference.

Step S803: Obtain the second distance of the second radar relative to the target point according to the height normalization result and the energy normalization result.

Among them, the historical height of the autonomous mobile platform relative to the target point may refer to the height information of the autonomous mobile platform relative to the target point obtained at the previous moment or historical moment; after obtaining the second distance information and the target energy information, it can be obtained To the height difference between the second distance information and the historical height, and then normalize the height difference and the target energy information value respectively to obtain the height normalization result and energy normalization corresponding to the height difference Result; Afterwards, the second distance of the second radar relative to the target point can be obtained based on the height normalization result and the energy normalization result. Specifically, referring to FIG. 9, obtaining the second distance of the second radar relative to the target point according to the height normalization result and the energy normalization result in this embodiment may include:

Step S901: Perform weighted summation processing on the height normalization result and the energy normalization result to obtain weight information corresponding to the second energy information value.

Step S902: Determine the second distance information corresponding to the second energy information value with the largest weight as the second distance of the second radar relative to the target point.

Specifically, after obtaining the height normalization result and the energy normalization result, the height weight information corresponding to the height normalization result and the energy weight information corresponding to the energy normalization result can be determined, and then Perform weighted sum processing based on the height weight information, energy weight information, height normalization result, and energy normalization result, so that the weight information corresponding to the second energy information value can be obtained; among them, due to the second energy There are multiple information values, and each second energy information value corresponds to one second distance information. Therefore, after obtaining the weight information corresponding to all the second energy information values, all the weight information can be analyzed and compared, and the second distance information corresponding to the second energy information value with the largest weight can be determined as The second distance of the second radar relative to the target point.

In this embodiment, by acquiring multiple second energy information values of the reflected radar signal, the multiple second energy information values correspond to the second radar, and the second radar relative to the target point is determined according to the multiple second energy information values The second distance information and target energy information of the second distance information and target energy information, and the second distance of the second radar relative to the target point is obtained based on the second distance information and target energy information, which effectively ensures the timeliness and reliability of the second distance acquisition, and further improves Based on the first distance and the second distance, the accuracy and reliability of the target distance of the autonomous mobile platform relative to the target point is determined.

FIG. 10 is a schematic flowchart of determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance provided by an embodiment of the present invention; on the basis of the above embodiment, referring to FIG. 10, this embodiment For example, the specific implementation method of determining the target distance of the autonomous mobile platform relative to the target point is not limited. Those skilled in the art can set it according to the specific application requirements and design requirements. Preferably, in this embodiment, according to the first distance Determining the target distance of the autonomous mobile platform relative to the target point with the second distance may include:

Step S1001: Obtain a first weighting factor corresponding to the first distance and a second weighting factor corresponding to the second distance.

Step S1002: Use the first weighting factor and the second weighting factor to perform weighting processing on the first distance and the second distance to obtain the target distance of the autonomous mobile platform relative to the target point.

Wherein, when using the first distance and the second distance to determine the target distance of the autonomous mobile platform relative to the target point, the first weighting factor corresponding to the first distance and the second weighting factor corresponding to the second distance can be obtained first , Where the values of the first weighting factor and the second weighting factor can be adjusted and changed according to different application scenarios; then the first weighting factor and the second weighting factor can be used to weight the first distance and the second distance, In this way, the target distance of the autonomous mobile platform relative to the target point can be obtained.

For example, the first distance is L1, the second distance is L2, the first weighting factor corresponding to the first distance L1 is α, and the second weighting factor corresponding to the second distance L2 is β, so that autonomous movement can be obtained The target distance between the platform and the target point is L=α*L1+β*L2. It is understandable that in different application scenarios, the values of the first weighting factor α and the second weighting factor β can be different, so that the target distance of the autonomous mobile platform corresponding to the target point in different application scenarios can be accurately obtained. .

In this embodiment, by obtaining the first weighting factor corresponding to the first distance and the second weighting factor corresponding to the second distance, and using the first weighting factor and the second weighting factor, the first distance and the second The distance is weighted to obtain the target distance of the autonomous mobile platform relative to the target point, which effectively ensures the accuracy and reliability of the determination of the target distance of the autonomous mobile platform relative to the target point.

Fig. 11 is a schematic diagram of a process for obtaining a first weighting factor corresponding to a first distance according to an embodiment of the present invention; on the basis of the foregoing embodiment, referring to Fig. 11, the The specific implementation of the first weighting factor corresponding to the distance is not limited, and those skilled in the art can set it according to specific application scenarios and application requirements. Preferably, the acquisition of the first weighting factor corresponding to the first distance in this embodiment is not limited. A weighting factor can include:

Step S1101: Obtain first variance information corresponding to the first distance detected by the first radar and second variance information corresponding to the second distance detected by the second radar.

Step S1102: Determine a first weighting factor according to the first variance information and the second variance information.

Wherein, after the first distance detected by the first radar and the second distance detected by the second radar are obtained, the first variance information corresponding to the first distance and the second variance information corresponding to the second distance can be obtained; Then, the first weighting factor is determined according to the first variance information and the second variance information; specifically, referring to FIG. 12, in this embodiment, the first weighting factor can be determined according to the first variance information and the second variance information. include:

Step S1201: Obtain the sum of the variances of the first variance information and the second variance information.

Step S1202: Determine the ratio of the second variance information to the sum of variances as the first weighting factor.

Specifically, after obtaining the first variance information corresponding to the first distance detected by the first radar and the second variance information corresponding to the second distance detected by the second radar, the first variance information and the second variance information can be obtained. The sum of the variances of the variance information, and then the ratio of the second variance information to the sum of variances can be determined as the first weighting factor. The ratio of the first variance information to the sum of variances can be determined as the first weighting factor, thereby ensuring the first weighting factor. Accurate reliability obtained by a weighting factor.

FIG. 13 is a schematic diagram of a process for obtaining a second weighting factor corresponding to a second distance according to an embodiment of the present invention; on the basis of the foregoing embodiment, referring to FIG. The specific implementation of the second weighting factor corresponding to the distance is not limited, and those skilled in the art can set it according to specific application scenarios and application requirements. Preferably, the acquisition of the second weighting factor corresponding to the second distance in this embodiment is not limited. Two weighting factors can include:

Step S1301: Obtain first variance information corresponding to the first distance detected by the first radar and second variance information corresponding to the second distance detected by the second radar.

Step S1302: Determine a second weighting factor according to the first variance information and the second variance information.

Wherein, after the first distance detected by the first radar and the second distance detected by the second radar are obtained, the first variance information corresponding to the first distance and the second variance information corresponding to the second distance can be obtained; Then the second weighting factor is determined according to the first variance information and the second variance information; specifically, referring to FIG. 14, the second weighting factor can be determined according to the first variance information and the second variance information in this embodiment. include:

Step S1401: Obtain the sum of the variances of the first variance information and the second variance information;

Step S1402: Determine the ratio of the first variance information and the sum of variance as the second weighting factor.

Specifically, after obtaining the first variance information corresponding to the first distance detected by the first radar and the second variance information corresponding to the second distance detected by the second radar, the first variance information and the second variance information can be obtained. The sum of variances of the variance information, and then the ratio of the first variance information to the sum of variances can be determined as the second weighting factor, thereby ensuring the accuracy and reliability of obtaining the second weighting factor.

15 is a schematic diagram of the second process of determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance provided by an embodiment of the present invention; on the basis of any of the above embodiments, continue to refer to FIG. 15 When the areas detected by the first radar and the second radar partially overlap in the same time, determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance in this embodiment may include:

Step S1501: Determine the detection overlap area and the non-overlap area formed between the first radar and the second radar.

Step S1502: Estimate the target distance of another effective target in the adjacent non-overlapping area according to the first distance and the second distance of the first radar and the second radar to the same effective target in the detection overlap area.

Among them, due to the different types of the first radar and the second radar, in general, when the first radar and the second radar are set on the autonomous mobile platform, the first radar and the second radar can be set on the autonomous mobile platform. At different locations. At this time, when the first radar and the second radar are used for area scanning, the detection area between the first radar and the second radar may be different. When the detection area between the first radar and the second radar is different, the detection area of the first radar and the detection area of the second radar may constitute a detection overlap area and a non-overlap area. For detecting overlapping areas, the first distance of the first radar relative to the target point and the second distance of the second radar relative to the target point can be obtained, and then the autonomous mobile platform relative to the target point can be determined according to the first distance and the second distance. The target distance of the target point. For non-overlapping areas, generally only one of the first distance and the second distance can be obtained. For example, the first distance can be obtained but the second distance cannot be obtained. At this time, in order to be able to detect the distance between the autonomous mobile platform and the target point in the non-overlapping area, the first distance and the second distance of the first radar and the second radar for the same effective target in the overlapping area can be detected, To estimate the target distance of another effective target in the adjacent non-overlapping area.

For example, the detection overlap area A and the non-overlap area B formed between the first radar and the second radar are acquired, where the detection overlap area A and the non-overlap area B are adjacent to each other. When it is necessary to perform distance detection on the effective target b in the non-overlapping area B, the first distance La1 and the second distance La2 for the same effective target a in the detection overlap area A domain of the first radar and the second radar can be obtained, and then The target distance of another effective target b in the adjacent non-overlapping area B can be estimated based on the first distance La1 and the second distance La2; specifically, the first distance La1 and the second distance La2 can be used to determine the autonomous mobile platform first The target distance La relative to the effective target a; then the effective target b in the non-overlapping area B can be estimated based on the detection of the overlapping area A, the non-overlapping area B, the target distance La, and the distance information between the effective target a and the effective target b Target distance Lb.

In this embodiment, by determining the detection overlap area and non-overlap area formed between the first radar and the second radar, and then according to the first radar and the second radar in the detection overlap area for the first distance and the first distance to the same effective target The second distance is to estimate the target distance of another effective target in the adjacent non-overlapping area, which effectively realizes the accuracy and reliability of determining the target distance of another effective target in the adjacent non-overlapping area, and further improves The scope of application of this method.

16 is a schematic diagram of the third process of determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance provided by an embodiment of the present invention; on the basis of any of the above embodiments, continue to refer to FIG. 16 When the target point includes the first effective target and the second effective target, determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance in this embodiment may include:

Step S1601: Determine whether the first distance and the second distance corresponding to the first valid target are valid.

Step S1602: When the first distance is invalid, estimate the target distance of the first valid target according to the second distance of the first valid target, the first distance and the second distance corresponding to the second valid target, where the first The distance between the effective target and the second effective target is less than or equal to the preset threshold.

Wherein, when the first effective target and the second effective target exist on the target point, and the distance between the first effective target and the second effective target is less than or equal to the preset threshold, it is determined that the autonomous mobile platform is relative to the first effective target In the process of the target distance, if the first distance of the first radar relative to the first effective target or the second distance of the second radar relative to the first effective target is invalid, the autonomous mobile platform can be relative to the second effective target To estimate the target distance of the autonomous mobile platform relative to the first effective target.

Specifically, when determining the target distance between the autonomous mobile platform and the first effective target, it can be determined whether the first distance and the second distance corresponding to the first effective target are valid. The specific implementation method may be: The distance and the second distance are analyzed and compared with the preset distance range respectively. If the first distance and the second distance are both within the preset distance range, it can be determined that both the first distance and the second distance are valid; or, in the first distance When the distance and the second distance both exceed the preset distance range, it can be determined that both the first distance and the second distance are invalid. For example, when it is determined that the first distance is invalid, the target distance of the first valid target is estimated according to the second distance corresponding to the first valid target, the first distance and the second distance corresponding to the second valid target .

For example, when the target point includes the first effective target A and the second effective target B, the distance between the first effective target A and the second effective target B is less than or equal to the preset threshold. Then, the first distance LA1 and the second distance LA2 corresponding to the first valid target A can be obtained, and the first distance LB1 and the second distance LB2 corresponding to the second valid target B can be obtained. When the first distance LA1 is invalid , The first distance LB1 and the second distance LB2 can be used to determine the target distance LB corresponding to the second effective target B; then based on the target distance LB, the distance information between the first effective target A and the second effective target B, and The second distance LA2 is used to estimate the target distance LA corresponding to the first effective target A.

In this embodiment, by judging whether the first distance and the second distance corresponding to the first valid target are valid, when the first distance is invalid, it can correspond to the second valid target according to the second distance of the first valid target The first distance and the second distance are estimated to be the target distance of the first effective target, thereby effectively achieving the accuracy and reliability of determining the target distance of the first effective target.

For specific applications, take the UAV as the autonomous mobile platform, the omnidirectional millimeter-wave radar as the first radar, the downward-looking flat panel radar as the second radar, and the ground as the target surface where the target point is located as an example; refer to Figure 17 As shown, this application embodiment provides a distance detection method for an autonomous mobile platform. The distance detection method can be realized: based on the scanning result of the rotating millimeter wave radar, the ground points are filtered out from the scanning results, and the ground points are used to perform the ground detection. Fitting, according to the fitting results to estimate the terrain information of the ground, and at the same time, fusing the detection results of the down-looking flat panel radar to accurately estimate the height information of the UAV relative to the ground. Specifically, the distance detection method may include a processing process of ground terrain estimation based on omnidirectional radar, height detection based on downward-looking flat panel radar, and fusion of terrain estimation and height detection results. The above processing procedure is described in detail below:

1. Ground terrain estimation based on omnidirectional radar

(1) Data extraction

When the transmitting beam of the millimeter wave radar reaches the target object, the echo signal reflected by the target object can be obtained. After the echo signal is acquired, a series of signal processing can be performed on the echo signal, so that the observation value of the target object (target distance, angle, signal strength, etc.) can be obtained. Specifically, after analyzing and processing the above echo signals, the following parameters can be obtained:

a) The target distance r and azimuth angle θ of the millimeter wave radar relative to the target object, refer to Figure 18;

b) The grating sensor can obtain the rotation angle φ of the millimeter wave radar relative to the radar rotation center at the current moment, refer to Figure 19.

(2) Coordinate conversion

The target distance r and the azimuth angle θ of the millimeter wave radar relative to the target object are transformed into coordinates, and the radar coordinate system is projected to the earth coordinate system. Specifically, the coordinate transformation includes:

Among them, i represents when the radio frequency board of the millimeter wave radar turns to the i-th optical grid, j represents the detected obstacle on the ground, and x _{i, j} represents the obstacle relative to the center of the radar. Horizontal distance, y _i,j represents the depth of field distance of the obstacle relative to the radar center, z _i,j represents the vertical distance of the obstacle relative to the radar center; r _i,j represents the radial distance of the obstacle relative to the radar center, θ _{i, j} represent the azimuth angle of the obstacle relative to the radar;

It represents the current position of the optical grid corresponding to the radio frequency board of the millimeter wave radar, and A represents the identification information of the radar coordinate system.

Then, the first distance information located in the radar coordinate system is converted to the geodetic coordinate system, which specifically includes:

In the above formula:

Among them, T is the rotation matrix, G is the identification information of the geodetic coordinate system,

Is the attitude quaternion with the radar

Corresponding linear algebra representation;

It is the radar attitude quaternion obtained in real time from the Inertial Measurement Unit (IMU), which is used to calculate the radar attitude information at the current time; in specific applications, the geodetic coordinate system used in this embodiment is northeast The East-North-UP coordinate system (ENU), therefore,

Indicates the upward distance of the target object relative to the origin of the coordinates, which is true north,

Indicates the distance of the target object relative to the origin of the coordinates.

Indicates the vertical distance of the target object relative to the coordinate origin.

(3) Data screening

After obtaining multiple target information values that have been projected into the geodetic coordinate system, effective ground points can be filtered out for estimation of ground terrain. The specific implementation steps of screening are as follows:

A) Perform cluster analysis based on the z value of multiple target information values, that is, the vertical distance of the detected target object relative to the radar device;

B) Calculate the feature information of each point cluster of the clustering result, the feature information includes at least one of the following:

a) The number of effective target points Ni in the point cluster;

b) The difference Di between the mean value of the height (z value) of the effective target point in the point cluster and the fusion height of the previous frame;

c) The variance σi of the height value of the effective target point in the point cluster;

C) After the feature information of each point cluster in the clustering result is obtained, each feature value of each point cluster can be normalized to obtain the normalized result corresponding to the number of effective target points Ni

The normalized result corresponding to the difference between the mean value of the height (z value) of the effective target point and the fusion height of the previous frame Di

The normalized result corresponding to the variance σi of the height value of the effective target point in the point cluster

_{Specifically, the weight information w n} , w _d , and w _σ corresponding to the above-mentioned normalized feature values is assigned according to the empirical value, and then the weighted value S _{i of} each feature value can be obtained;

After obtaining the weighted values corresponding to multiple point clusters, the detection point of the point cluster with the largest _{weighting value S i can be used as the effective ground point.}

D) Ground fitting

After the effective ground points are obtained, plane fitting can be performed on the filtered effective ground points. The plane equation is as follows:

Z _G ＝aX _G +bY _G +c

Among them, the normal vector

Can identify the slope of the ground, the straight-line distance from the origin of the coordinate to the plane

Identifies the vertical distance of the UAV/radar from the ground.

2. Height detection based on down-looking flat-panel radar

(1) Data extraction

When the transmitting beam of the downward-looking flat panel radar reaches the target object, the echo signal reflected by the target object can be obtained. After the echo signal is obtained, a series of signal processing can be performed on the echo signal, so that the target distance r and the target energy e of the target object can be obtained.

(2) Data screening/height calculation

_{A) Obtain the feature information of a series of targets {T 1} , T ₂ ,...T _N } detected by the down-looking flat panel radar. The feature information can include the following information:

a) The difference Di between the target distance and the fusion height; b) The target energy Ei.

B) Normalize each characteristic value of each target to obtain the normalized result;

Among them, Emax is the maximum energy information that the radar can detect an effective target.

_{Then, the weights w d} and w _e corresponding to the normalization results of each feature are assigned according to the empirical value, and then the weighted summation processing is performed on all the normalization results of the features to obtain the weighted value S _{i of the} normalization results of each feature.

Then, the weighting value of the height information by S _i between the maximum detection range of the detection target is detected as ri lower viewing radar and radar ground plate.

3. Highly fusion of detection results

The terrain detection result of the omnidirectional radar and the height detection result of the down-looking radar are merged to realize the height estimation operation of the UAV (the carrier of the radar equipment). Specifically, the αβ filter can be used for the omnidirectional radar and the downward-looking radar. Fusion is performed based on the radar detection results.

h _f =αh _O +βh _B

H _O ={h _O ^ik ,...h _O ^i-1 , h _O ⁱ }

H _B ={h _B ^ik ,...h _B ^i-1 , h _B ⁱ }

In the above formula, h _f is the final fusion height of the UAV relative to the ground, h _O is the height of the radar/UAV relative to the ground extracted from the terrain information of the omnidirectional radar output, and h _B is the output of the down-looking radar. The height of the radar/UAV relative to the ground; α is _{the weight of h O} , which is normalized by the variance of the height detected by the omnidirectional radar, and β is _{the weight of h B} , which is normalized by the variance of the height detected by the downward-looking radar. To get.

Wherein, when acquiring the distance information and azimuth information of the target object relative to the radar, this application embodiment uses a microwave radar to acquire the distance information and azimuth information of the target object relative to the radar. It should be noted that those skilled in the art can also use other methods to obtain the distance information and azimuth angle information of the target object relative to the radar, for example, obtain the distance information and azimuth angle information of the target object through lidar. Linear lidar can achieve accurate and fast ranging and angle measurement, and the precision of ranging and angle measurement is much better than microwave radar. However, the disadvantages of lidar are: (1) It has high requirements on the light environment and is easily interfered by external light sources; (2) the cost of lidar is very high. Alternatively, the distance information and azimuth angle information of the target object can also be obtained through the ultrasonic sensor, which has a great cost advantage. However, the defects of ultrasonic sensors are: (1) The measurement range is short, which is suitable for short-distance measurement; (2) The ultrasonic sensor uses the reflection of mechanical waves for distance measurement, and the mechanical waves are susceptible to interference.

In summary, when using different radar equipment to obtain the distance information and azimuth information of the target object relative to the radar, it can have different priorities and shortcomings. Those skilled in the art can flexibly choose different ones according to different application scenarios and application requirements. Radar equipment is implemented, so I won’t go into details here.

The distance detection method provided in this embodiment solves the problem of the detection blind area below due to the horizontal field of view when the radar equipment is used to detect the surrounding environment. The distance detection method by fusing the omnidirectional radar and the downward-looking radar , To make up for the detection blind area below, to realize the rapid and accurate detection of the terrain information of the ground below, to ensure the accuracy and reliability of the detection of the distance between the drone and the ground, and to further improve the safety of the autonomous operation of the drone. Sex.

On the basis of any of the foregoing embodiments, this embodiment provides a method for modeling target surface information, including:

Fig. 3-The distance detection method of the autonomous mobile platform in the embodiment corresponding to Fig. 19;

After determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the method in this embodiment may further include:

Step S1701: Perform modeling processing on the target surface where the target point is located by using the target distance to obtain model information corresponding to the shape information of the target surface.

Specifically, after determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the target distance can be used to model the target surface where the target point is located, so as to obtain the shape information of the target surface Corresponding model information, so as to facilitate the realization that the autonomous mobile platform can perform terrain following operations on the target surface based on the model information, thereby improving the quality and effect of the autonomous mobile platform's operations.

The target surface information modeling method provided in this embodiment uses the target distance to model the target surface where the target point is located, and obtains model information corresponding to the shape information of the target surface, and then enables the autonomous mobile platform to be based on the model The information performs terrain following operations on the target surface, effectively ensuring the safety and reliability of the autonomous mobile platform for operations.

On the basis of any of the above embodiments, this embodiment provides a method for controlling an autonomous mobile platform, including:

Step S1801: Use the target distance to control the autonomous mobile platform so as to maintain a preset distance between the autonomous mobile platform and the target point.

Among them, after determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the target distance can be used to control the autonomous mobile platform, so that a preset distance is maintained between the autonomous mobile platform and the target point. , The target distance between the autonomous mobile platform and the target point can be obtained, and then the target distance is analyzed and compared with the preset distance. When the target distance is greater than the preset distance, the autonomous mobile platform is adjusted to make the autonomous mobile platform The distance to the target point decreases from the target distance to the preset distance; when the target distance is less than the preset distance, the autonomous mobile platform is adjusted so that the distance between the autonomous mobile platform and the target point increases from the target distance to The preset distance ensures the safety and reliability of the autonomous mobile platform.

The control method of the autonomous mobile platform provided in this embodiment uses the target distance to control the autonomous mobile platform so as to maintain a preset distance between the autonomous mobile platform and the target point, thereby effectively ensuring the safety of the autonomous mobile platform for operations Reliability further improves the practicability of the method, which is conducive to market promotion and application.

FIG. 20 is a schematic structural diagram of a distance detection device provided by an embodiment of the present invention; as shown in FIG. 20, this embodiment provides a distance detection device for distance detection of an autonomous mobile platform. It may include at least one of the following: unmanned aerial vehicle, manned aircraft, etc.; in specific applications, the distance detection device may be a first radar or a second radar. Specifically, the distance detection device may include:

The first memory 12 is used to store computer programs;

The first processor 11 is configured to run a computer program stored in the first memory 12 to implement:

Obtain the first distance of the first radar relative to the target point and the second distance of the second radar relative to the target point, wherein the first radar and the second radar are both set on the autonomous mobile platform, and the first radar and the second radar Different types;

Wherein, the structure of the distance detection device may further include a first communication interface 13 for the electronic device to communicate with other devices or a communication network.

Further, the first distance and the second distance are distance information of the same effective target point, and the first distance is the first vertical distance, the second distance is the second vertical distance, and the target surface on which the target point is located is the ground.

Further, when the first processor 11 obtains the first distance of the first radar relative to the target point, the first processor 11 is configured to execute: obtain multiple first energy information values of the reflected radar signal, and multiple first energy information values. The energy information value corresponds to the first radar; the rotation angle of the first radar relative to the radar rotation center, the first distance information and the azimuth angle of the first radar relative to the target point are determined according to the first energy information value; based on the rotation angle and azimuth The angle performs coordinate conversion processing on the first distance information to obtain multiple target information values located in the geodetic coordinate system; according to the multiple target information values, perform plane fitting on the target surface where the target point is located, and obtain the plane information corresponding to the target surface ; Obtain the first distance of the first radar relative to the target point according to the plane information.

Further, when the first processor 11 performs plane fitting on the target surface where the target point is located according to the multiple target information values, and obtains the planar information corresponding to the target surface, the first processor 11 is configured to execute: The information value is clustered to obtain multiple clustering results; the characteristic information corresponding to each clustering result is obtained; the effective target information corresponding to the target surface where the target point is located is obtained according to the characteristic information; the target point is determined according to the effective target information Perform plane fitting on the target surface to obtain plane information corresponding to the target surface.

Further, the feature information includes at least one of the following: the number of effective target information in the clustering result in the current frame; the fusion of the average height of the effective target information in the current frame and the autonomous mobile platform in the previous frame relative to the target point The difference in distance; the height variance of the effective target point in the current frame.

Further, when the feature information includes the number of effective target information in the clustering result in the current frame, when the first processor 11 obtains the feature information corresponding to each clustering result, the first processor 11 is configured to execute : Determine the number of effective target information in the clustering result according to the first energy information value, the first distance information and the azimuth angle.

Further, when the first processor 11 obtains the effective target information corresponding to the target surface where the target point is located according to the characteristic information, the first processor 11 is configured to perform: normalize the characteristic information to obtain the characteristic information. Corresponding normalized results; weighted summation of all normalized results to obtain weight information corresponding to the clustering results; the target information value included in the clustering result with the largest weight information is determined as Effective target information corresponding to the target surface where the target point is located.

Further, when the first processor 11 acquires the second distance of the second radar relative to the target point, the first processor 11 is configured to execute: acquire multiple second energy information values of the reflected radar signal, and multiple second The energy information value corresponds to the second radar; the second distance information and the target energy information of the second radar relative to the target point are determined according to the multiple second energy information values; the second radar relative information is obtained based on the second distance information and the target energy information The second distance to the target point.

Further, when the first processor 11 obtains the second distance of the second radar relative to the target point based on the second distance information and the target energy information, the first processor 11 is configured to execute: obtain the second distance information and the autonomous mobile platform The height difference between the historical height relative to the target point; the height difference and the target energy information are respectively normalized to obtain the height normalization result and the energy normalization result corresponding to the height difference; according to The height normalization result and the energy normalization result obtain the second distance of the second radar relative to the target point.

Further, when the first processor 11 obtains the second distance of the second radar relative to the target point according to the height normalization result and the energy normalization result, the first processor 11 is configured to execute: normalize the height result And the energy normalization result to perform weighted sum processing to obtain the weight information corresponding to the second energy information value; the second distance information corresponding to the second energy information value with the largest weight is determined as the second radar relative to The second distance of the target point.

Further, when the first processor 11 determines the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the first processor 11 is configured to execute: obtain the first weight corresponding to the first distance Factor and a second weighting factor corresponding to the second distance; using the first weighting factor and the second weighting factor, the first distance and the second distance are weighted to obtain the target distance of the autonomous mobile platform relative to the target point.

Further, when the first processor 11 obtains the first weighting factor corresponding to the first distance, the first processor 11 is configured to execute: obtain the first variance information corresponding to the first distance detected by the first radar and The second variance information corresponding to the second distance detected by the second radar; the first weighting factor is determined according to the first variance information and the second variance information.

Further, when the first processor 11 determines the first weighting factor according to the first variance information and the second variance information, the first processor 11 is configured to execute: obtain the difference between the variance of the first variance information and the second variance information和; Determine the ratio of the first variance information to the sum of the variances as the first weighting factor.

Further, when the first processor 11 obtains the second weighting factor corresponding to the second distance, the first processor 11 is configured to execute: obtain the first variance information corresponding to the first distance detected by the first radar and The second variance information corresponding to the second distance detected by the second radar; the second weighting factor is determined according to the first variance information and the second variance information.

Further, when the first processor 11 determines the second weighting factor according to the first variance information and the second variance information, the first processor 11 is configured to execute: obtain the difference between the variance of the first variance information and the second variance information和; Determine the ratio of the second variance information to the sum of the variances as the second weighting factor.

Further, the areas detected by the first radar and the second radar at the same time partially overlap; when the first processor 11 determines the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the first processing The device 11 is used to perform: determine the detection overlap area and the non-overlap area formed between the first radar and the second radar; according to the first radar and the second radar in the detection overlap area for the same effective target first distance and second distance Distance: Estimate the target distance of another effective target in the adjacent non-overlapping area.

Further, the target point includes a first effective target and a second effective target; when the first processor 11 determines the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the first processor 11 is configured to Execution: Determine whether the first distance and the second distance corresponding to the first valid target are valid; when the first distance is invalid, the second distance of the first valid target, the first distance corresponding to the second valid target, and the The second distance is to estimate the target distance of the first effective target, where the distance between the first effective target and the second effective target is less than or equal to a preset threshold.

Further, the first radar includes at least one of the following: millimeter wave radar, lidar, and ultrasonic radar; and the second radar includes down-looking radar.

The device shown in Fig. 20 can execute the methods of the embodiments shown in Figs. 3-19. For parts that are not described in detail in this embodiment, please refer to the relevant descriptions of the embodiments shown in Figs. 3-19. For the implementation process and technical effects of this technical solution, please refer to the description in the embodiment shown in FIG. 3 to FIG. 19, which will not be repeated here.

FIG. 21 is a schematic structural diagram of a target surface information modeling device provided by an embodiment of the present invention; referring to FIG. 21, this embodiment provides a target surface information modeling device, including:

The second memory 22 is used to store computer programs;

The second processor 21 is configured to run a computer program stored in the second memory 22 to implement:

The distance detection method of the autonomous mobile platform of the above-mentioned Figure 3-Figure 19;

After determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the second processor 21 is further configured to:

The target distance is used to model the target surface where the target point is located, and the model information corresponding to the shape information of the target surface is obtained.

Wherein, the structure of the target plane information modeling apparatus may further include a second communication interface 23 for the electronic device to communicate with other devices or a communication network.

The device shown in Fig. 21 can execute the methods of the embodiments shown in Figs. 3-19. For parts that are not described in detail in this embodiment, please refer to the related descriptions of the embodiments shown in Figs. 3-19. For the implementation process and technical effects of this technical solution, please refer to the description in the embodiment shown in FIG. 3 to FIG. 19, which will not be repeated here.

FIG. 22 is a schematic structural diagram of a control device for an autonomous mobile platform according to an embodiment of the present invention; referring to FIG. 22, this embodiment provides a control device for an autonomous mobile platform, including:

The third memory 32 is used to store computer programs;

The third processor 31 is configured to run a computer program stored in the third memory 32 to implement:

The distance detection method of an autonomous mobile platform according to any one of claims 1-15;

Use the target distance to control the autonomous mobile platform so that the preset distance is maintained between the autonomous mobile platform and the target point.

Wherein, the structure of the control device of the autonomous mobile platform may further include a third communication interface 33 for the electronic device to communicate with other devices or a communication network.

The device shown in Fig. 22 can execute the methods of the embodiments shown in Figs. 3-19. For parts that are not described in detail in this embodiment, please refer to the relevant descriptions of the embodiments shown in Figs. 3-19. For the implementation process and technical effects of this technical solution, please refer to the description in the embodiment shown in FIG. 3 to FIG. 19, which will not be repeated here.

Figure 23 is a schematic structural diagram of an autonomous mobile platform provided by an embodiment of the present invention. With reference to Figure 23, this embodiment provides an autonomous mobile platform. The autonomous mobile platform may include unmanned aerial vehicles, manned aircraft, etc. Etc. Specifically, the autonomous mobile platform may include:

Body 41;

The first radar 42 is set on the autonomous mobile platform and used to obtain the first distance of the first radar 42 relative to the target point;

The second radar 43 is set on the autonomous mobile platform and used to obtain the second distance of the second radar 43 relative to the target point, where the first radar 42 and the second radar 43 are of different types;

At least one of the first radar 42 and the second radar 43 is also used to determine the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance.

Further, the first distance and the second distance are distance information for the same effective target point, and the first distance is the first vertical distance, the second distance is the second vertical distance, and the target surface on which the target point is located is the ground.

Further, when the first radar 42 acquires the first distance of the first radar 42 with respect to the target point, the first radar 42 is used to execute: acquire multiple first energy information values of the reflected radar signal, multiple first The energy information value corresponds to the first radar 42; the rotation angle of the first radar 42 relative to the radar rotation center, the first distance information and the azimuth angle of the first radar 42 relative to the target point are determined according to the first energy information value; based on the rotation Angle and azimuth perform coordinate conversion processing on the first distance information to obtain multiple target information values located in the geodetic coordinate system; perform plane fitting on the target surface where the target point is located according to multiple target information values to obtain the corresponding target surface The plane information; the first distance of the first radar 42 relative to the target point is obtained according to the plane information.

Further, when the first radar 42 performs plane fitting on the target surface where the target point is located according to multiple target information values, and obtains the planar information corresponding to the target surface, the first radar 42 is used to perform: Perform clustering processing to obtain multiple clustering results; obtain the characteristic information corresponding to each clustering result; obtain effective target information corresponding to the target surface where the target point is located according to the characteristic information; Perform plane fitting on the target surface to obtain plane information corresponding to the target surface.

Further, when the feature information includes the number of effective target information in the clustering result in the current frame, when the first radar 42 obtains the feature information corresponding to each clustering result, the first radar 42 may be used to execute: The number of effective target information in the clustering result is determined according to the first energy information value, the first distance information and the azimuth angle.

Further, when the first radar 42 obtains the effective target information corresponding to the target surface where the target point is located according to the feature information, the first radar 42 is used to perform: normalize the feature information to obtain the information corresponding to the feature information Normalized results; weighted summation of all normalized results to obtain weight information corresponding to the clustering results; the target information value included in the clustering result with the largest weight information is determined as the target point Valid target information corresponding to the target surface.

Further, when the second radar 43 obtains the second distance of the second radar 43 with respect to the target point, the second radar 43 is used to execute: obtain multiple second energy information values of the reflected radar signal, and multiple second energy information values. The information value corresponds to the second radar 43; the second distance information and target energy information of the second radar 43 relative to the target point are determined according to multiple second energy information values; the second radar is obtained based on the second distance information and target energy information 43 The second distance relative to the target point.

Further, when the second radar 43 obtains the second distance of the second radar 43 relative to the target point based on the second distance information and the target energy information, the second radar 43 is used to execute: obtain the second distance information relative to the autonomous mobile platform The height difference between the historical heights of the target point; the height difference and the target energy information are respectively normalized to obtain the height normalization result and the energy normalization result corresponding to the height difference; according to the height The normalized result and the energy normalized result obtain the second distance of the second radar relative to the target point.

Further, when the second radar 43 obtains the second distance of the second radar 43 relative to the target point according to the height normalization result and the energy normalization result, the second radar 43 is used to perform: The energy normalization result is weighted and summed to obtain the weight information corresponding to the second energy information value; the second distance information corresponding to the second energy information value with the largest weight is determined as the second radar 43 relative to The second distance of the target point.

Further, at least one of the first radar 42 and the second radar 43: when determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the first radar 42 and/or the second radar 43 are used For execution: obtain the first weighting factor corresponding to the first distance and the second weighting factor corresponding to the second distance; use the first weighting factor and the second weighting factor to weight the first distance and the second distance , To obtain the target distance of the autonomous mobile platform relative to the target point.

Further, when the first radar 42 and/or the second radar 43 acquires the first weighting factor corresponding to the first distance, the first radar 42 and/or the second radar 43 is used to execute: obtain the detection of the first radar 42 The first variance information corresponding to the first distance and the second variance information corresponding to the second distance detected by the second radar 43; the first weighting factor is determined according to the first variance information and the second variance information.

Further, when the first radar 42 and/or the second radar 43 determines the first weighting factor according to the first variance information and the second variance information, the first radar 42 and/or the second radar 43 are used to perform: The sum of variances of the variance information and the second variance information; the ratio of the first variance information to the sum of variances is determined as the first weighting factor.

Further, when the first radar 42 and/or the second radar 43 acquires the second weighting factor corresponding to the second distance, the first radar 42 and/or the second radar 43 is used to perform: obtain the detection of the first radar 42 The first variance information corresponding to the first distance and the second variance information corresponding to the second distance detected by the second radar 43; the second weighting factor is determined according to the first variance information and the second variance information.

Further, when the first radar 42 and/or the second radar 43 determines the second weighting factor according to the first variance information and the second variance information, the first radar 42 and/or the second radar 43 is used to perform: The sum of variances of the variance information and the second variance information; the ratio of the second variance information to the sum of variances is determined as the second weighting factor.

Further, the areas detected by the first radar 42 and the second radar 43 partially overlap at the same time; at least one of the first radar 42 and the second radar 43: Determine the relative position of the autonomous mobile platform according to the first distance and the second distance When the target distance of the target point, the first radar 42 and/or the second radar 43 are used to perform: determine the detection overlap area and the non-overlap area formed between the first radar 42 and the second radar 43; according to the first radar 42 and The second radar 43 detects the first distance and the second distance of the same effective target in the overlapping area, and estimates the target distance of another effective target in the adjacent non-overlapping area.

Further, the target point includes a first effective target and a second effective target; at least one of the first radar 42 and the second radar 43: when the target distance of the autonomous mobile platform relative to the target point is determined according to the first distance and the second distance , The first radar 42 and/or the second radar 43 are used to perform: judging whether the first distance and the second distance corresponding to the first valid target are valid; when the first distance is invalid, according to the second distance of the first valid target The distance, the first distance and the second distance corresponding to the second effective target, estimate the target distance of the first effective target, wherein the distance between the first effective target and the second effective target is less than or equal to a preset threshold.

Further, the first radar 42 includes at least one of the following: millimeter wave radar, laser radar, and ultrasonic radar; and the second radar 43 includes a downward-looking radar.

The device shown in Fig. 23 can execute the methods of the embodiments shown in Figs. 3-19. For parts that are not described in detail in this embodiment, please refer to the related descriptions of the embodiments shown in Figs. 3-19. For the implementation process and technical effects of this technical solution, please refer to the description in the embodiment shown in FIG. 3 to FIG. 19, which will not be repeated here.

In addition, an embodiment of the present invention provides a computer storage medium for storing computer software instructions used by electronic devices, which includes all methods used to execute the distance detection method of the autonomous mobile platform in the method embodiments shown in FIG. 3 to FIG. 19. The procedures involved.

The technical solutions and technical features in each of the above embodiments can be singly or combined in case of conflict with the present invention, as long as they do not exceed the cognitive scope of those skilled in the art, they all belong to the equivalent embodiments within the protection scope of this application. .

In the several embodiments provided by the present invention, it should be understood that the disclosed related remote control device and method can be implemented in other ways. For example, the embodiments of the remote control device described above are only illustrative. For example, the division of the modules or units is only a logical function division, and there may be other divisions in actual implementation, such as multiple units or components. It can be combined or integrated into another system, or some features can be ignored or not implemented. In addition, the displayed or discussed mutual coupling or direct coupling or communication connection may be indirect coupling or communication connection through some interfaces, remote control devices or units, and may be in electrical, mechanical or other forms.

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 units may be selected according to actual needs to achieve the objectives of the solutions of the embodiments.

In addition, the functional units in the various embodiments of the present invention may be integrated into one processing unit, or each unit may exist alone physically, or two or more units may be integrated into one unit. The above-mentioned integrated unit can be implemented in the form of hardware or software functional unit.

If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer readable storage medium. Based on this understanding, the technical solution of the present invention essentially or the part that contributes to the existing technology or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium. , Including several instructions to make a computer processor (processor) execute all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage media include: U disk, mobile hard disk, Read-Only Memory (ROM), Random Access Memory (RAM, Random Access Memory), magnetic disks or optical disks and other media that can store program codes.

The above are only the embodiments of the present invention, which do not limit the scope of the present invention. Any equivalent structure or equivalent process transformation made by using the content of the description and drawings of the present invention, or directly or indirectly applied to other related technologies In the same way, all fields are included in the scope of patent protection of the present invention.

Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, not to limit them; although the present invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that: The technical solutions recorded in the foregoing embodiments can still be modified, or some or all of the technical features can be equivalently replaced; and these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the technical solutions of the embodiments of the present invention. range.

Claims

A distance detection method for an autonomous mobile platform is characterized in that it includes:

Acquiring the first distance of the first radar relative to the target point and the second distance of the second radar relative to the target point, wherein the first radar and the second radar are both set on the autonomous mobile platform, And the first radar and the second radar are of different types;

According to the first distance and the second distance, the target distance of the autonomous mobile platform relative to the target point is determined.
The method according to claim 1, wherein the first distance and the second distance are distance information for the same effective target point, and the first distance is a first vertical distance, and the second distance is The distance is the second vertical distance, and the target surface where the target point is located is the ground.
The method according to claim 1, wherein obtaining the first distance of the first radar relative to the target point comprises:

Acquiring a plurality of first energy information values of the reflected radar signal, the plurality of first energy information values corresponding to the first radar;

Determining, according to the first energy information value, the rotation angle of the first radar relative to the radar rotation center, the first distance information and the azimuth angle of the first radar relative to the target point;

Performing coordinate conversion processing on the first distance information based on the rotation angle and the azimuth angle to obtain multiple target information values in a geodetic coordinate system;

Performing plane fitting on the target surface where the target point is located according to a plurality of the target information values, to obtain plane information corresponding to the target surface;

Obtaining the first distance of the first radar relative to the target point according to the plane information.
The method according to claim 3, wherein, according to a plurality of the target information values, performing plane fitting on the target surface where the target point is located to obtain the plane information corresponding to the target surface comprises:

Performing clustering processing on a plurality of the target information values to obtain a plurality of clustering results;

Acquiring feature information corresponding to each of the clustering results;

Obtaining, according to the characteristic information, effective target information corresponding to the target surface where the target point is located;

Perform plane fitting on the target surface where the target point is located according to the effective target information to obtain plane information corresponding to the target surface.
The method according to claim 4, wherein the characteristic information includes at least one of the following:

The number of valid target information in the clustering result in the current frame;

The difference between the average height of the effective target information in the current frame and the fusion distance of the autonomous mobile platform in the previous frame relative to the target point;

The height variance of the effective target point in the current frame.
The method according to claim 4, wherein when the feature information includes the number of effective target information in the clustering result in the current frame, acquiring feature information corresponding to each clustering result ,include:

The number of effective target information in the clustering result is determined according to the first energy information value, the first distance information, and the azimuth angle.
The method according to claim 4, wherein obtaining effective target information corresponding to the target surface where the target point is located according to the characteristic information comprises:

Performing normalization processing on the characteristic information to obtain a normalization result corresponding to the characteristic information;

Performing weighted summation processing on all normalized results to obtain weight information corresponding to the clustering results;

The target information value included in the clustering result with the largest weight information is determined as the effective target information corresponding to the target plane where the target point is located.
The method according to claim 1, wherein obtaining the second distance of the second radar relative to the target point comprises:

Acquiring a plurality of second energy information values of the reflected radar signal, the plurality of second energy information values corresponding to the second radar;

Determining second distance information and target energy information of the second radar relative to the target point according to a plurality of second energy information values;

The second distance of the second radar relative to the target point is obtained based on the second distance information and the target energy information.
The method according to claim 8, wherein obtaining the second distance of the second radar relative to the target point based on the second distance information and the target energy information comprises:

Acquiring the height difference between the second distance information and the historical height of the autonomous mobile platform relative to the target point;

Performing normalization processing on the height difference and the target energy information respectively to obtain a height normalization result and an energy normalization result corresponding to the height difference;

Obtain the second distance of the second radar relative to the target point according to the height normalization result and the energy normalization result.
The method according to claim 9, wherein obtaining the second distance of the second radar relative to the target point according to the height normalization result and the energy normalization result comprises:

Performing weighted summation processing on the height normalization result and the energy normalization result to obtain weight information corresponding to the second energy information value;

The second distance information corresponding to the second energy information value with the largest weight is determined as the second distance of the second radar relative to the target point.
The method according to claim 1, wherein determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance comprises:

Acquiring a first weighting factor corresponding to the first distance and a second weighting factor corresponding to the second distance;

Using the first weighting factor and the second weighting factor, the first distance and the second distance are weighted to obtain the target distance of the autonomous mobile platform relative to the target point.
The method according to claim 11, wherein obtaining a first weighting factor corresponding to the first distance comprises:

Obtaining first variance information corresponding to the first distance detected by the first radar and second variance information corresponding to the second distance detected by the second radar;

The first weighting factor is determined according to the first variance information and the second variance information.
The method according to claim 12, wherein determining the first weighting factor according to the first variance information and the second variance information comprises:

Acquiring the sum of the variances of the first variance information and the second variance information;

The ratio of the first variance information to the sum of the variances is determined as the first weighting factor.
The method according to claim 11, wherein obtaining a second weighting factor corresponding to the second distance comprises:

Obtaining first variance information corresponding to the first distance detected by the first radar and second variance information corresponding to the second distance detected by the second radar;

The second weighting factor is determined according to the first variance information and the second variance information.
The method according to claim 14, wherein determining the second weighting factor according to the first variance information and the second variance information comprises:

Acquiring the sum of the variances of the first variance information and the second variance information;

The ratio of the second variance information to the sum of the variances is determined as the second weighting factor.
The method according to any one of claims 1-15, wherein the areas detected by the first radar and the second radar in the same time partially overlap; according to the first distance and the first distance Two distances: Determining the target distance of the autonomous mobile platform relative to the target point includes:

Determining a detection overlap area and a non-overlap area formed between the first radar and the second radar;

According to the first distance and the second distance for the same effective target in the detection overlap area of the first radar and the second radar, the target distance of another effective target in the adjacent non-overlapping area is estimated .
The method according to any one of claims 1-15, wherein the target point includes a first effective target and a second effective target; the autonomous system is determined according to the first distance and the second distance. The target distance of the mobile platform relative to the target point includes:

Judging whether the first distance and the second distance corresponding to the first valid target are valid;

When the first distance is invalid, the second distance of the first valid target, the first distance corresponding to the second valid target, and the second distance are used to estimate the distance of the first valid target. The target distance, wherein the distance between the first effective target and the second effective target is less than or equal to a preset threshold.
The method according to any one of claims 1-15, wherein:

The first radar includes at least one of the following: millimeter wave radar, lidar, and ultrasonic radar;

The second radar includes a downward looking radar.
A method for modeling target surface information, which is characterized in that it includes:

The distance detection method of an autonomous mobile platform according to any one of claims 1-15;

After determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the method further includes:

Modeling processing is performed on the target surface where the target point is located by using the target distance to obtain model information corresponding to the shape information of the target surface.
A control method of an autonomous mobile platform is characterized in that it includes:

The distance detection method of an autonomous mobile platform according to any one of claims 1-15;

After determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the method further includes:

The target distance is used to control the autonomous mobile platform so as to maintain a preset distance between the autonomous mobile platform and the target point.
A distance detection device, characterized in that the distance detection device is a first radar or a second radar, and includes:

Memory, used to store computer programs;

The processor is configured to run a computer program stored in the memory to realize:

Acquire the first distance of the first radar relative to the target point and the second distance of the second radar relative to the target point, wherein the first radar and the second radar are both set on an autonomous mobile platform, and The type of the first radar is different from that of the second radar;

According to the first distance and the second distance, the target distance of the autonomous mobile platform relative to the target point is determined.
The distance detection device according to claim 21, wherein the first distance and the second distance are distance information for the same effective target point, and the first distance is a first vertical distance, and the The second distance is the second vertical distance, and the target surface where the target point is located is the ground.
The distance detection device according to claim 21, wherein when the processor obtains the first distance of the first radar relative to the target point, the processor is configured to execute:

Acquiring a plurality of first energy information values of the reflected radar signal, the plurality of first energy information values corresponding to the first radar;

Determining, according to the first energy information value, the rotation angle of the first radar relative to the radar rotation center, the first distance information and the azimuth angle of the first radar relative to the target point;

Performing coordinate conversion processing on the first distance information based on the rotation angle and the azimuth angle to obtain multiple target information values in a geodetic coordinate system;

Performing plane fitting on the target surface where the target point is located according to a plurality of the target information values, to obtain plane information corresponding to the target surface;

Obtaining the first distance of the first radar relative to the target point according to the plane information.
The distance detection device according to claim 23, wherein the processor performs plane fitting on the target surface where the target point is located according to a plurality of the target information values, and obtains the corresponding For plane information, the processor is used to execute:

Performing clustering processing on a plurality of the target information values to obtain a plurality of clustering results;

Acquiring feature information corresponding to each of the clustering results;

Obtaining, according to the characteristic information, effective target information corresponding to the target surface where the target point is located;

Perform plane fitting on the target surface where the target point is located according to the effective target information to obtain plane information corresponding to the target surface.
The distance detection device according to claim 24, wherein the characteristic information includes at least one of the following:

The number of valid target information in the clustering result in the current frame;

The difference between the average height of the effective target information in the current frame and the fusion distance of the autonomous mobile platform in the previous frame relative to the target point;

The height variance of the effective target point in the current frame.
The distance detection device according to claim 24, wherein when the feature information includes the number of valid target information in the clustering result in the current frame, the processor acquires each cluster When the characteristic information corresponding to the class result, the processor is used to execute:

The number of effective target information in the clustering result is determined according to the first energy information value, the first distance information, and the azimuth angle.
The distance detection device according to claim 24, wherein when the processor obtains valid target information corresponding to the target surface where the target point is located according to the characteristic information, the processor is configured to execute:

Performing normalization processing on the characteristic information to obtain a normalization result corresponding to the characteristic information;

Performing weighted summation processing on all normalized results to obtain weight information corresponding to the clustering results;

The target information value included in the clustering result with the largest weight information is determined as the effective target information corresponding to the target plane where the target point is located.
The distance detection device according to claim 21, wherein when the processor obtains the second distance of the second radar relative to the target point, the processor is configured to execute:

Acquiring a plurality of second energy information values of the reflected radar signal, the plurality of second energy information values corresponding to the second radar;

Determining second distance information and target energy information of the second radar relative to the target point according to a plurality of second energy information values;

The second distance of the second radar relative to the target point is obtained based on the second distance information and the target energy information.
The distance detection device according to claim 28, wherein when the processor obtains the second distance of the second radar relative to the target point based on the second distance information and the target energy information, the processing The device is used to perform:

Acquiring the height difference between the second distance information and the historical height of the autonomous mobile platform relative to the target point;

Performing normalization processing on the height difference and the target energy information, respectively, to obtain a height normalization result and an energy normalization result corresponding to the height difference;

Obtain the second distance of the second radar relative to the target point according to the height normalization result and the energy normalization result.
The distance detection device according to claim 29, wherein when the processor obtains the second distance of the second radar relative to the target point according to the height normalization result and the energy normalization result, The processor is used to execute:

Performing weighted summation processing on the height normalization result and the energy normalization result to obtain weight information corresponding to the second energy information value;

The second distance information corresponding to the second energy information value with the largest weight is determined as the second distance of the second radar relative to the target point.
The distance detection device according to claim 21, wherein when the processor determines the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, The processor is used to execute:

Acquiring a first weighting factor corresponding to the first distance and a second weighting factor corresponding to the second distance;

Using the first weighting factor and the second weighting factor, the first distance and the second distance are weighted to obtain the target distance of the autonomous mobile platform relative to the target point.
The distance detection device according to claim 31, wherein when the processor obtains the first weighting factor corresponding to the first distance, the processor is configured to execute:

Obtaining first variance information corresponding to the first distance detected by the first radar and second variance information corresponding to the second distance detected by the second radar;

The first weighting factor is determined according to the first variance information and the second variance information.
The distance detection device according to claim 32, wherein when the processor determines the first weighting factor according to the first variance information and the second variance information, the processor is configured to execute:

Acquiring the sum of the variances of the first variance information and the second variance information;

The ratio of the first variance information to the sum of the variances is determined as the first weighting factor.
The distance detection device according to claim 31, wherein when the processor obtains the second weighting factor corresponding to the second distance, the processor is configured to execute:

Obtaining first variance information corresponding to the first distance detected by the first radar and second variance information corresponding to the second distance detected by the second radar;

The second weighting factor is determined according to the first variance information and the second variance information.
The distance detection device according to claim 34, wherein when the processor determines the second weighting factor according to the first variance information and the second variance information, the processor is configured to execute:

Acquiring the sum of the variances of the first variance information and the second variance information;

The ratio of the second variance information to the sum of the variances is determined as the second weighting factor.
The distance detection device according to any one of claims 21-35, wherein the area detected by the first radar and the second radar at the same time partially overlap; When the first distance and the second distance determine the target distance of the autonomous mobile platform relative to the target point, the processor is configured to execute:

Determining a detection overlap area and a non-overlap area formed between the first radar and the second radar;

According to the first distance and the second distance for the same effective target in the detection overlap area of the first radar and the second radar, the target distance of another effective target in the adjacent non-overlapping area is estimated .
The distance detection device according to any one of claims 21-35, wherein the target point includes a first effective target and a second effective target; the processor is based on the first distance and the When the second distance determines the target distance of the autonomous mobile platform relative to the target point, the processor is configured to execute:

Judging whether the first distance and the second distance corresponding to the first valid target are valid;

When the first distance is invalid, the second distance of the first valid target, the first distance corresponding to the second valid target, and the second distance are used to estimate the distance of the first valid target. The target distance, wherein the distance between the first effective target and the second effective target is less than or equal to a preset threshold.
The distance detection device according to any one of claims 21-35, wherein:

The first radar includes at least one of the following: millimeter wave radar, lidar, and ultrasonic radar;

The second radar includes a downward looking radar.
A target plane information modeling device, which is characterized in that it comprises:

Memory, used to store computer programs;

The processor is configured to run a computer program stored in the memory to realize:

The distance detection method of an autonomous mobile platform according to any one of claims 1-15;

After determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the processor is further configured to:

Modeling processing is performed on the target surface where the target point is located by using the target distance to obtain model information corresponding to the shape information of the target surface.
A control device of an autonomous mobile platform, characterized in that it comprises:

Memory, used to store computer programs;

The processor is configured to run a computer program stored in the memory to realize:

The distance detection method of an autonomous mobile platform according to any one of claims 1-15;

After determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the processor is further configured to:

The target distance is used to control the autonomous mobile platform so as to maintain a preset distance between the autonomous mobile platform and the target point.
An autonomous mobile platform, characterized in that it includes:

body;

The first radar is set on the autonomous mobile platform and is used to obtain the first distance of the first radar relative to the target point;

The second radar is set on the autonomous mobile platform and is used to obtain a second distance of the second radar relative to the target point, wherein the first radar and the second radar are of different types;

At least one of the first radar and the second radar is further configured to determine the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance.
The autonomous mobile platform of claim 41, wherein the first distance and the second distance are distance information for the same effective target point, and the first distance is a first vertical distance, and the The second distance is the second vertical distance, and the target surface where the target point is located is the ground.
The autonomous mobile platform according to claim 41, wherein when the first radar obtains the first distance of the first radar relative to the target point, the first radar is used to execute:

Acquiring a plurality of first energy information values of the reflected radar signal, the plurality of first energy information values corresponding to the first radar;

Determining, according to the first energy information value, the rotation angle of the first radar relative to the radar rotation center, the first distance information and the azimuth angle of the first radar relative to the target point;

Performing coordinate conversion processing on the first distance information based on the rotation angle and the azimuth angle to obtain multiple target information values in a geodetic coordinate system;

Performing plane fitting on the target surface where the target point is located according to a plurality of the target information values, to obtain plane information corresponding to the target surface;

Obtaining the first distance of the first radar relative to the target point according to the plane information.
The autonomous mobile platform according to claim 43, wherein the first radar performs plane fitting on the target surface where the target point is located according to a plurality of the target information values, and obtains a plane corresponding to the target surface When the plane information of, the first radar is used to execute:

Performing clustering processing on a plurality of the target information values to obtain a plurality of clustering results;

Acquiring feature information corresponding to each of the clustering results;

Obtaining, according to the characteristic information, effective target information corresponding to the target surface where the target point is located;

Perform plane fitting on the target surface where the target point is located according to the effective target information to obtain plane information corresponding to the target surface.
The autonomous mobile platform according to claim 44, wherein the characteristic information comprises at least one of the following:

The number of valid target information in the clustering result in the current frame;

The difference between the average height of the effective target information in the current frame and the fusion distance of the autonomous mobile platform in the previous frame relative to the target point;

The height variance of the effective target point in the current frame.
The autonomous mobile platform according to claim 44, wherein when the characteristic information includes the number of valid target information in the clustering result in the current frame, the first radar acquires each of the When the feature information corresponding to the clustering result, the first radar can be used to perform:

The number of effective target information in the clustering result is determined according to the first energy information value, the first distance information, and the azimuth angle.
The autonomous mobile platform according to claim 44, wherein when the first radar obtains the effective target information corresponding to the target surface where the target point is located according to the characteristic information, the first radar is used for carried out:

Performing normalization processing on the characteristic information to obtain a normalization result corresponding to the characteristic information;

Performing weighted summation processing on all normalized results to obtain weight information corresponding to the clustering results;

The target information value included in the clustering result with the largest weight information is determined as the effective target information corresponding to the target plane where the target point is located.
The autonomous mobile platform according to claim 41, wherein when the second radar obtains the second distance of the second radar relative to the target point, the second radar is used to execute:

Acquiring a plurality of second energy information values of the reflected radar signal, the plurality of second energy information values corresponding to the second radar;

Determining second distance information and target energy information of the second radar relative to the target point according to a plurality of second energy information values;

The second distance of the second radar relative to the target point is obtained based on the second distance information and the target energy information.
The autonomous mobile platform of claim 48, wherein when the second radar obtains the second distance of the second radar relative to the target point based on the second distance information and the target energy information, the The second radar is used to perform:

Acquiring the height difference between the second distance information and the historical height of the autonomous mobile platform relative to the target point;

Performing normalization processing on the height difference and the target energy information, respectively, to obtain a height normalization result and an energy normalization result corresponding to the height difference;

Obtain the second distance of the second radar relative to the target point according to the height normalization result and the energy normalization result.
The autonomous mobile platform of claim 49, wherein when the second radar obtains the second distance of the second radar relative to the target point according to the height normalization result and the energy normalization result , The second radar is used to perform:

Performing weighted summation processing on the height normalization result and the energy normalization result to obtain weight information corresponding to the second energy information value;

The second distance information corresponding to the second energy information value with the largest weight is determined as the second distance of the second radar relative to the target point.
The autonomous mobile platform according to claim 41, wherein at least one of the first radar and the second radar: determining the relative position of the autonomous mobile platform according to the first distance and the second distance At the target distance of the target point, the first radar and/or the second radar are used to perform:

Acquiring a first weighting factor corresponding to the first distance and a second weighting factor corresponding to the second distance;

Using the first weighting factor and the second weighting factor, the first distance and the second distance are weighted to obtain the target distance of the autonomous mobile platform relative to the target point.
The autonomous mobile platform according to claim 51, wherein when the first radar and/or the second radar acquires the first weighting factor corresponding to the first distance, the first radar And/or the second radar is used to perform:

Obtaining first variance information corresponding to the first distance detected by the first radar and second variance information corresponding to the second distance detected by the second radar;

The first weighting factor is determined according to the first variance information and the second variance information.
The autonomous mobile platform according to claim 52, wherein when the first radar and/or the second radar determine the first weighting factor according to the first variance information and the second variance information , The first radar and/or the second radar are used to perform:

Acquiring the sum of the variances of the first variance information and the second variance information;

The ratio of the first variance information to the sum of the variances is determined as the first weighting factor.
The autonomous mobile platform according to claim 51, wherein when the first radar and/or the second radar acquires a second weighting factor corresponding to the second distance, the first radar And/or the second radar is used to perform:

Obtaining first variance information corresponding to the first distance detected by the first radar and second variance information corresponding to the second distance detected by the second radar;

The second weighting factor is determined according to the first variance information and the second variance information.
The autonomous mobile platform according to claim 54, wherein when the first radar and/or the second radar determine the second weighting factor according to the first variance information and the second variance information , The first radar and/or the second radar are used to perform:

Acquiring the sum of the variances of the first variance information and the second variance information;

The ratio of the second variance information to the sum of the variances is determined as the second weighting factor.
The autonomous mobile platform according to any one of claims 41-55, wherein the area detected by the first radar and the second radar partially overlaps in the same time; the first radar and the At least one of the second radars: when the target distance of the autonomous mobile platform relative to the target point is determined according to the first distance and the second distance, the first radar and/or the second radar Used to execute:

Determining a detection overlap area and a non-overlap area formed between the first radar and the second radar;

According to the first distance and the second distance for the same effective target in the detection overlap area of the first radar and the second radar, the target distance of another effective target in the adjacent non-overlapping area is estimated .
The autonomous mobile platform according to any one of claims 41-55, wherein the target point includes a first effective target and a second effective target; at least one of the first radar and the second radar One: when determining the target distance of the autonomous mobile platform relative to the target point according to the first distance and the second distance, the first radar and/or the second radar are used to perform:

Judging whether the first distance and the second distance corresponding to the first valid target are valid;

When the first distance is invalid, the second distance of the first valid target, the first distance corresponding to the second valid target, and the second distance are used to estimate the distance of the first valid target. The target distance, wherein the distance between the first effective target and the second effective target is less than or equal to a preset threshold.
The autonomous mobile platform according to any one of claims 41-55, wherein:

The first radar includes at least one of the following: millimeter wave radar, lidar, and ultrasonic radar;

The second radar includes a downward looking radar.
A computer-readable storage medium, wherein the storage medium is a computer-readable storage medium, the computer-readable storage medium stores program instructions, and the program instructions are used to implement any one of claims 1-18 The distance detection method of the autonomous mobile platform described in the item.