Ultrasonic radar ranging method and device

By using random mode and image sensor in ultrasonic radar system to obtain reference distance, dynamically switch working modes and match probe configuration parameters, the problem of homofrequency interference is solved, the accuracy of distance measurement is improved, and the reliability of the automatic parking system is ensured. .

CN114460585BActive Publication Date: 2024-11-26FORYOU GENERAL ELECTRONICS
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202111675413.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-12-31
Publication Date
2024-11-26
Estimated Expiration
2041-12-31

AI Technical Summary

Technical Problem

Existing ultrasonic radar ranging technology is susceptible to homofrequency interference, affecting the decision-making and judgment of the automatic parking system, resulting in parking failure or accidents.

Method used

By controlling the radar system to work in random mode, the reference distance is obtained in combination with the image sensor, the difference between the initial distance and the reference distance is judged, the working mode is dynamically switched to reduce interference, and the distance measurement accuracy is improved through the matching of the probe configuration parameter.

Benefits of technology

It effectively reduces the synchronous interference of ultrasonic radar, improves the accuracy of distance measurement, and ensures the reliability of the automatic parking system.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114460585B_ABST
    Figure CN114460585B_ABST
Patent Text Reader

Abstract

The present invention provides an ultrasonic radar ranging method and device, the method comprising: step 1, controlling the radar system to work in a first mode; step 2, obtaining the initial distance of the obstacle according to the echo of each radar sensor; step 3, synchronizing with the radar system to transmit waves, obtaining an image within the field of view of the radar system, and identifying whether there is an obstacle, if so, obtaining a reference distance to the obstacle, otherwise executing step 5; step 4, judging whether the absolute value of the difference between the reference distance and the initial distance is greater than a preset error threshold, if so, executing step 5, otherwise judging that the initial distance meets the preset requirements; step 5, controlling the radar system to work in a second mode, and returning to step 2. The present invention achieves the improvement of ranging accuracy while reducing the same-frequency interference of ultrasonic radar.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of radar ranging technology, and in particular to an ultrasonic radar ranging method and device. Background Art

[0002] With the rapid development of automatic parking technology, more and more vehicles are equipped with automatic parking systems. One of the important functions of the automatic parking system is to measure the distance to obstacles, and the distance measurement is mainly completed by ultrasonic radar.

[0003] Current ultrasonic radars detect obstacles around the vehicle body by emitting sound wave signals of a fixed frequency. This ranging method is easily interfered by nearby ultrasonic signals of the same frequency, which can affect the decision-making of the automatic parking system, leading to parking failure and even accidents. Summary of the invention

[0004] The present invention provides an ultrasonic radar ranging method and device, aiming to solve the defects in the prior art and improve the ranging accuracy while reducing the same-frequency interference of the ultrasonic radar.

[0005] In order to achieve the above object, the technical solution adopted by the present invention is:

[0006] One aspect of the present invention provides an ultrasonic radar ranging method, comprising:

[0007] Step 1: Control the radar system to work in a first mode, where the first mode is a random mode in the built-in radar working mode;

[0008] Step 2: Obtain the initial distance of the obstacle according to the echo of each radar sensor;

[0009] Step 3, synchronously with the radar system transmitting waves, acquiring an image within the field of view of the radar system, and identifying whether there is an obstacle, if yes, obtaining a reference distance to the obstacle, otherwise executing step 5;

[0010] Step 4: determine whether the absolute value of the difference between the reference distance and the initial distance is greater than a preset error threshold, if yes, execute step 5, otherwise determine that the initial distance meets the preset requirement;

[0011] Step 5: Control the radar system to operate in a second mode, and return to step 2, wherein the second mode is a random mode in the built-in radar operating mode except the first mode.

[0012] Specifically, the step 2 includes:

[0013] Step 201, sampling a preset number of continuous echo signals at a preset period, and saving the obtained sampling points;

[0014] Step 202: determining the peak value of each echo signal according to the sampling point;

[0015] Step 203, determining the maximum peak value among the peak values ​​and the period number of the echo signal corresponding thereto;

[0016] Step 204, determining a reference point, the reference point being the first peak point greater than the ratio of the maximum peak to the cycle number of the echo signal corresponding to the maximum peak;

[0017] Step 205: searching from the reference point to the first pair of adjacent sampling points that meet a preset amplitude feature, wherein the preset amplitude feature is that the amplitude of the first sampling point among the adjacent sampling points is positive, and the amplitude of the second sampling point is negative;

[0018] Step 206, calculating the echo time according to a first preset formula;

[0019] Step 206: Calculate the initial distance of the obstacle according to the second preset formula.

[0020] Specifically, the first preset formula is:

[0021] △t=Ts*{m+A(m) / [(A(m)-A(m+1)]}, where △t represents the echo time, Ts represents the sampling period, m represents the storage number of the previous sampling point, A(m) represents the amplitude of the previous sampling point, and A(m+1) represents the amplitude of the subsequent sampling point.

[0022] Specifically, the second preset formula is:

[0023] Si=c*Δt / 2, where Si represents the initial distance of the obstacle, c represents the speed of sound, and Δt represents the echo time.

[0024] Furthermore, after step 4, the method further includes:

[0025] Step 41, determine whether the initial distance matches the current probe configuration parameter, if yes, use the initial distance as the final measurement distance, otherwise switch the probe configuration parameter to a probe configuration parameter that matches the initial distance and return to step 1.

[0026] Specifically, the current probe configuration parameters are default probe configuration parameters or probe configuration parameters used last time.

[0027] Specifically, the probe configuration parameters include the number of waves, measurement time, amplification factor, and sensitivity.

[0028] Another aspect of the present invention provides an ultrasonic radar ranging device, comprising: a control module, and a radar sensor group, an image sensor, and an error judgment module connected to the control module, and also comprising a first distance calculation module and a second distance calculation module connected to the error judgment module, wherein the first distance calculation module is also connected to the radar sensor, and the second distance calculation module is also connected to the image sensor;

[0029] The radar sensor group includes at least three radar sensors, which are used to operate according to a mode set by the control module and transmit or / and receive detection sound waves;

[0030] The image sensor is used to obtain images within the field of view of the radar system;

[0031] The first distance calculation module is used to obtain the initial distance of the obstacle according to a preset calculation rule through the echo;

[0032] The second distance calculation module is used to obtain a reference distance of the obstacle according to the image;

[0033] The error judgment module is used to send a radar working mode switching signal to the control module according to the relationship between the reference distance and the initial distance;

[0034] The control module is used to set the initial working mode of the radar sensor group and receive the working mode switching signal sent by the error judgment module to switch the working mode of the radar sensor group.

[0035] Furthermore, the first distance calculation module is also connected to the control module, and also includes a configuration storage module connected to the control module, for storing probe configuration parameters corresponding to each detection distance interval of the radar sensor;

[0036] The control module is used for reading the matching probe configuration parameters from the configuration storage module to configure the working parameters of the radar sensor group when the initial distance does not match the current probe configuration parameters.

[0037] Specifically, the image sensor is a wide-angle camera.

[0038] The beneficial effect of the present invention is that the present invention controls the radar system to work in a randomly selected mode, obtains the initial distance of the obstacle according to the echo, and simultaneously obtains the reference distance according to the image, and then decides whether to change the working mode of the radar system according to the relationship between the reference distance and the initial distance, thereby achieving the improvement of the ranging accuracy while reducing the same-frequency interference of the ultrasonic radar. BRIEF DESCRIPTION OF THE DRAWINGS

[0039] Figure 1 It is a schematic diagram of the flow of the ultrasonic radar ranging method of the present invention;

[0040] Figure 2 It is a schematic diagram of the structure of the ultrasonic radar ranging device of the present invention;

[0041] Figure 3 It is another structural schematic diagram of the ultrasonic radar ranging device of the present invention. DETAILED DESCRIPTION

[0042] The following specifically describes the embodiments of the present invention in conjunction with the accompanying drawings, which are only for reference and illustration and do not constitute a limitation on the scope of patent protection of the present invention.

[0043] Example 1

[0044] like Figure 1 As shown, this embodiment provides an ultrasonic radar ranging method, including:

[0045] Step 1: Control the radar system to work in a first mode, where the first mode is a random mode in the built-in radar working mode.

[0046] In this embodiment, the radar system includes at least three radars, namely a first radar, a second radar and a third radar. Each radar can operate in a direct measurement mode and an indirect measurement test mode. Each radar can receive echoes emitted by itself and adjacent radars.

[0047] The built-in radar working modes can be combined according to the measurement mode and wave form of each radar. As an implementable example, some built-in radar working modes are as follows:

[0048] 1) The first radar and the second radar send sound waves of fixed frequency and receive their own echo signals, while the third radar and the fourth radar do not send waves but receive the echoes of the first radar and the second radar;

[0049] 2) The first radar and the third radar send sound waves of a fixed frequency, and the second radar and the fourth radar receive echoes;

[0050] 3) The first radar sends a decreasing LFM sound wave, the second radar sends an increasing LFM sound wave, and the third radar and the fourth radar receive the echo;

[0051] 4) The third radar sends an increasing LFM sound wave, the fourth radar sends a decreasing LFM sound wave, and the first radar and the second radar work to receive echoes;

[0052] 5) and so on.

[0053] LFM is the abbreviation of Linear Frequency Modulation, which means linear frequency modulation. LFM signal refers to a signal whose instantaneous frequency changes linearly with time.

[0054] Step 2: Obtain the initial distance of the obstacle based on the echo of each radar sensor.

[0055] In this embodiment, step 2 includes:

[0056] Step 201: Sample a preset number of consecutive echo signals at a preset period, and save the obtained sampling points.

[0057] For example, if the preset number is n, the period sequence number i of each echo signal is recorded as 1, 2, 3...n-1 in sequence.

[0058] Step 202: Determine the peak value of each echo signal according to the sampling points.

[0059] Step 203: Determine the maximum peak value among the peak values ​​and the period number of the echo signal corresponding to the maximum peak value.

[0060] Step 204: determine a reference point, where the reference point is the first peak point that is greater than the ratio of the maximum peak value to the cycle number of the echo signal corresponding to the maximum peak value.

[0061] Step 205 : searching from the reference point backward for a first pair of adjacent sampling points that meet a preset amplitude feature, wherein the preset amplitude feature is that the amplitude of the preceding sampling point among the adjacent sampling points is positive, and the amplitude of the succeeding sampling point is negative.

[0062] Step 206: Calculate the echo time according to the first preset formula.

[0063] In this embodiment, the first preset formula is:

[0064] △t=Ts*{m+A(m) / [(A(m)-A(m+1)]}, where △t represents the echo time, Ts represents the sampling period, m represents the storage number of the previous sampling point, A(m) represents the amplitude of the previous sampling point, and A(m+1) represents the amplitude of the subsequent sampling point.

[0065] Step 206: Calculate the initial distance of the obstacle according to the second preset formula.

[0066] In this embodiment, the second preset formula is:

[0067] Si=c*Δt / 2, where Si represents the initial distance of the obstacle, c represents the speed of sound, and Δt represents the echo time.

[0068] Step 3: Synchronize with the radar system to obtain the image within the field of view of the radar system and identify whether there is an obstacle. If yes, obtain the reference distance to the obstacle; otherwise, execute step 5.

[0069] Acquiring the distance to an obstacle through an image is a prior art and will not be described in detail here.

[0070] If it is determined through image recognition that there are no obstacles in the image within the field of view of the radar system, it can be determined that the echo signal received in step 2 is an interference signal, the initial distance should be ignored, and the working mode of the radar should be changed.

[0071] Step 4: determine whether the absolute value of the difference between the reference distance and the initial distance is greater than a preset error threshold, if yes, execute step 5, otherwise determine that the initial distance meets the preset requirements.

[0072] In this embodiment, the preset error threshold can be determined according to actual calibration.

[0073] Step 5: Control the radar system to operate in a second mode, and return to step 2, wherein the second mode is a random mode in the built-in radar operating mode except the first mode.

[0074] After calculation, it can be known that using the above steps, if the obstacle distance refresh period of the system is 100ms and the radar system's wave transmission period (working period) is 10ms, then the co-frequency interference probability P at the same location and time is:

[0075]

[0076] in, Indicates the number of combinations of selecting two wave transmission cycles to work in the first mode within a 100ms refresh cycle. It indicates the number of combinations of selecting two wave transmission cycles from the other eight wave transmission cycles to work in the second mode.

[0077] It can be seen that by randomly emitting waves, the probability of ultrasonic radar being interfered with can be greatly reduced.

[0078] In addition, error judgment is performed by integrating the reference distance of the camera, so that interference can be further filtered out.

[0079] Example 2

[0080] Different from the first embodiment, this embodiment further includes after the step 4:

[0081] Step 41, determine whether the initial distance matches the current probe configuration parameter, if yes, use the initial distance as the final measurement distance, otherwise switch the probe configuration parameter to a probe configuration parameter that matches the initial distance and return to step 1.

[0082] In a specific embodiment, according to each detection distance interval (0.5m / 2m / 3m) of the radar, several corresponding groups of probe configuration parameters, such as probe configuration parameters A, B, C, etc., are stored in advance.

[0083] In this embodiment, the probe configuration parameters include but are not limited to the number of waves, measurement time, amplification factor, and sensitivity.

[0084] In this embodiment, the current probe configuration parameters are default probe configuration parameters or probe configuration parameters used last time.

[0085] For example, if the currently used probe configuration parameter A (corresponding to a 0.5m detection distance interval) and the initial ranging of the radar is 1.2m, the measurement result is not very accurate. Therefore, in order to obtain a more accurate measurement result, the probe configuration parameter can be switched to B.

[0086] This embodiment dynamically matches the corresponding probe configuration parameters through the initial distance, thereby making the distance measurement more accurate.

[0087] Example 3

[0088] like Figure 2 As shown, this embodiment provides an ultrasonic radar ranging device, including: a control module, and a radar sensor group, an image sensor, and an error judgment module connected to the control module, and also includes a first distance calculation module and a second distance calculation module connected to the error judgment module, wherein the first distance calculation module is also connected to the radar sensor, and the second distance calculation module is also connected to the image sensor;

[0089] The radar sensor group includes at least three radar sensors, which are used to operate according to a mode set by the control module and transmit or / and receive detection sound waves;

[0090] The image sensor is used to obtain images within the field of view of the radar system;

[0091] The first distance calculation module is used to obtain the initial distance of the obstacle according to a preset calculation rule;

[0092] The second distance calculation module is used to obtain a reference distance of the obstacle according to the image;

[0093] The error judgment module is used to send a radar working mode switching signal to the control module according to the relationship between the reference distance and the initial distance;

[0094] The control module is used to set the initial working mode of the radar sensor group and receive the working mode switching signal sent by the error judgment module to switch the working mode of the radar sensor group.

[0095] In this embodiment, the image sensor is a wide-angle camera.

[0096] The working process of the ultrasonic radar ranging device of this embodiment corresponds to the method described in Example 1 and will not be repeated here.

[0097] Example 4

[0098] like Figure 3 As shown, different from Example 3, in the ultrasonic radar ranging device provided in this embodiment, the first distance calculation module is also connected to the control module, and also includes a configuration storage module connected to the control module, which is used to store probe configuration parameters corresponding to each detection distance interval of the radar sensor;

[0099] The control module is used for reading the matching probe configuration parameters from the configuration storage module to configure the working parameters of the radar sensor group when the initial distance does not match the current probe configuration parameters.

[0100] The working process of the ultrasonic radar ranging device of this embodiment corresponds to the method described in Example 2 and will not be repeated here.

[0101] The above disclosure is only a preferred embodiment of the present invention, which cannot be used to limit the scope of protection of the present invention. Therefore, equivalent changes made according to the scope of the patent application of the present invention are still within the scope covered by the present invention.

Claims

1. An ultrasonic radar ranging method, characterized in that: include: Step 1: Control the radar system to work in a first mode, where the first mode is a random mode in the built-in radar working mode; Step 2: Obtain the initial distance of the obstacle according to the echo of each radar sensor; Step 3, synchronously with the radar system transmitting waves, acquiring an image within the field of view of the radar system, and identifying whether there is an obstacle, if yes, acquiring a reference distance to the obstacle, otherwise executing step 5; Step 4: determine whether the absolute value of the difference between the reference distance and the initial distance is greater than a preset error threshold, if yes, execute step 5, otherwise determine that the initial distance meets the preset requirement; Step 41, determining whether the initial distance matches the current probe configuration parameter, if yes, taking the initial distance as the final measurement distance, otherwise switching the probe configuration parameter to a probe configuration parameter matching the initial distance and returning to step 1; Step 5: Control the radar system to operate in a second mode, and return to step 2, wherein the second mode is a random mode in the built-in radar operating mode except the first mode.

2. The ultrasonic radar ranging method according to claim 1, characterized in that: The step 2 comprises: Step 201, sampling a preset number of continuous echo signals at a preset period, and saving the obtained sampling points; Step 202: determining the peak value of each echo signal according to the sampling points; Step 203, determining the maximum peak value among the peak values ​​and the period number of the echo signal corresponding thereto; Step 204, determining a reference point, the reference point being the first peak point greater than the ratio of the maximum peak to the cycle number of the echo signal corresponding to the maximum peak; Step 205: searching from the reference point to the first pair of adjacent sampling points that meet a preset amplitude feature, wherein the preset amplitude feature is that the amplitude of the first sampling point among the adjacent sampling points is positive, and the amplitude of the second sampling point is negative; Step 206, calculating the echo time according to a first preset formula; Step 206: Calculate the initial distance of the obstacle according to the second preset formula.

3. The ultrasonic radar ranging method according to claim 2, characterized in that: The first preset formula is: △t=Ts*{m+A(m) / [(A(m)-A(m+1)]}, where △t represents the echo time, Ts represents the sampling period, m represents the storage number of the previous sampling point, A(m) represents the amplitude of the previous sampling point, and A(m+1) represents the amplitude of the subsequent sampling point.

4. The ultrasonic radar ranging method according to claim 3, characterized in that: The second preset formula is: Si=c*△t / 2, where Si represents the initial distance of the obstacle, c represents the speed of sound, and △t represents the echo time.

5. The ultrasonic radar ranging method according to claim 1, characterized in that: The current probe configuration parameters are default probe configuration parameters or probe configuration parameters used last time.

6. The ultrasonic radar ranging method according to claim 5, characterized in that: The probe configuration parameters include the number of waves, measurement time, amplification factor, and sensitivity.

7. An ultrasonic radar ranging device, characterized in that: include: A control module, and a radar sensor group, an image sensor, and an error judgment module connected to the control module, and also includes a first distance calculation module and a second distance calculation module connected to the error judgment module, the first distance calculation module is also connected to the radar sensor, and the second distance calculation module is also connected to the image sensor; The radar sensor group includes at least three radar sensors, which are used to operate according to a mode set by the control module and transmit or / and receive detection sound waves; The image sensor is used to obtain images within the field of view of the radar system; The first distance calculation module is used to obtain the initial distance of the obstacle according to a preset calculation rule through the echo; The second distance calculation module is used to obtain a reference distance of the obstacle according to the image; The error judgment module is used to send a radar working mode switching signal to the control module according to the relationship between the reference distance and the initial distance; The control module is used to set the initial working mode of the radar sensor group and receive the working mode switching signal sent by the error judgment module to switch the working mode of the radar sensor group; Also included is a configuration storage module connected to the control module, for storing probe configuration parameters corresponding to each detection distance interval of the radar sensor; The control module is used for reading the matching probe configuration parameters from the configuration storage module to configure the working parameters of the radar sensor group when the initial distance does not match the current probe configuration parameters.

8. The ultrasonic radar ranging device according to claim 7, characterized in that: The image sensor is a wide-angle camera.