CN114280623A

CN114280623A - Ultrasonic radar array, obstacle detection method and system

Info

Publication number: CN114280623A
Application number: CN202111399435.4A
Authority: CN
Inventors: 朱晓星; 刘祥; 杨凡
Original assignee: Beijing Baidu Netcom Science and Technology Co Ltd
Current assignee: Beijing Baidu Netcom Science and Technology Co Ltd
Priority date: 2019-01-15
Filing date: 2019-01-15
Publication date: 2022-04-05
Also published as: CN109814114A; CN109814114B

Abstract

The application provides an ultrasonic radar array, an obstacle detection method and a system, wherein the method comprises the steps of obtaining obstacle information collected by ultrasonic radars in an upper array and a lower array in the ultrasonic radar array in an obstacle scene; judging whether the obstacle information collected by each ultrasonic radar of the upper array and the obstacle information collected by each ultrasonic radar of the lower array are detected by mistake or not according to a preset rule; respectively carrying out error correction processing on the obstacle information acquired by each ultrasonic radar in the upper array and the obstacle information acquired by each ultrasonic radar in the lower array according to the judgment result; and respectively determining the positions of the obstacles according to the obstacle information acquired by each ultrasonic radar of the upper array and the obstacle information acquired by each ultrasonic radar of the lower array after error correction processing, and fusing the obstacle information. False detection and missed detection of each ultrasonic radar in the ultrasonic radar array can be effectively judged, the position of the obstacle is accurately determined, detection blind areas are reduced, and the driving safety of the unmanned vehicle is improved.

Description

Ultrasonic radar array, obstacle detection method and system

[ technical field ] A method for producing a semiconductor device

The application relates to the field of automatic control, in particular to an ultrasonic radar array, and an obstacle detection method and system.

[ background of the invention ]

The unmanned vehicle is an intelligent automobile, which can be called as a wheeled mobile robot, and mainly depends on an intelligent driver mainly comprising a computer system in the vehicle to realize unmanned driving. The unmanned automobile integrates a plurality of technologies such as automatic control, a system structure, artificial intelligence, visual calculation and the like, is a product of high development of computer science, mode recognition and intelligent control technologies, is an important mark for measuring national scientific research strength and industrial level, and has wide application prospect in the fields of national defense and national economy.

Ultrasonic waves have the characteristics of good directivity, strong adaptability, strong penetrating power and the like, and therefore the ultrasonic waves are often loaded on an unmanned vehicle to achieve an obstacle avoidance function. The traditional ultrasonic radar array applied to the unmanned vehicle is generally arranged on a front/rear bumper of the automobile, and the number of the traditional ultrasonic radar array is 4. The measured obstacle is unstable and is missed along with false detection; the position of the obstacle cannot be accurately described; transverse and longitudinal detection blind areas are often large, and potential safety hazards exist; in the fields with higher precision requirements such as unmanned vehicles and the like, the sensing requirements are difficult to achieve, and the driving safety of the unmanned vehicles is reduced.

[ summary of the invention ]

Aspects of the application provide an ultrasonic radar array, an obstacle detection method and system for improving accuracy and reliability of ultrasonic obstacle detection, covering transverse and longitudinal blind areas of an unmanned vehicle and improving driving safety.

In one aspect of the present application, there is provided an ultrasonic radar array comprising: an upper array and a lower array; wherein the content of the first and second substances,

the upper array comprises N ultrasonic radars which are uniformly arranged on the upper part of a bumper of the unmanned vehicle, and the outward rotation angles of the N ultrasonic radars are gradually increased from the center to the outer side;

the lower array comprises M ultrasonic radars which are uniformly arranged on the upper part of a bumper of the unmanned vehicle, the rotating angles of the M ultrasonic radars are gradually increased outwards from the center to the outer side, and the M ultrasonic radars are inclined downwards to cover the blind area of the upper array;

wherein N, M is a positive integer.

In accordance with the above aspect and any one of the possible implementations, there is further provided an implementation in which, if the number of the ultrasonic radars in the upper array or the lower array is even, the first ultrasonic radar is horizontally installed on the left side of the center of the bumper, and the second ultrasonic radar is horizontally installed on the right side of the center of the bumper; (the number of the ultrasonic radars is-2)/2 ultrasonic radars are arranged on the left side of the first ultrasonic radar, and are rotated by alpha in a counterclockwise manner in sequence from the center to the outer side with the ultrasonic radars as the reference; (the number of the ultrasonic radars is-2)/2 ultrasonic radars are arranged on the right side of the second ultrasonic radar, and are sequentially rotated clockwise by alpha from the center to the outer side by taking the ultrasonic radars as a reference;

if the number of the ultrasonic radars in the upper array or the lower array is odd, the first ultrasonic radar is horizontally arranged in the center of the bumper, and every 2 ultrasonic radars are arranged on the left side of the first ultrasonic radar, and are sequentially rotated counterclockwise by alpha from the center to the outer side by taking the ultrasonic radars as a reference; (number of ultrasonic radars-1)/2 ultrasonic radars are installed on the right side of the first ultrasonic radar, and are rotated clockwise by α in sequence from the center to the outside with the one or more ultrasonic radars as a reference.

The above-described aspects and any possible implementation manner further provide an implementation manner, wherein the number and the rotation angle α of the ultrasonic radars are determined according to a mathematical model of the detection distance and the detection shape of each ultrasonic radar, so as to ensure that triple redundancy exists in the coverage range of the ultrasonic radar.

The invention provides an obstacle detection method according to the ultrasonic radar array, which comprises the following steps:

acquiring obstacle information acquired by each ultrasonic radar in an obstacle scene in an upper array and a lower array in the ultrasonic radar array;

judging whether the obstacle information collected by each ultrasonic radar of the upper array and the obstacle information collected by each ultrasonic radar of the lower array are detected by mistake or not according to a preset rule;

respectively carrying out error correction processing on the obstacle information acquired by each ultrasonic radar in the upper array and the obstacle information acquired by each ultrasonic radar in the lower array according to the judgment result;

and respectively determining the positions of the obstacles according to the obstacle information acquired by each ultrasonic radar of the upper array and the obstacle information acquired by each ultrasonic radar of the lower array after error correction processing, and fusing the obstacle information.

In the above aspect and any possible implementation manner, an implementation manner is further provided, where the preset rule is to determine whether the ultrasonic radar to be determined has false detection or missed detection according to whether an adjacent ultrasonic radar of the ultrasonic radar to be determined returns obstacle coordinates.

The above aspect and any possible implementation manner further provide an implementation manner, where the adjacent ultrasonic radars are ultrasonic radars on two sides of the ultrasonic radar to be determined and one ultrasonic radar apart from the ultrasonic radar to be determined.

As described in the foregoing aspect and any possible implementation manner, there is further provided an implementation manner, where the preset rule for performing the false detection judgment includes:

under the condition that the adjacent ultrasonic radars of the ultrasonic radar to be judged do not return the coordinates of the obstacle, if the coverage area of the ultrasonic radar to be judged has a single coverage area of the ultrasonic radar or the coverage areas of the two ultrasonic radars are overlapped, false detection does not exist; if the coverage range of the ultrasonic radar to be judged is only overlapped by the coverage ranges of the three ultrasonic radars, false detection exists;

under the condition that one adjacent ultrasonic radar of the ultrasonic radar to be judged returns the coordinates of the obstacle, false detection does not exist;

and under the condition that two adjacent ultrasonic radars of the ultrasonic radar to be judged return to the coordinates of the obstacle, false detection does not exist.

As described in the foregoing aspect and any possible implementation manner, there is further provided an implementation manner, where the preset rule for performing the missed detection judgment includes:

under the condition that the adjacent ultrasonic radar of the ultrasonic radar to be judged does not return to the coordinates of the obstacle, the ultrasonic radar to be judged does not have missing detection;

under the condition that one adjacent ultrasonic radar of the ultrasonic radar to be judged returns the obstacle coordinates, if the coverage areas of the ultrasonic radar to be judged and the adjacent ultrasonic radar returning the obstacle coordinates are overlapped, missing detection exists; if the coverage areas of the ultrasonic radar to be judged and the adjacent ultrasonic radar returning to the coordinates of the obstacle are only overlapped by the coverage areas of the three ultrasonic radars, missing detection does not exist;

under the condition that two adjacent ultrasonic radars of the ultrasonic radar to be judged return obstacle coordinates, if three ultrasonic radar coverage ranges exist in the coverage ranges of the ultrasonic radar to be judged and the adjacent ultrasonic radars returning the obstacle coordinates, missing detection exists; if the coverage areas of the three ultrasonic radars are not overlapped, missing detection does not exist;

and under the condition that three or more adjacent ultrasonic radars of the ultrasonic radar to be judged return the coordinates of the obstacles, missed detection exists.

In accordance with the foregoing aspect and any one of the possible implementations, there is further provided an implementation in which performing error correction processing on the obstacle information acquired by each of the ultrasonic radars in the upper array and the obstacle information acquired by each of the ultrasonic radars in the lower array according to the determination result includes:

and if the obstacle information acquired by the ultrasonic radar has false detection, deleting the obstacle information acquired by the false detection ultrasonic radar.

And if the obstacle information acquired by the ultrasonic radar has missing detection, acquiring the obstacle information acquired by the ultrasonic radar which has missing detection according to the obstacle information returned by the adjacent ultrasonic radar.

The above-mentioned aspects and any possible implementation manners further provide an implementation manner, wherein determining the position of the obstacle in the vehicle body coordinate system according to the obstacle information acquired by each ultrasonic radar of the upper array and the obstacle information acquired by each ultrasonic radar of the lower array after the error correction processing, and performing fusion includes:

and respectively fusing distance data returned by the ultrasonic radars of the upper array or the lower array to obtain the coordinates of the obstacle, and superposing the position of the obstacle determined by the upper array and the position of the obstacle determined by the lower array.

The present invention provides an obstacle detection system according to the above ultrasonic radar array, comprising:

the acquisition module is used for acquiring the obstacle information acquired by each ultrasonic radar in the upper array and the lower array in the ultrasonic radar array in an obstacle scene;

the judgment module is used for respectively carrying out false detection and missing detection judgment on the barrier information acquired by each ultrasonic radar of the upper array and the barrier information acquired by each ultrasonic radar of the lower array according to a preset rule;

the processing module is used for respectively carrying out error correction processing on the barrier information acquired by each ultrasonic radar in the upper array and the barrier information acquired by each ultrasonic radar in the lower array according to the judgment result;

and the determining module is used for respectively determining the positions of the obstacles according to the obstacle information acquired by each ultrasonic radar of the upper array and the obstacle information acquired by each ultrasonic radar of the lower array after error correction processing, and fusing the obstacle information.

The above-described aspect and any possible implementation further provide an implementation, where the processing module is specifically configured to:

The above-described aspect and any possible implementation further provide an implementation, where the determining module is specifically configured to:

In another aspect of the present invention, a computer device is provided, comprising a memory, a processor and a computer program stored on the memory and executable on the processor, the processor implementing the method as described above when executing the program.

In another aspect of the invention, a computer-readable storage medium is provided, on which a computer program is stored, which program, when being executed by a processor, is adapted to carry out the method as set forth above.

According to the technical scheme, false detection and missing detection of each ultrasonic radar in the ultrasonic radar array can be effectively judged, the position of the obstacle is accurately determined, detection blind areas are reduced, and the driving safety of the unmanned vehicle is improved.

[ description of the drawings ]

In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings needed to be used in the embodiments or the prior art descriptions will be briefly described below, and it is obvious that the drawings in the following description are some embodiments of the present application, and those skilled in the art can also obtain other drawings according to the drawings without inventive labor.

Fig. 1 is a front view of an ultrasonic radar array according to an embodiment of the present disclosure;

FIG. 2 is a top view of an upper array of an ultrasonic radar array according to an embodiment of the present disclosure;

fig. 3 is a schematic flowchart of an ultrasonic radar array obstacle detection method according to a second embodiment of the present application;

fig. 4 is a schematic structural diagram of an ultrasonic radar array obstacle detection system according to a third embodiment of the present application;

fig. 5 illustrates a block diagram of an exemplary computer system/server 012 suitable for use in implementing embodiments of the invention.

[ detailed description ] embodiments

In order to make the objects, technical solutions and advantages of the embodiments of the present application clearer, the technical solutions in the embodiments of the present application will be clearly and completely described below with reference to the drawings in the embodiments of the present application, and it is obvious that the described embodiments are some embodiments of the present application, but not all embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present application.

Fig. 1 is a schematic structural diagram of an ultrasonic radar array according to an embodiment of the present application, as shown in fig. 1, including:

the ultrasonic radar array comprises an upper array and a lower array, wherein the upper array is positioned on the upper portion of a front bumper of the unmanned vehicle and is used for collecting obstacle information in front of the vehicle; the lower array is located on the lower portion of a front bumper of the unmanned vehicle and used for collecting barrier information in a longitudinal blind area of the upper array and conducting blind repairing.

In practical application, because the vertical beam angle of the ultrasonic radar is generally small, for example 30 °, the coverage range of the emitted ultrasonic waves is a cone-shaped solid area, the farther the distance from the ultrasonic radar is, the larger the horizontal coverage range is, and in the closer distance in front of the vehicle, only the obstacle within plus or minus 15 ° on the same horizontal section with the ultrasonic radar can be detected, and for shorter obstacles, such as ground piles, dogs and the like, due to the lower height, the obstacle in the blind area of the ultrasonic radar can cause missed detection and the collision risk.

The upper array comprises 10 ultrasonic radars, as shown in fig. 2, each of which is composed of an ultrasonic transmitting circuit and an ultrasonic receiving circuit; nine, seven, five, three, one, two, four, six, eight and ten ultrasonic radars are uniformly installed on a front bumper of the unmanned vehicle, the installation angle of the ultrasonic radars starts from that of the nine ultrasonic radar installed at the leftmost side to rotate by 4 alpha counterclockwise by taking the horizontal direction as a reference, and each ultrasonic radar sequentially rotates by alpha clockwise until that of the ten ultrasonic radars installed at the rightmost side to rotate by 4 alpha clockwise by taking the horizontal direction as a reference.

The method comprises the following specific steps: the ten ultrasonic radars are uniformly arranged on the upper part of a front bumper of the unmanned vehicle, and the first ultrasonic radar is horizontally arranged on the left side of the center of the front bumper; the ultrasonic radar II is horizontally arranged on the right side of the center of the front bumper; the ultrasonic radar III is arranged on the left side of the ultrasonic radar I, and rotates alpha anticlockwise on the basis of the horizontal direction; the ultrasonic radar IV is arranged on the right side of the ultrasonic radar II and rotates clockwise alpha by taking the horizontal direction as a reference; the ultrasonic radar V is arranged on the left side of the ultrasonic radar III and rotates anticlockwise by 2 alpha by taking the horizontal direction as a reference; the ultrasonic radar VI is arranged on the right side of the ultrasonic radar IV and rotates clockwise by 2 alpha by taking the horizontal direction as a reference; the ultrasonic radar seven is arranged on the left side of the ultrasonic radar five and rotates anticlockwise by 3 alpha by taking the horizontal direction as a reference; the ultrasonic radar eight is arranged on the six right side of the ultrasonic radar, and rotates clockwise by 3 alpha by taking the horizontal direction as a reference; the ultrasonic radar nine is arranged on the left side of the ultrasonic radar five and rotates anticlockwise by 4 alpha by taking the horizontal direction as a reference; the ultrasonic radar ten is arranged on the right side of the ultrasonic radar eight and rotates clockwise by 4 alpha by taking the horizontal direction as a reference; among them, α is preferably 5 °. The horizontal beam angle of the ultrasonic radar is 45 degrees, and the coverage range of the ultrasonic radar is 0-3.5 m.

The lower array comprises 8 ultrasonic radars, and each ultrasonic radar consists of an ultrasonic transmitting circuit and an ultrasonic receiving circuit; the ultrasonic radars seventeen, fifteen, thirteen, twelve, eleven, fourteen, sixteen and eighteen are uniformly installed at the lower part of a front bumper of the unmanned vehicle, the installation angle of the ultrasonic radars starts from the ultrasonic radar seventeen installed at the leftmost side to rotate counterclockwise by 3 beta, each ultrasonic radar rotates clockwise by beta in turn until the ultrasonic radar eighteen installed at the rightmost side rotates clockwise by 3 beta based on the horizontal. Meanwhile, each ultrasonic radar mounting angle is inclined downward by θ. Wherein beta is preferably 5 degrees, the horizontal beam angle of the ultrasonic radar is 60 degrees, theta is preferably 30 degrees, and the coverage range of the ultrasonic radar is 0-0.5 m. So that the ultrasonic waves emitted by the ultrasonic radar of the lower array cover the blind area of the ultrasonic radar of the upper array.

The coverage ranges of the ten ultrasonic radars of the upper array are mutually overlapped, so that the ultrasonic radar has certain fault tolerance capability. The coverage area of the ultrasonic radars overlapping each other needs to be determined so as to perform error detection and correction in the subsequent obstacle detection process. And through the blind repairing of the ten ultrasonic radars of the lower array, the short obstacles in the blind area in front of the vehicle can be identified, and the driving safety of the vehicle is improved.

Preferably, the coverage area of each ultrasonic radar in the own coordinate system is determined according to a mathematical model of the detection distance and the detection shape of each ultrasonic radar.

And (4) enabling each ultrasonic radar coordinate system to be identical to the reference coordinate system. In this embodiment, the reference coordinate system is a vehicle coordinate system. Matrix conversion is performed by the relationship between the initial spatial arrangement of each ultrasonic radar on the unmanned vehicle and the vehicle coordinate system. The initial spatial configuration of the ultrasonic radar is known in advance and can be obtained from the measurement data of the plurality of ultrasonic radars on the unmanned vehicle body.

And overlapping the coverage areas of the upper array ultrasonic radars unified to the reference coordinate system in a preset detection area. Preferably, the rasterized preset detection area is within the range of 15-350cm in front of the vehicle body and in front of the side.

Through the steps, the coverage range of the ultrasonic radar array and the overlapping condition of the coverage ranges of the ultrasonic radars, such as a single ultrasonic radar coverage range, two ultrasonic radar coverage ranges, three ultrasonic radar coverage ranges, and the like, can be obtained.

It is necessary to determine the overlap of the coverage areas of the ultrasonic radars, for example, there may be various situations where an obstacle appears in the coverage area of the ultrasonic radar nine, and the obstacle is located in three situations, i.e., a single coverage area of the ultrasonic radar, two coverage areas of the ultrasonic radars overlap, and three coverage areas of the ultrasonic radars overlap. In the embodiment, since the function of the ultrasonic radar is to measure the obstacle, the tolerance to false detection is higher than that of missed detection, and therefore, even if only the ultrasonic radar nine returns the obstacle information, the obstacle is considered to be located in a single ultrasonic radar coverage area in the coverage area of the ultrasonic radar nine, rather than the missed detection of the adjacent ultrasonic radar seven or five.

In the range of 2m in front of the unmanned vehicle, the coverage areas of the 3 ultrasonic radars can be overlapped, so that the decision system can vote according to the barrier information returned by the 3 ultrasonic radars.

The accuracy of obstacle recognition can be further improved by fusing the obstacle recognition result of the upper array with the obstacle recognition result of the lower array.

By the ultrasonic radar array provided by the embodiment, the fault-tolerant capability of obstacle detection is realized by overlapping the coverage areas of multiple ultrasonic radars of the upper array; and the blind is compensated through the lower array multi-ultrasonic-wave radar, so that the accuracy of obstacle identification is further improved.

Fig. 3 is a schematic flowchart of an ultrasonic radar array obstacle detection method according to a second embodiment of the present application, as shown in fig. 3, including:

step S31, obtaining obstacle information collected by the ultrasonic radars in the upper array and the lower array in the ultrasonic radar array in the first embodiment in the obstacle scene, and converting each coordinate into a vehicle body coordinate system;

the initial spatial configuration of the ultrasonic radars is known in advance and may be obtained from the measured data of the plurality of ultrasonic radars in the upper and lower arrays on the unmanned vehicle body. And transforming the coordinates of the obstacle in each ultrasonic radar coordinate system into a vehicle body coordinate system.

And step S32, respectively carrying out false detection and missed detection judgment on the obstacle information acquired by each ultrasonic radar of the upper array and the obstacle information acquired by each ultrasonic radar of the lower array according to a preset rule.

The basic principle of the preset rule is that when one ultrasonic radar is detected by mistake, if the adjacent ultrasonic radar is not detected by mistake, the coordinates of the obstacle are not returned; when one ultrasonic radar is missed, if the adjacent ultrasonic radar is not missed, the coordinates of the obstacle are returned. The preset rules for performing false detection and missing detection judgment on the obstacle information acquired by each ultrasonic radar of the upper array and the lower array are the same.

Specifically, the rule for performing the false detection determination is as follows:

if the obstacle coordinates returned by the ultrasonic radar are received, judging whether the adjacent ultrasonic radar of the ultrasonic radar to be judged returns the obstacle coordinates;

if the adjacent ultrasonic radars of the ultrasonic radar to be judged do not return the obstacle coordinates, judging whether the ultrasonic radar to be judged has a single ultrasonic radar coverage area, such as an ultrasonic radar nine and an ultrasonic radar ten which are positioned at the edge of an ultrasonic radar array;

if the coverage area of the ultrasonic radar to be judged has a single ultrasonic radar coverage area, determining that the obstacle appears in the single ultrasonic radar coverage area of the ultrasonic radar to be judged; the ultrasonic radar to be judged has no false detection;

if the coverage range of the ultrasonic radar has two coverage ranges, such as seven and eight, the detection range of the ultrasonic radar is at least overlapped with the coverage range of one adjacent ultrasonic radar, such as seven, the obstacle coordinates are returned by the ultrasonic radar, nine adjacent ultrasonic radars do not return the obstacle coordinates, and five adjacent ultrasonic radars do not return the obstacle coordinates; there are many possibilities that an obstacle may be located in two of the seven ranges of the ultrasonic radar, i.e., in a range overlapping with the ultrasonic radar nine, and thus the ultrasonic radar nine may miss the detection or the ultrasonic radar seven may miss the detection. If the obstacle is located in the coverage area of three of the seven coverage areas of the ultrasonic radar, namely the coverage area overlapped with the nine ultrasonic radar and the five ultrasonic radar, the seven ultrasonic radar false detection is possible because the nine ultrasonic radar and the five ultrasonic radar do not return the coordinates of the obstacle. For safety reasons, it is considered that an obstacle located in two of the seven ranges of the ultrasonic radar, i.e., in a range overlapping with the ultrasonic radar nine, is missed. Because, if false detection is carried out, the unmanned vehicle can only be caused to stop, the detection result at the next moment is waited, and if false detection is carried out, collision is likely to be caused.

If the coverage areas of the ultrasonic radars only have three overlapping coverage areas, for example, the coverage areas of the ultrasonic radar five, the ultrasonic radar three, the ultrasonic radar one, the ultrasonic radar two, the ultrasonic radar four and the ultrasonic radar six overlap with the coverage areas of two adjacent ultrasonic radars, and under the condition that no obstacle detection result is returned by the two adjacent ultrasonic radars, the ultrasonic radar to be judged has false detection.

If the number of the adjacent ultrasonic radars returning to the coordinates of the obstacle is one, judging whether the coverage area of the ultrasonic radar to be judged has two coverage areas of the ultrasonic radar;

if not, the ultrasonic radar array is determined to have missed detection, for example, the coverage range of the first ultrasonic radar is the overlapping coverage range of the three ultrasonic radars, and if only one adjacent second ultrasonic radar returns the coordinates of the obstacle; if the adjacent ultrasonic radar III or the adjacent ultrasonic radar IV returns the coordinates of the obstacle, the adjacent ultrasonic radar III or the adjacent ultrasonic radar IV has missed detection;

if so, further judging whether the coverage area of the adjacent ultrasonic radar returning to the coordinates of the obstacle and the coverage area of the ultrasonic radar to be judged have two coverage areas;

if yes, no false detection exists; for example, if the coverage areas of the ultrasonic radar nine and the adjacent ultrasonic radar seven overlap, the obstacle is located in the overlapping area;

if not, the ultrasonic radar array is determined to have missing detection, for example, if the ultrasonic radar seven to be judged returns the coordinates of the obstacle, the adjacent ultrasonic radar five returns the coordinates of the obstacle, and the coverage areas of the ultrasonic radar seven and the ultrasonic radar five are only overlapped by three ultrasonic radars, the missing detection of the adjacent ultrasonic radar nine or the ultrasonic radar three is proved.

And if the number of the adjacent ultrasonic radars returning to the coordinates of the obstacle is two, the radar to be detected is not considered to have false detection.

The rule for performing the missing detection judgment is as follows:

if the obstacle coordinates returned by the ultrasonic radar are not received, judging whether the adjacent ultrasonic radar of the ultrasonic radar to be judged returns the obstacle coordinates or not;

if the adjacent ultrasonic radar of the ultrasonic radar to be judged does not return the obstacle coordinates, judging that the ultrasonic radar to be judged does not have missing detection;

if the adjacent ultrasonic radar of the ultrasonic radar to be judged returns the coordinates of the obstacle,

judging the number of adjacent ultrasonic radars returning to the coordinates of the obstacle;

if the number of the adjacent ultrasonic radars returning to the obstacle coordinate is one, judging whether the coverage areas of the ultrasonic radar to be judged and the adjacent ultrasonic radar returning to the obstacle coordinate have two coverage areas of the ultrasonic radar;

if two ultrasonic radar coverage areas exist, the ultrasonic radar to be judged has missing detection, for example, if an obstacle is located in two ultrasonic radar coverage areas in the ultrasonic radar seven coverage areas, namely, the coverage area overlapped with the ultrasonic radar nine, the ultrasonic radar nine does not return obstacle coordinates, and the adjacent ultrasonic radar seven returns obstacle coordinates. For safety reasons, it is considered that the ultrasonic radar has nine missed detections. Because, if false detection is carried out, the unmanned vehicle can only be caused to stop, the detection result at the next moment is waited, and if false detection is carried out, collision is likely to be caused.

If two ultrasonic radar coverage areas do not exist, only three ultrasonic radar coverage areas exist, and only one of the three ultrasonic radars returns obstacle coordinates, the ultrasonic radar returning the obstacle coordinates is considered to have false detection, and the ultrasonic radar to be judged does not have missed detection.

If the number of the adjacent ultrasonic radars returning to the obstacle coordinate is two, judging whether the coverage areas of the ultrasonic waves to be detected and the two adjacent ultrasonic radars returning to the obstacle coordinate have three coverage areas or not; if three ultrasonic radar coverage areas exist, considering that the ultrasonic radar to be judged has missing detection; and if the coverage areas of the three ultrasonic radars do not exist, the ultrasonic radars to be judged have missing detection.

And if the number of the adjacent ultrasonic radars returning to the coordinates of the obstacle is three or more, determining that the ultrasonic radar to be judged has missing detection.

Through the steps, the false detection or missing detection condition of the ultrasonic radar to be judged is judged according to the mutual overlapping condition of the coverage areas of the ultrasonic radar to be judged and the adjacent ultrasonic radar and the obstacle coordinates returned by each ultrasonic radar in the array.

And step S33, respectively carrying out error correction processing on the obstacle information acquired by each ultrasonic radar in the upper array and the obstacle information acquired by each ultrasonic radar in the lower array according to the judgment result.

Preferably, if the detection result has false detection, the obstacle information collected by the false-detection ultrasonic radar is deleted.

Preferably, if the detection result has missed detection, the obstacle information collected by the missed ultrasonic radar can be obtained according to the obstacle information returned by the adjacent ultrasonic radar. And under the condition that one adjacent ultrasonic radar of the ultrasonic radar to be judged returns the obstacle coordinates, taking the obstacle coordinates returned by the adjacent ultrasonic radar as the obstacle coordinates of the ultrasonic radar to be judged. And fusing distance data returned by the two ultrasonic radars by adopting a fusion method based on triangulation under the condition that the two or more adjacent ultrasonic radars of the ultrasonic radar to be judged return the coordinates of the obstacle, and taking the distance data as the coordinates of the obstacle of the ultrasonic radar to be judged.

For example, if the first ultrasonic radar does not return the obstacle coordinates, and the adjacent third ultrasonic radar and the adjacent second ultrasonic radar return the obstacle coordinates, the obstacle coordinates corresponding to the first ultrasonic radar are determined according to the obstacle coordinates returned by the third ultrasonic radar and the second ultrasonic radar.

And if the detection result has no false detection or missing detection, the obstacle information acquired by each ultrasonic radar in the ultrasonic radar array is not processed.

And step S34, respectively determining the positions of the obstacles in the vehicle body coordinate system according to the obstacle information acquired by the ultrasonic radars of the upper array and the obstacle information acquired by the ultrasonic radars of the lower array after error correction processing, fusing the positions, and making unmanned vehicle decision according to the positions of the obstacles obtained by fusion.

Preferably, the position of the obstacle in the vehicle body coordinate system is determined according to the obstacle information collected by each ultrasonic radar of the upper array after error correction processing; then determining the position of the obstacle in the vehicle body coordinate system according to the obstacle information acquired by each ultrasonic radar of the lower array after error correction processing; and fusing the positions of the respectively obtained obstacles in the vehicle body coordinate system.

And if only a single ultrasonic radar returns the obstacle coordinate, determining that the obstacle is positioned at the position in the vehicle body coordinate system, wherein the single ultrasonic radar is used as the origin, and the circular arc which takes the obstacle distance as the radius is positioned at the upper part of the coverage range of the single ultrasonic radar of the ultrasonic radar.

Preferably, if two or more adjacent ultrasonic radars return the coordinates of the obstacle, the distance data returned by the two ultrasonic radars are fused by a fusion method based on triangulation to acquire the edge fixed point information of the obstacle.

Preferably, if three or more adjacent ultrasonic radars return the coordinates of the obstacle, since the number of times of fusion is large when the triangulation fusion method is used, the circumscribed circle method may be used for the fusion processing, and for the same edge point of the obstacle, theoretically, arcs of the plurality of ultrasonic radars using the ultrasonic radars as the origin and the distance from the obstacle as the radius should intersect at one point, but actually, due to the measurement error, noise interference and other originations, the plurality of arcs do not intersect at one point. Therefore, three ultrasonic radars are taken as a group, three sections of circular arcs of each group intersect at three points, the centers of circumscribed circles of the three points are taken as final measurement results of the three ultrasonic radars, and finally the average value of the final measurement results of the ultrasonic radars of each group is calculated as a final fusion result.

Since each ultrasonic radar of the lower array is used for blinding each ultrasonic radar of the upper array, there is a case where the ultrasonic radar of the lower array determines the position of an obstacle in the blind area of the upper array, and the upper array does not detect the obstacle. Therefore, the positions of the obstacles specified by the upper array and the lower array in the vehicle body coordinate system may be superimposed.

Through this application the embodiment, can effectively judge the false retrieval and the omission that each ultrasonic radar appears in the ultrasonic radar array, the accurate obstacle position that confirms has improved the security of traveling of unmanned vehicle.

It should be noted that, for simplicity of description, the above-mentioned method embodiments are described as a series of acts or combination of acts, but those skilled in the art will recognize that the present application is not limited by the order of acts described, as some steps may occur in other orders or concurrently depending on the application. Further, those skilled in the art should also appreciate that the embodiments described in the specification are preferred embodiments and that the acts and modules referred to are not necessarily required in this application.

The above is a description of method embodiments, and the embodiments of the present invention are further described below by way of apparatus embodiments.

Fig. 4 is a schematic structural diagram of an ultrasonic radar array obstacle detection system according to a second embodiment of the present application, as shown in fig. 4, including:

an obtaining module 41, configured to obtain obstacle information acquired in an obstacle scene by each of the ultrasonic radars in the upper array and the lower array in the ultrasonic radar array according to the first embodiment, and convert each coordinate into a vehicle body coordinate system;

And the judging module 42 is configured to perform false detection and missed detection judgment on the obstacle information acquired by each ultrasonic radar in the upper array and the obstacle information acquired by each ultrasonic radar in the lower array according to a preset rule.

The rule for performing the false detection judgment is as follows:

The rule for performing the missing detection judgment is as follows:

Through the steps, the false detection or missing detection condition of the ultrasonic radar to be judged is judged according to the mutual overlapping condition of the coverage areas of the ultrasonic radar to be judged and the adjacent ultrasonic radars and the coordinates of the obstacles returned by the ultrasonic radars in the ultrasonic radar array.

And the processing module 43 is configured to perform error correction processing on the obstacle information acquired by each ultrasonic radar in the upper array and the obstacle information acquired by each ultrasonic radar in the lower array according to the determination result.

And the determining module 44 is configured to determine positions of the obstacles in the vehicle body coordinate system according to the obstacle information acquired by each ultrasonic radar of the upper array and the obstacle information acquired by each ultrasonic radar of the lower array after the error correction processing, and perform fusion.

Preferably, the unmanned vehicle decision is made according to the position of the obstacle obtained by fusion.

Preferably, if only a single ultrasonic radar returns the coordinates of the obstacle, it is determined that the obstacle is located on a portion of the coverage area of the single ultrasonic radar with the single ultrasonic radar as the origin and the arc with the obstacle distance as the radius.

Through this application the embodiment can effectively judge the false retrieval and the omission that each ultrasonic radar appears in the ultrasonic radar array, the accurate obstacle position of confirming to reduced the detection blind area, improved unmanned vehicle's the security of traveling.

In the embodiments, the descriptions of the respective embodiments have respective emphasis, and for parts that are not described in detail in a certain embodiment, reference may be made to related descriptions of other embodiments.

In the several embodiments provided in the present application, it should be understood that the disclosed method and apparatus may be implemented in other ways. For example, the above-described apparatus embodiments are merely illustrative, and for example, the division of the units is only one logical division, and other divisions may be realized in practice, for example, a plurality of units or components may be combined or integrated into another system, or some features may be omitted, or not executed. In addition, the shown or discussed mutual coupling or direct coupling or communication connection may be an indirect coupling or communication connection through some interfaces, devices or units, and may be in an electrical, mechanical or other form.

The units described as separate parts may or may not be physically separate, and parts displayed as units may or may not be physical units, may be located in one place, or may be distributed on a plurality of network units. Some or all of the units can be selected according to actual needs to achieve the purpose of the solution of the embodiment.

In addition, functional units in the embodiments of the present application may be integrated into one processing unit, or each unit may exist alone physically, or two or more units are integrated into one unit. The integrated unit can be realized in a form of hardware, or in a form of hardware plus a software functional unit.

Fig. 5 illustrates a block diagram of an exemplary computer system/server 012 suitable for use in implementing embodiments of the invention. The computer system/server 012 shown in fig. 5 is only an example, and should not bring any limitation to the function and the scope of use of the embodiment of the present invention.

As shown in fig. 5, the computer system/server 012 is embodied as a general purpose computing device. The components of computer system/server 012 may include, but are not limited to: one or more processors or processing units 016, a system memory 028, and a bus 018 that couples various system components including the system memory 028 and the processing unit 016.

Bus 018 represents one or more of any of several types of bus structures, including a memory bus or memory controller, a peripheral bus, an accelerated graphics port, a processor, or a local bus using any of a variety of bus architectures. By way of example, such architectures include, but are not limited to, Industry Standard Architecture (ISA) bus, micro-channel architecture (MAC) bus, enhanced ISA bus, Video Electronics Standards Association (VESA) local bus, and Peripheral Component Interconnect (PCI) bus.

Computer system/server 012 typically includes a variety of computer system readable media. Such media may be any available media that is accessible by computer system/server 012 and includes both volatile and nonvolatile media, removable and non-removable media.

System memory 028 can include computer system readable media in the form of volatile memory, such as Random Access Memory (RAM)030 and/or cache memory 032. The computer system/server 012 may further include other removable/non-removable, volatile/nonvolatile computer system storage media. By way of example only, storage system 034 may be used to read from and write to non-removable, nonvolatile magnetic media (not shown in FIG. 5, commonly referred to as a "hard drive"). Although not shown in FIG. 5, a magnetic disk drive for reading from and writing to a removable, nonvolatile magnetic disk (e.g., a "floppy disk") and an optical disk drive for reading from or writing to a removable, nonvolatile optical disk (e.g., a CD-ROM, DVD-ROM, or other optical media) may be provided. In such cases, each drive may be connected to bus 018 via one or more data media interfaces. Memory 028 can include at least one program product having a set (e.g., at least one) of program modules configured to carry out the functions of embodiments of the present invention.

Program/utility 040 having a set (at least one) of program modules 042 can be stored, for example, in memory 028, such program modules 042 including, but not limited to, an operating system, one or more application programs, other program modules, and program data, each of which examples or some combination thereof might include an implementation of a network environment. Program modules 042 generally perform the functions and/or methodologies of embodiments of the present invention as described herein.

The computer system/server 012 may also communicate with one or more external devices 014 (e.g., keyboard, pointing device, display 024, etc.), hi the present invention, the computer system/server 012 communicates with an external radar device, and may also communicate with one or more devices that enable a user to interact with the computer system/server 012, and/or with any device (e.g., network card, modem, etc.) that enables the computer system/server 012 to communicate with one or more other computing devices. Such communication may occur through an input/output (I/O) interface 022. Also, the computer system/server 012 may communicate with one or more networks (e.g., a Local Area Network (LAN), a Wide Area Network (WAN), and/or a public network such as the internet) via the network adapter 020. As shown in fig. 5, the network adapter 020 communicates with the other modules of the computer system/server 012 via bus 018. It should be appreciated that although not shown in fig. 5, other hardware and/or software modules may be used in conjunction with the computer system/server 012, including but not limited to: microcode, device drivers, redundant processing units, external disk drive arrays, RAID systems, tape drives, and data backup storage systems, among others.

The processing unit 016 executes the programs stored in the system memory 028, thereby performing the functions and/or methods of the described embodiments of the present invention.

The computer program described above may be provided in a computer storage medium encoded with a computer program that, when executed by one or more computers, causes the one or more computers to perform the method flows and/or apparatus operations shown in the above-described embodiments of the invention.

With the development of time and technology, the meaning of media is more and more extensive, and the propagation path of computer programs is not limited to tangible media any more, and can also be downloaded from a network directly and the like. Any combination of one or more computer-readable media may be employed. The computer readable medium may be a computer readable signal medium or a computer readable storage medium. A computer readable storage medium may be, for example, but not limited to, an electronic, magnetic, optical, electromagnetic, infrared, or semiconductor system, apparatus, or device, or any combination of the foregoing. More specific examples (a non-exhaustive list) of the computer readable storage medium would include the following: an electrical connection having one or more wires, a portable computer diskette, a hard disk, a Random Access Memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disc read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing. In the context of this document, a computer readable storage medium may be any tangible medium that can contain, or store a program for use by or in connection with an instruction execution system, apparatus, or device.

A computer readable signal medium may include a propagated data signal with computer readable program code embodied therein, for example, in baseband or as part of a carrier wave. Such a propagated data signal may take any of a variety of forms, including, but not limited to, electro-magnetic, optical, or any suitable combination thereof. A computer readable signal medium may also be any computer readable medium that is not a computer readable storage medium and that can communicate, propagate, or transport a program for use by or in connection with an instruction execution system, apparatus, or device.

Program code embodied on a computer readable medium may be transmitted using any appropriate medium, including but not limited to wireless, wireline, optical fiber cable, RF, etc., or any suitable combination of the foregoing.

Computer program code for carrying out operations for aspects of the present invention may be written in any combination of one or more programming languages, including an object oriented programming language such as Java, Smalltalk, C + + or the like and conventional procedural programming languages, such as the "C" programming language or similar programming languages. The program code may execute entirely on the user's computer, partly on the user's computer, as a stand-alone software package, partly on the user's computer and partly on a remote computer or entirely on the remote computer or server. In the case of a remote computer, the remote computer may be connected to the user's computer through any type of network, including a Local Area Network (LAN) or a Wide Area Network (WAN), or the connection may be made to an external computer (for example, through the Internet using an Internet service provider).

Finally, it should be noted that: the above embodiments are only used to illustrate the technical solutions of the present application, and not to limit the same; although the present application has been described in detail with reference to the foregoing embodiments, it should be understood by those of ordinary skill in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some technical features may be equivalently replaced; and such modifications or substitutions do not depart from the spirit and scope of the corresponding technical solutions in the embodiments of the present application.

Claims

1. An ultrasonic radar array, comprising:

an upper array and a lower array; wherein the content of the first and second substances,

wherein N, M is a positive integer;

if the number of the ultrasonic radars in the upper array or the lower array is even, the first ultrasonic radar is horizontally arranged on the left side of the center of the bumper, and the second ultrasonic radar is horizontally arranged on the right side of the center of the bumper; (the number of the ultrasonic radars is-2)/2 ultrasonic radars are arranged on the left side of the first ultrasonic radar, and are rotated by alpha in a counterclockwise manner in sequence from the center to the outer side with the ultrasonic radars as the reference; (the number of the ultrasonic radars is-2)/2 ultrasonic radars are arranged on the right side of the second ultrasonic radar, and are sequentially rotated clockwise by alpha from the center to the outer side by taking the ultrasonic radars as a reference;

2. The ultrasonic radar array of claim 1,

and determining the number and the rotation angle alpha of the ultrasonic radars according to the detection distance and the detection shape mathematical model of each ultrasonic radar so as to ensure that triple redundancy exists in the coverage range of the ultrasonic radars.

3. A method of obstacle detection for an ultrasonic radar array according to any one of claims 1-2, comprising:

4. The method according to claim 3, wherein the preset rule is to determine whether the ultrasonic radar to be determined has false detection and missed detection according to whether the adjacent ultrasonic radar of the ultrasonic radar to be determined returns the obstacle coordinates.

5. The method of claim 4, wherein the adjacent ultrasonic radars are one ultrasonic radar on both sides of the ultrasonic radar to be determined and one ultrasonic radar apart.

6. The method of claim 5, wherein the predetermined rule for performing the false positive determination comprises:

7. The method of claim 5, wherein the predetermined rule for performing the missing detection judgment comprises:

8. The method according to claim 3, wherein performing error correction processing on the obstacle information acquired by each of the ultrasonic radars in the upper array and the obstacle information acquired by each of the ultrasonic radars in the lower array according to the determination result comprises:

9. The method according to claim 8, wherein determining the position of the obstacle in the vehicle body coordinate system according to the obstacle information collected by each of the ultrasonic radars of the upper array and the obstacle information collected by each of the ultrasonic radars of the lower array after the error correction processing, and performing the fusion comprises:

10. An obstacle detection system for an ultrasonic radar array according to any one of claims 1-2, comprising:

11. The system according to claim 10, wherein the predetermined rule is to determine whether the ultrasonic radar to be determined has false detection or missed detection according to whether the adjacent ultrasonic radar of the ultrasonic radar to be determined returns the obstacle coordinates.

12. The system of claim 11, wherein the adjacent ultrasonic radars are one ultrasonic radar on both sides of the ultrasonic radar to be determined and one ultrasonic radar apart.

13. The system of claim 12, wherein the predetermined rule for performing the false positive determination comprises:

14. The system of claim 12, wherein the predetermined rules for performing the missing detection determination include:

15. The system of claim 10, wherein the processing module is specifically configured to:

16. The system of claim 15, wherein the determination module is specifically configured to:

17. A computer device comprising a memory, a processor and a computer program stored on the memory and executable on the processor, characterized in that the processor implements the method according to any of claims 3-9 when executing the program.

18. A computer-readable storage medium, on which a computer program is stored, which program, when being executed by a processor, carries out the method according to any one of claims 3-9.