A self-calibration method, device, and storage medium for radar networking
By employing a self-calibration method in millimeter-wave radar networking, utilizing ToF measurement and clock synchronization technology, the radar angle is automatically calculated, solving the problems of tedious and low-precision manual calibration, and achieving high-precision self-calibration for radar networking.
Patent Information
- Application Number
- CN202511839296.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2025-12-08
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2045-12-08
AI Technical Summary
Existing millimeter-wave radar network calibration relies on manual operation, which is cumbersome, time-consuming, and labor-intensive, and has low accuracy in complex terrain or large-scale scenarios.
By using the radar coordinate system of one millimeter-wave radar as a reference in the radar network, other radars perform self-calibration based on the object's movement information, calculate the radar angle, and use ToF measurement signals and clock synchronization technology to automatically calculate the relative attitude between radars without human intervention.
It improves the accuracy of radar network calibration, reduces human error, and ensures the consistency and accuracy of collaborative work among radars in the radar network.
Smart Images

Figure CN121348248B_ABST
Abstract
Description
Technical Field
[0001] The embodiments of the present invention relate to the field of radar detection technology, and in particular to a self-calibration method, device and storage medium for radar networking. Background Technology
[0002] Millimeter-wave radar, with its advantages of strong anti-interference capability, good environmental adaptability, and accurate acquisition of target distance and speed information, has been applied in fields such as intelligent transportation, industrial monitoring, and security surveillance. In practical life, multiple millimeter-wave radars are often used to build radar networks, which are then applied to various aspects of life. For example, in traffic control at urban intersections, multiple millimeter-wave radars need to work together to achieve vehicle detection without blind spots. However, the sensing accuracy of a radar network is related to the accuracy of the spatial position and attitude relationship between each millimeter-wave radar.
[0003] Currently, the calibration of millimeter-wave radar networks largely relies on manual calibration. Manual calibration requires staff to use measuring tools to determine the installation parameters of the millimeter-wave radars on-site and measure the position and attitude relationships of each millimeter-wave radar. This is not only cumbersome and time-consuming, but also results in low accuracy when calibrating multiple millimeter-wave radars in complex terrain or large-scale network scenarios. Summary of the Invention
[0004] This invention provides a self-calibration method, device, and storage medium for radar networking, which improves the accuracy of mutual calibration between radars.
[0005] In a first aspect, embodiments of the present invention provide a self-calibration method for a radar network, wherein the radar network includes multiple millimeter-wave radars, an object moves among the multiple millimeter-wave radars, and the radar coordinate system of the current millimeter-wave radar is used as a reference for calibrating the other millimeter-wave radars. The method includes:
[0006] The millimeter-wave radar measures first movement information of the object, sends a recording signal to other millimeter-wave radars, and measures the first original coordinates of the object based on the first movement information and the first radar coordinates of the current millimeter-wave radar.
[0007] When the other millimeter-wave radars receive the recording signal, they measure second movement information of the object and measure the second original coordinates of the object based on the second movement information and the second radar coordinates of other millimeter-wave radars.
[0008] The current millimeter-wave radar fits a first moving trajectory belonging to a straight line to the object based on the first original coordinates, and sends the first moving angle formed by the first moving trajectory and the normal of the current millimeter-wave radar to other millimeter-wave radars;
[0009] The other millimeter-wave radars fit a second moving trajectory belonging to a straight line to the object based on the second original coordinates, and send the second moving angle formed by the second moving trajectory and the normal of the other millimeter-wave radars to the current millimeter-wave radar;
[0010] The millimeter-wave radar currently calculates the radar angle formed by the normal of the current millimeter-wave radar and the normal of other millimeter-wave radars based on the first moving angle and the second moving angle.
[0011] The other millimeter-wave radars calculate the radar angle formed by the normal of the current millimeter-wave radar and the normal of other millimeter-wave radars based on the first moving angle and the second moving angle.
[0012] Secondly, embodiments of the present invention also provide a self-calibration device for a radar network, wherein the radar network includes multiple millimeter-wave radars, an object moves among the multiple millimeter-wave radars, and the radar coordinate system of the current millimeter-wave radar is used as a reference for calibrating the other millimeter-wave radars. The device includes:
[0013] The first original coordinate measurement module is used to measure the first movement information of the object by the current millimeter-wave radar, send recording signals to other millimeter-wave radars, and measure the first original coordinates of the object based on the first movement information and the first radar coordinates of the current millimeter-wave radar.
[0014] The second original coordinate measurement module is used to measure the second movement information of the object when the other millimeter-wave radars receive the recording signal, and to measure the second original coordinates of the object based on the second movement information and the second radar coordinates of the other millimeter-wave radars.
[0015] The first movement trajectory fitting module is used to fit a first movement trajectory belonging to a straight line to the object based on the first original coordinates of the current millimeter-wave radar, and send the first movement angle formed by the first movement trajectory and the normal of the current millimeter-wave radar to other millimeter-wave radars.
[0016] The second movement trajectory fitting module is used to fit a second movement trajectory belonging to a straight line to the object based on the second original coordinates of the other millimeter-wave radars, and to send the second movement angle formed by the second movement trajectory and the normal of the other millimeter-wave radars to the current millimeter-wave radar.
[0017] The first radar angle calculation module is used to calculate the radar angle formed by the normal of the current millimeter-wave radar and the normal of other millimeter-wave radars based on the first moving angle and the second moving angle.
[0018] The second radar angle calculation module is used by other millimeter-wave radars to calculate the radar angle formed by the normal of the current millimeter-wave radar and the normal of other millimeter-wave radars based on the first moving angle and the second moving angle.
[0019] Thirdly, embodiments of the present invention also provide a computer device, the computer device comprising:
[0020] One or more processors;
[0021] Storage device for storing one or more programs;
[0022] When the one or more programs are executed by the one or more processors, the one or more processors implement the self-calibration method for radar networking as provided in the first aspect of the present invention.
[0023] Fourthly, embodiments of the present invention also provide a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the self-calibration method for radar networking as provided in the first aspect of the present invention.
[0024] Fifthly, embodiments of the present invention also provide a computer program product, the computer program product including a computer program, which, when executed by a processor, implements the self-calibration method for radar networking as provided in the first aspect of the present invention.
[0025] In this embodiment of the invention, a radar network includes multiple millimeter-wave radars. An object moves among these radars. The radar coordinate system of the current millimeter-wave radar serves as the reference for calibrating other millimeter-wave radars. The current millimeter-wave radar measures first movement information of the object and sends a recording signal to the other millimeter-wave radars. Based on the first movement information and the first radar coordinates of the current millimeter-wave radar, it measures the object's first original coordinates. When the other millimeter-wave radars receive the recording signal, they measure second movement information of the object and measure the object's second original coordinates based on the second movement information and the second radar coordinates of the other millimeter-wave radars. The current millimeter-wave radar fits a linear coordinate system to the object based on the first original coordinates. The first moving trajectory of the line is sent to other millimeter-wave radars, and the first moving angle formed by the first moving trajectory and the normal of the current millimeter-wave radar is sent to the other millimeter-wave radars. The other millimeter-wave radars fit a second moving trajectory belonging to a straight line to the object based on the second original coordinates, and send the second moving angle formed by the second moving trajectory and the normal of the other millimeter-wave radars to the current millimeter-wave radar. The current millimeter-wave radar calculates the radar angle formed by the normal of the current millimeter-wave radar and the normal of the other millimeter-wave radars based on the first moving angle and the second moving angle. The other millimeter-wave radars calculate the radar angle formed by the normal of the current millimeter-wave radar and the normal of the other millimeter-wave radars based on the first moving angle and the second moving angle. This embodiment determines the spatial attitude of two millimeter-wave radars using a first and a second moving angle. Both the first and second moving angles are obtained based on a unified radar coordinate system and the same moving object, avoiding calibration deviations caused by inconsistent references and ensuring the usability of the first and second moving angles in the same dimension and from the same source. The difference between the first and second moving angles directly maps the relative relationship of the normal directions of the two millimeter-wave radars in the radar coordinate system, eliminating the need for complex coordinate transformations or indirect derivation through multi-sensor fusion, minimizing errors introduced by intermediate steps, and improving calibration accuracy. The entire process of calculating the radar angles is automated. In the radar network, one millimeter-wave radar is selected as the reference. By setting the same reference object and based on the signal transmission and reception characteristics of the millimeter-wave radar itself, the entire process requires no manual intervention, completing the self-calibration between the two radars, reducing objective errors caused by human intervention, and improving the accuracy of radar network self-calibration. Attached Figure Description
[0026] To more clearly illustrate the technical solutions in the embodiments of the present invention, the accompanying drawings used in the description of the embodiments will be briefly introduced below. Obviously, the accompanying drawings described below are only some embodiments of the present invention. For those skilled in the art, other drawings can be obtained based on these drawings without creative effort.
[0027] Figure 1 This is a flowchart of a self-calibration method for radar networking provided in Embodiment 1 of the present invention;
[0028] Figure 2 This is a schematic diagram of a confirmation execution calibration signaling process provided in Embodiment 1 of the present invention;
[0029] Figure 3 This is a schematic diagram of clock error synchronization provided in Embodiment 1 of the present invention;
[0030] Figure 4 This is a schematic diagram of a radar ranging signaling process provided in Embodiment 1 of the present invention;
[0031] Figure 5 This is a schematic diagram illustrating the calculation of radar angles based on a trajectory, provided in Embodiment 1 of the present invention.
[0032] Figure 6 This is a structural block diagram of a self-calibration device for radar networking provided in Embodiment 2 of the present invention;
[0033] Figure 7 This is a schematic diagram of the structure of a computer device provided in Embodiment 3 of the present invention. Detailed Implementation
[0034] To enable those skilled in the art to better understand the present invention, the technical solutions of the present invention will be clearly and completely described below with reference to the accompanying drawings of the embodiments of the present invention. Obviously, the described embodiments are only some embodiments of the present invention, and not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort should fall within the scope of protection of the present invention.
[0035] It should be noted that the terms "first," "second," etc., in the specification, claims, and accompanying drawings of this invention are used to distinguish similar objects and are not necessarily used to describe a specific order or sequence. It should be understood that such data can be used interchangeably where appropriate so that the embodiments of the invention described herein can cover implementations in sequences other than those illustrated or described herein. Furthermore, the terms "comprising" and "having," and any variations thereof, are intended to cover non-exclusive inclusion; for example, a process, method, system, product, or apparatus that comprises a series of steps or units is not necessarily limited to those steps or units explicitly listed, but may include other steps or units not explicitly listed or inherent to such processes, methods, products, or apparatus.
[0036] Example 1
[0037] See Figure 1The diagram illustrates a flowchart of a self-calibration method for radar networking according to Embodiment 1 of the present invention. This embodiment is applicable to situations where the difference in the angle between the normals of two millimeter-wave radars and the reference object indirectly maps the relative positional relationship of the two millimeter-wave radars in the same radar coordinate system. This method can be executed by a self-calibration device for radar networking, which can be implemented in hardware and / or software and can be configured in a computer device. Figure 1 As shown, the method includes:
[0038] Step 101: The current millimeter-wave radar measures the first movement information of the object, sends a recording signal to other millimeter-wave radars, and measures the first original coordinates of the object based on the first movement information and the first radar coordinates of the current millimeter-wave radar.
[0039] In this embodiment, the current millimeter-wave radar emits a unidirectional Time of Flight (ToF) measurement signal to the object. When the ToF measurement signal comes into contact with the object, it is reflected back to the current millimeter-wave radar. The current millimeter-wave radar records the angle between the reflected ToF measurement signal and its own normal, as well as the round-trip time of the ToF signal. The current millimeter-wave radar obtains the distance between the current millimeter-wave radar and the object based on the round-trip time and the electromagnetic wave propagation speed (approximately the speed of light). After obtaining the object's first movement information (the distance between the current millimeter-wave radar and the object, and the angle between the reflected ToF measurement signal and its own normal), it can accurately locate the object's specific position in the radar coordinate system (i.e., the object's first original coordinates) by combining the conversion rules between polar coordinates and rectangular coordinates. ToF measurement is mainly for time measurement and is less affected by external factors such as ambient light, color, and temperature. Especially in the millimeter wave band, it has good anti-interference capabilities and all-weather operation characteristics. The entire process utilizes the characteristics of the ToF measurement signal to locate the object in the radar coordinate system, ensuring data reliability and providing high-precision data for the subsequent calibration of two millimeter wave radars. This can further improve the accuracy of subsequent radar network self-calibration.
[0040] Currently, millimeter-wave radar, as a reference radar (i.e., using its own radar coordinate system as the reference for calibrating other millimeter-wave radars, with its own normal as the X-axis of the radar coordinate system), needs to transmit synchronous measurement commands to other millimeter-wave radars through recording signals. This ensures that the two mutually calibrated millimeter-wave radars observe the state of an object at the same point in time, avoiding misalignment of observation data caused by object movement. If this synchronous trigger (sending recording signals to other millimeter-wave radars) is lacking, the measurements of other millimeter-wave radars may lag or advance, causing the observed objects of two different mutually calibrated millimeter-wave radars to be the same object, but their corresponding positions may have changed. Subsequent trajectory fitting and angle calculation will lose data correlation, and the entire self-calibration process will lose data input support.
[0041] In one embodiment of the present invention, before performing step 101, the method further includes S1, the current millimeter-wave radar determines one of the other millimeter-wave radars for calibration; S2, the clock errors of the current millimeter-wave radar and the other millimeter-wave radars are determined; and S3, the second radar coordinates of the other millimeter-wave radars in the radar coordinate system are calculated.
[0042] Specifically, S1, the current millimeter-wave radar identifies one of the other millimeter-wave radars for calibration, including the following:
[0043] The current millimeter-wave radar monitors the radio frequency (RF) signal information of channels corresponding to multiple preset frequency points. This RF signal information includes co-channel interference and harmonic interference. The current millimeter-wave radar calculates the anti-interference strength of the channels based on this RF signal information. The current millimeter-wave radar selects the frequency point corresponding to the channel with the highest anti-interference strength as the target frequency point for communication between the current millimeter-wave radar and other millimeter-wave radars. Determining the target frequency point is crucial for building a stable and reliable communication foundation for radar network self-calibration, mitigating the disruption of the radar network calibration process by electromagnetic interference from the source. The electromagnetic environment in which millimeter-wave radars operate often contains complex interference. Co-channel interference (electromagnetic signals in the same communication frequency band as the millimeter-wave radar) directly occupies channel resources, causing communication signals between millimeter-wave radars to be submerged. Harmonic interference (high-frequency signals that are integer multiples of the communication frequency band) may affect signal reception accuracy through harmonic coupling. Both types of interference (RF signal information) can cause signal distortion, packet loss, or delay. Therefore, selecting the frequency point with the highest anti-interference strength as the target frequency point ensures stable transmission of all subsequent interaction signals between millimeter-wave radars, reducing communication obstacles in the entire self-calibration process.
[0044] After determining the target frequency, the next step is to identify other millimeter-wave radars that are performing calibration work with the current millimeter-wave radar, such as... Figure 2 As shown:
[0045] The current millimeter-wave radar (target device A) sends a start signal (StartedSignal) to other millimeter-wave radars (other devices) based on the target frequency. The start signal is accompanied by a first identifier. The first identifier is the identity identifier (ID) of the current millimeter-wave radar, such as ID=001.
[0046] When other millimeter-wave radars (other devices) receive the Started Signal, they record a first identifier (ID) and send a Started Ack Signal to the current millimeter-wave radar (target device A) whose identifier is the first identifier. The response signal is accompanied by a second identifier, which is the identifier (ID) of the other millimeter-wave radar, such as ID=002, 003, etc. The number of other millimeter-wave radars is at least one.
[0047] When the current millimeter-wave radar (target device A) receives the response signal (Started Ack Signal), it selects the second identifier in the start signal (such as ID=002) as the target identifier (TID) and sends the calibration signal (Ready Signal) to other millimeter-wave radars (other devices); the calibration signal is accompanied by the target identifier (TID).
[0048] Upon receiving the calibration signal (Ready Signal), other millimeter-wave radars (other devices) compare their own second identifier (ID) with the target identifier (TID). For example, they search for the one with the second identifier 002. If the second identifier (ID) matches the target identifier (TID), the millimeter-wave radar with the matching second identifier (ID) will perform calibration with the current millimeter-wave radar. The millimeter-wave radar with the matching second identifier (ID) will send a confirmation signal (Ready Confirm Signal) to the current millimeter-wave radar (target device A) and set its own working status to the pending calibration state.
[0049] When the current millimeter-wave radar (target device A) receives the Ready Confirm Signal, it sets its operating status to the calibration pending state, so as to perform calibration work with other millimeter-wave radars in the calibration pending state. The Ready Confirm Signal includes a target identifier (TID).
[0050] Specifically, S2, determine the clock errors of the current millimeter-wave radar and other millimeter-wave radars, including the following:
[0051] like Figure 3 As shown, when the current millimeter-wave radar (device A) and other millimeter-wave radars (device B) are both in the calibrating state, the current millimeter-wave radar (device A) sends a first synchronization pulse with a duration of a first value (TS) to the other millimeter-wave radars (device B).
[0052] When other millimeter-wave radars (device B) receive the first synchronization pulse, they measure the duration of the first synchronization pulse and record it as the second value (LTSB).
[0053] Other millimeter-wave radars (device B) query the first value agreed upon for the first synchronization pulse, and divide the difference between the second value (LTSB) and the first value (TS) by the first value (TS) to obtain the first error on the clock; the first error Lb = (LTSB - TS) / TS.
[0054] Other millimeter-wave radar (device B) sends a second synchronization pulse with a duration of a first value (TS) to the current millimeter-wave radar (device A).
[0055] When the current millimeter-wave radar (device A) receives the second synchronization pulse, the duration of the second synchronization pulse is measured and recorded as the third value (LTSA).
[0056] The current millimeter-wave radar (device A) queries the first value agreed upon for the second synchronization pulse, and divides the difference between the third value (LTSA) and the first value (TS) by the first value (TS) to obtain the second error on the clock. The second error La = (LTSA - TS) / TS.
[0057] In this embodiment, due to factors such as hardware production and operating environment (temperature, voltage fluctuations), the internal clocks of multiple millimeter-wave radars have different running rates. This clock deviation will directly cause the timestamp recording of each millimeter-wave radar to be inaccurate. Since the subsequent calibration process involves the acquisition of timestamps by millimeter-wave radars, if the acquired timestamps are not corrected according to the clock error (first error and second error), it may affect the accuracy of the subsequent radar network self-calibration.
[0058] Specifically, S3 calculates the second radar coordinates of other millimeter-wave radars in the radar coordinate system, including:
[0059] like Figure 4 As shown: When the current millimeter-wave radar (device A) sends the first measurement signal (ToF) to another millimeter-wave radar (device B), the first timestamp (T1) of sending the first measurement signal is recorded.
[0060] When other millimeter-wave radars (device B) receive the first measurement signal, they record the second timestamp (T2) of receiving the first measurement signal, and send the second measurement signal to the current millimeter-wave radar (device A) within a preset time range, and record the third timestamp (T3) of sending the second measurement signal.
[0061] When the current millimeter-wave radar (device A) receives the second measurement signal, it records the fourth timestamp (T4) of receiving the second measurement signal, and records the first normal angle formed by the second measurement signal and the normal of the current millimeter-wave radar.
[0062] The current millimeter-wave radar sends a first data signal to other millimeter-wave radars; the first data signal includes a first difference (T4-T1) between the fourth timestamp and the first timestamp.
[0063] When other millimeter-wave radars receive the first data signal, they calculate the first distance between the current millimeter-wave radar and other millimeter-wave radars based on the first error, and send the second data signal to the current millimeter-wave radar; the second data signal includes the second difference between the third timestamp and the second timestamp, the first distance, and the third distance between other millimeter-wave radars and the object.
[0064] When the current millimeter-wave radar receives the second data signal, it calculates the second distance between the current millimeter-wave radar and other millimeter-wave radars based on the second error. The first distance and the second distance are then fused to obtain the actual distance between the current millimeter-wave radar and other millimeter-wave radars. The average of the two distances (corrected for clock error) is then taken to obtain the actual distance, further reducing the error in the actual distance between the current millimeter-wave radar and other millimeter-wave radars, thus improving the accuracy of subsequent calculations of the second radar coordinates of other millimeter-wave radars.
[0065] The current millimeter-wave radar calculates the second radar coordinates of other millimeter-wave radars based on the third distance, the actual distance, and the angle between the first normal and the second radar coordinates, and then sends the second radar coordinates to the other millimeter-wave radars.
[0066] In one embodiment of the present invention, calculating a first distance between the current millimeter-wave radar and other millimeter-wave radars based on a first error includes the following:
[0067] Other millimeter-wave radars calculate the product between the second difference and the first error to obtain the first time multiplier; other millimeter-wave radars calculate the difference between the first difference and the first time multiplier to obtain the first signal round-trip time; half of the product between the first signal round-trip time and the speed of light is taken to obtain the first distance between the current millimeter-wave radar and other millimeter-wave radars; if the first error is not introduced to correct the second difference, it will be artificially increased or decreased due to the clocks of other millimeter-wave radars being too fast or too slow, which will cause the first signal round-trip time to be calculated incorrectly, ultimately resulting in a large deviation between the first distance and the actual value.
[0068] For example, the first distance is calculated using the following formula:
[0069] Dba=(c / 2)×((T4-T1)-(T3-T2)×(1+Lb));
[0070] Where Dba is the first distance, c is the speed of light, T4-T1 is the first difference, T3-T2 is the second difference, Lb is the first error, T4 is the fourth timestamp, T3 is the third timestamp, T2 is the second timestamp, and T1 is the first timestamp.
[0071] In one embodiment of the present invention, calculating a second distance between the current millimeter-wave radar and other millimeter-wave radars based on a second error includes:
[0072] Calculate the product between the first difference and the second error to obtain the second time multiplier; calculate the difference between the second time multiplier and the second difference to obtain the second signal round-trip time; take half of the product between the second signal round-trip time and the speed of light to obtain the second distance between the current millimeter-wave radar and other millimeter-wave radars.
[0073] For example, the second distance is calculated using the following formula:
[0074] Dab=(c / 2)×((T4-T1)×(1+La)-(T3-T2));
[0075] Where Dab is the second distance, c is the speed of light, T4-T1 is the first difference, T3-T2 is the second difference, La is the second error, T4 is the fourth timestamp, T3 is the third timestamp, T2 is the second timestamp, and T1 is the first timestamp.
[0076] In one embodiment of the present invention, the current millimeter-wave radar calculates the second radar coordinates of other millimeter-wave radars based on the third distance, the actual distance, and the included angle of the first normal, and sends the second radar coordinates to the other millimeter-wave radars, including:
[0077] The product of the actual distance and the first cosine value is added to the X value of the first radar coordinate of the current millimeter-wave radar, which is used as the X value of the first candidate coordinate of other millimeter-wave radars; the first cosine value is the cosine value of the first normal angle.
[0078] The product of the actual distance and the first sine value is supplemented with the Y value of the first radar coordinates to serve as the Y value of the first candidate coordinates for other millimeter-wave radars; the first sine value is the sine of the first normal angle. The first candidate coordinates are (Xa + Dcosθ, Ya + Dsinθ); Xa is the X value of the first radar coordinates, D is the actual distance, θ is the first normal angle, and Ya is the Y value of the first radar coordinates.
[0079] The X value of the first radar coordinate is added to the product of the actual distance and the second cosine value, and used as the X value of the second candidate coordinate of other millimeter-wave radars; the second cosine value is the cosine value after taking the negative of the angle between the first normal and the second cosine value.
[0080] The Y-value of the first radar coordinate is added to the product of the actual distance and the second sine value to obtain the Y-value of the second candidate coordinate for other millimeter-wave radars. The second sine value is the sine of the negative value of the first normal angle. The second candidate coordinates are (Xa + Dcos(-θ), Ya + Dsin(-θ)). Due to the reception limitations of millimeter-wave radar antenna arrays, only the numerical value of the first normal angle (e.g., 30°) is known when it is obtained. Therefore, the first normal angle can have two values (e.g., -30° or +30°). Thus, based on the actual distance and the sign of the first normal angle, two possible coordinates (first candidate coordinates, second candidate coordinates) for other millimeter-wave radars are calculated.
[0081] The current millimeter-wave radar acquires object measurement information, including a fourth distance between the current millimeter-wave radar and the object, and a second normal angle between the object and the normal of the current millimeter-wave radar. Based on the object measurement information and the first radar coordinates, the object's first original coordinates are calculated. Based on the first original coordinates and a third distance, second radar coordinates belonging to other millimeter-wave radars in the radar coordinate system are selected from first and second candidate coordinates. Using the two-coordinate distance calculation formula, a first candidate distance between the first candidate coordinates and the first original coordinates is calculated, as well as a second candidate distance between the second candidate coordinates and the first original coordinates. The absolute value of the difference between the first candidate distance and the third distance is used to obtain the first target distance. The absolute value of the difference between the second candidate distance and the third distance is used to obtain the second target distance. The coordinates (either the first or second candidate coordinates) with the smallest value between the first and second target distances are selected as the second radar coordinates. By verifying the object's determined position (first original coordinates) with the measured distances from other radars to the object (third distance), erroneous candidate coordinates can be accurately eliminated, avoiding errors in the calculation of the relative positional relationship of millimeter-wave radars due to coordinate ambiguity. At the same time, the unique and accurate second radar coordinates ensure that the positional relationship between other millimeter-wave radars and the current millimeter-wave radar is clear, providing a reliable coordinate reference for subsequent second movement trajectory fitting and the calculation of the angle between the normals of the two millimeter-wave radars. Ultimately, this improves the accuracy of the entire radar network self-calibration and ensures the consistency of collaborative work among networked radars.
[0082] Step 102: When other millimeter-wave radars receive the recording signal, they measure the second movement information of the object and measure the second original coordinates of the object based on the second movement information and the second radar coordinates of other millimeter-wave radars.
[0083] In this embodiment, the recording signal is the synchronization trigger signal emitted by the current millimeter-wave radar, ensuring that other millimeter-wave radars measure the state of the same moving object at the same time as the current millimeter-wave radar, thus guaranteeing data temporal consistency. When other millimeter-wave radars receive the recording signal, they measure the second movement information of the object using the same method as in step 101, i.e., other millimeter-wave radars transmit a ToF measurement signal to the object. The final obtained second movement information includes the distance between the other millimeter-wave radars and the object, as well as the angle between the ToF measurement signal reflected from the object and the normal of the other millimeter-wave radars. Based on the accurate second radar coordinates of the other radars and the measured second movement information, the calculated second original coordinates in the radar coordinate system possess data objectivity, providing high-quality data for the subsequent straight-line fitting of the second movement trajectory, and providing data support for the subsequent calculation of the radar angle between the current millimeter-wave radar and other millimeter-wave radars, improving the accuracy of the radar angle calculation and ensuring the reliability of the entire radar network self-calibration results.
[0084] Step 103: The current millimeter-wave radar fits a first moving trajectory belonging to a straight line to the object based on the first original coordinates, and sends the first moving angle formed by the first moving trajectory and the normal of the current millimeter-wave radar to other millimeter-wave radars.
[0085] In this embodiment, the first original coordinates are discrete position data measured by the current millimeter-wave radar of the moving object. A single first original coordinate cannot reflect the overall movement trend of the object. By fitting multiple discrete first original coordinates into a first movement trajectory that belongs to a straight line, the discrete position information can be transformed into a continuous trajectory with a clear directional attribute. It can also filter out the random errors that may exist in the measurement of a single first original coordinate, highlight the true direction of the object's movement, and make the subsequent calculation of the first movement angle more accurate and stable.
[0086] Specifically, first original coordinates are arranged in chronological order to obtain first object coordinates; a first window is added to the first object coordinates; during the sliding process of the first window, a first dispersion degree is calculated for the first object coordinates within the first window; a first movement trajectory belonging to a straight line is fitted for the object according to the first object coordinates with the minimum first dispersion degree. The first original coordinates may have outliers due to the influence of millimeter-wave radar measurement noise (such as distance measurement error and angle jitter of the millimeter-wave radar) and environmental interference (such as multipath reflection). Directly fitting the first original coordinates will cause the first movement trajectory to deviate from the real straight line, thereby leading to a subsequent calculation error of the first movement included angle. The reason for sorting the first original coordinates by time is that the movement of the object has temporal continuity, and the time correlation of the first original coordinates is a relatively important attribute in the movement trajectory of the object; adding the sliding window is to focus on local continuous coordinates and avoid the interference of outliers during global fitting; calculating the dispersion degree and selecting the minimum one essentially screens out the coordinate subset with the most stable measurement and the least noise, and the first movement trajectory fitted by this subset can be maximally close to the actual linear motion state of the object, laying a data foundation for the subsequent accurate calculation of the first movement included angle, and ensuring the reliability of radar network calibration.
[0087] The calculation of the dispersion degree can usually be realized through indicators such as variance, standard deviation, and mean absolute deviation.
[0088] As an example, the variance indicator is used as the dispersion degree of the window as follows:
[0089] According to the preset window size n (n<<m), where m is the number of the first original coordinates, n consecutive first object coordinates are selected from the first object coordinate set Sm recorded in chronological order, and the variance is calculated:
[0090] Starting from the 0th first object coordinate, the variance of the 0th to (n-1)th first object coordinates is calculated.
[0091] Starting from the 1st first object coordinate, the variance of the 1st to (n-1)+1th first object coordinates is calculated.
[0092] ……
[0093] Starting from the (m-n)th first object coordinate, the variance of the (m-n)th to (m-1)th first object coordinates is calculated;
[0094] A group of first object coordinates with the smallest variance is selected therefrom as fitting data; and a first movement trajectory belonging to a straight line is fitted to the fitting data by using the least square method.
[0095] Step 104: Other millimeter-wave radars fit a second movement trajectory belonging to a straight line for the object according to second original coordinates, and send a second movement included angle formed by the second movement trajectory and the normal line of the other millimeter-wave radar to the current millimeter-wave radar.
[0096] In this embodiment, the second original coordinates are discrete position data measured by other millimeter-wave radars of the moving object. Fitting the second original coordinates to a straight-line second moving trajectory can transform the discrete position information into a second moving trajectory with a clear directional attribute, providing a stable directional reference for calculating the second moving angle.
[0097] Specifically, the second object coordinates are obtained by arranging the second original coordinates in chronological order; a second window is added to the second object coordinates; during the sliding of the second window, the second degree of dispersion of the second object coordinates within the second window is calculated; and a second linear trajectory is fitted to the object based on the second object coordinates with the smallest second degree of dispersion. Using the same moving object as a natural calibration reference replaces the traditional method of manually setting calibration targets. The object's trajectory is objectively unique, and all coordinates (first radar coordinates, second radar coordinates, first original coordinates, and second original coordinates) are unified in the current millimeter-wave radar coordinate system, eliminating the problem of data incomparability under different reference coordinate systems and providing a reliable data foundation of the same source and dimension for subsequent radar angle calculations.
[0098] Step 105: The current millimeter-wave radar calculates the radar angle formed by the normal of the current millimeter-wave radar and the normal of other millimeter-wave radars based on the first and second moving angles.
[0099] In this embodiment, the accurate operation of the radar network relies on clearly defining the relative positions and attitudes of each millimeter-wave radar. The normal angle is a parameter reflecting the relative attitude relationship between two millimeter-wave radars, affecting the correlation accuracy of different millimeter-wave radars when observing data. Both the first and second moving angles are obtained based on a unified radar coordinate system and the same moving object. The difference between the first and second moving angles is essentially a direct mapping of the relative relationship of the normal directions of the two millimeter-wave radars, without the need for complex coordinate transformations or indirect derivation through multi-sensor fusion. This minimizes the error introduced by intermediate links. The calculation of the radar angle is an automated process that does not require manual intervention, reducing objective errors caused by human intervention and improving the accuracy of radar network self-calibration.
[0100] This embodiment incorporates multiple error control mechanisms. For example, by using a sliding window to filter the coordinates with the least dispersion to fit the first and second moving trajectories, abnormal data caused by millimeter-wave radar measurement noise is eliminated. Through steps such as pre-clock synchronization (calculating the first and second errors) and selection of anti-interference frequency points (target frequency points), the synchronization and stability of data acquisition are ensured, further supporting the accuracy of radar angle calculation. Ultimately, high-precision calibration of the relative attitude (radar angle) between millimeter-wave radars is achieved, improving the accuracy of the collaborative work of the entire radar network.
[0101] Specifically, the current millimeter-wave radar calculates the difference between the first and second moving angles as the moving deviation angle; the current millimeter-wave radar restricts the moving deviation angle to the range of straight angles to obtain the initial angle; the current millimeter-wave radar takes the absolute value of the initial angle to obtain the radar angle formed by the normal of the current millimeter-wave radar and the normal of other millimeter-wave radars.
[0102] The radar angle can be calculated using the following formula:
[0103]
[0104] in, The radar angle, The first included angle of movement, This is the second included angle of movement.
[0105] For example, such as Figure 5 The diagram illustrates the calculation of radar angles based on the trajectory. Device A represents the current millimeter-wave radar, and its normal is present. Device B represents other millimeter-wave radars, and its normal is present. The motion trajectory represents the object's movement, containing multiple first and second original coordinates. The fitted line represents the first and second moving trajectories. Since both trajectories are acquired within the same radar coordinate system, and the dispersion is calculated using a window, the error between the fitted first and second trajectories is very small (approximately coinciding). Figure 5 Only one fitted line is shown; The first moving angle is the angle between the current millimeter-wave radar's device A normal and the fitted line; The second moving angle is the angle between the device B normal and the fitted line of other millimeter-wave radars; The radar angle is obtained by calculating the difference between the first and second moving angles, which is used as the moving deviation angle. The moving deviation angle is then limited to the range of straight angles to obtain the initial angle, and the absolute value of the initial angle is taken.
[0106] Step 106: Other millimeter-wave radars calculate the radar angle formed by the normal of the current millimeter-wave radar and the normal of other millimeter-wave radars based on the first and second moving angles.
[0107] In this embodiment, when other millimeter-wave radars receive the first moving angle sent by the current millimeter-wave radar, they determine the spatial attitude relationship between the current millimeter-wave radar and other millimeter-wave radars by combining the second moving angle calculated by themselves (i.e., they calculate the radar angle between the normals of the two millimeter-wave radars), thereby achieving calibration between the two millimeter-wave radars.
[0108] Specifically, other millimeter-wave radars calculate the difference between the first and second moving angles as the moving deviation angle; other millimeter-wave radars limit the moving deviation angle to the range of straight angles to obtain the initial angle; other millimeter-wave radars take the absolute value of the initial angle to obtain the radar angle formed by the normal of the current millimeter-wave radar and the normal of other millimeter-wave radars.
[0109] In one embodiment of the present invention, if the current millimeter-wave radar has completed the calculation of the radar angle with one of the other millimeter-wave radars, then the process returns to sequentially execute S1, whereby the current millimeter-wave radar determines one of the other millimeter-wave radars for calibration; S2, whereby the clock errors of the current millimeter-wave radar and the other millimeter-wave radars are determined; S3, whereby the second radar coordinates of the other millimeter-wave radars in the radar coordinate system are calculated; steps 101-106; until all the other millimeter-wave radars have completed the calculation of the radar angle with the current millimeter-wave radar, thus completing the self-calibration process of the radar network.
[0110] This embodiment can be applied to human detection in large warehouses for theft prevention and fire emergency warnings. This scenario has two main characteristics: First, the coverage area is large, exceeding the capacity of a single millimeter-wave radar, requiring the coordinated operation of multiple millimeter-wave radars. Second, the warehouse layout may change, necessitating adjustments to the installation positions of the millimeter-wave radars. After the layout changes, simply re-triggering the automatic calibration process (e.g., executing S1-S3, followed by steps 101-106) re-acquires the spatial attitude of each millimeter-wave radar in the radar coordinate system. Furthermore, the millimeter-wave radars can be directly installed on warehouse shelves, moving with the shelves. During shelf movement, recalibration of the millimeter-wave radars is unnecessary; simply performing the radar network self-calibration allows continued warehouse monitoring.
[0111] In this embodiment of the invention, the radar network includes multiple millimeter-wave radars. An object moves among the multiple millimeter-wave radars. The radar coordinate system of the current millimeter-wave radar serves as the reference for calibrating other millimeter-wave radars. The current millimeter-wave radar measures first movement information of the object and sends a recording signal to the other millimeter-wave radars. Based on the first movement information and the first radar coordinates of the current millimeter-wave radar, it measures the first original coordinates of the object. When the other millimeter-wave radars receive the recording signal, they measure second movement information of the object and measure the second original coordinates of the object based on the second movement information and the second radar coordinates of the other millimeter-wave radars. The current millimeter-wave radar fits a linear coordinate system of the object based on the first original coordinates. The first moving trajectory of the line is sent to other millimeter-wave radars, and the first moving angle formed by the first moving trajectory and the normal of the current millimeter-wave radar is sent to the other millimeter-wave radars. The other millimeter-wave radars fit a second moving trajectory belonging to a straight line to the object based on the second original coordinates, and send the second moving angle formed by the second moving trajectory and the normal of the other millimeter-wave radars to the current millimeter-wave radar. The current millimeter-wave radar calculates the radar angle formed by the normal of the current millimeter-wave radar and the normal of the other millimeter-wave radars based on the first moving angle and the second moving angle. The other millimeter-wave radars calculate the radar angle formed by the normal of the current millimeter-wave radar and the normal of the other millimeter-wave radars based on the first moving angle and the second moving angle. This embodiment determines the spatial attitude of two millimeter-wave radars using a first and a second moving angle. Both the first and second moving angles are obtained based on a unified radar coordinate system and the same moving object, avoiding calibration deviations caused by inconsistent references and ensuring the usability of the first and second moving angles in the same dimension and from the same source. The difference between the first and second moving angles directly maps the relative relationship of the normal directions of the two millimeter-wave radars in the radar coordinate system, eliminating the need for complex coordinate transformations or indirect derivation through multi-sensor fusion, minimizing errors introduced by intermediate steps, and improving calibration accuracy. The entire process of calculating the radar angles is automated. In the radar network, one millimeter-wave radar is selected as the reference. By setting the same reference object and based on the signal transmission and reception characteristics of the millimeter-wave radar itself, the entire process requires no manual intervention, completing the self-calibration between the two radars, reducing objective errors caused by human intervention, and improving the accuracy of radar network self-calibration.
[0112] Example 2
[0113] Figure 6 This is a schematic diagram of a self-calibration device for a radar network according to Embodiment 2 of the present invention. The radar network includes multiple millimeter-wave radars. An object moves between the multiple millimeter-wave radars. The radar coordinate system of the current millimeter-wave radar serves as the reference for calibrating the other millimeter-wave radars. Figure 6 As shown, the device includes:
[0114] The first original coordinate measurement module 601 is located in the current millimeter-wave radar and is used to measure the first movement information of the object, send a recording signal to other millimeter-wave radars, and measure the first original coordinates of the object based on the first movement information and the first radar coordinates of the current millimeter-wave radar.
[0115] The second original coordinate measurement module 602, located in the other millimeter-wave radar, is used to measure second movement information of the object when the recording signal is received, and to measure the second original coordinates of the object based on the second movement information and the second radar coordinates of the other millimeter-wave radars;
[0116] The first movement trajectory fitting module 603, located in the current millimeter-wave radar, is used to fit a first movement trajectory belonging to a straight line to the object based on the first original coordinates, and send the first movement angle formed by the first movement trajectory and the normal of the current millimeter-wave radar to other millimeter-wave radars.
[0117] The second movement trajectory fitting module 604, located in the other millimeter-wave radar, is used to fit a second movement trajectory belonging to a straight line to the object based on the second original coordinates, and send the second movement angle formed by the second movement trajectory and the normal of the other millimeter-wave radar to the current millimeter-wave radar.
[0118] The first radar angle calculation module 605 is located in the current millimeter-wave radar and is used to calculate the radar angle formed by the normal of the current millimeter-wave radar and the normal of other millimeter-wave radars based on the first moving angle and the second moving angle.
[0119] The second radar angle calculation module 606, located in the other millimeter-wave radar, is used to calculate the radar angle formed by the normal of the current millimeter-wave radar and the normal of the other millimeter-wave radar based on the first moving angle and the second moving angle.
[0120] In one embodiment of the present invention, the first movement trajectory fitting module 603 includes:
[0121] The first object coordinate sorting module is used to arrange the first original coordinates in chronological order to obtain the first object coordinates.
[0122] The first window addition module is used to add a first window to the coordinates of the first object.
[0123] The first discreteness calculation module is used to calculate the first discreteness of the coordinates of the first object in the first window during the sliding process of the first window;
[0124] The first movement trajectory construction module is used to fit a first movement trajectory belonging to a straight line to the object based on the first object coordinates with the smallest degree of dispersion.
[0125] The second movement trajectory fitting module 604 includes:
[0126] The second object coordinate sorting module is used to arrange the second original coordinates in chronological order to obtain the second object coordinates.
[0127] The second window addition module is used to add a second window to the coordinates of the second object.
[0128] The second discreteness calculation module is used to calculate the second discreteness of the coordinates of the second object within the second window during the sliding process of the second window;
[0129] The second movement trajectory construction module is used to fit a second movement trajectory belonging to a straight line to the object based on the second object coordinates with the smallest degree of dispersion.
[0130] In one embodiment of the present invention, the first radar angle calculation module 605 includes:
[0131] The first movement deviation angle calculation module is used to calculate the difference between the first movement angle and the second movement angle, as the movement deviation angle;
[0132] The first initial included angle calculation module is used to limit the movement deviation angle within the range of a straight angle to obtain the initial included angle;
[0133] The first radar angle conversion module is used to take the absolute value of the initial angle to obtain the radar angle formed by the normal of the current millimeter-wave radar and the normal of other millimeter-wave radars.
[0134] In one embodiment of the present invention, the second radar angle calculation module 606 includes:
[0135] The second movement deviation angle calculation module is used to calculate the difference between the first movement angle and the second movement angle, as the movement deviation angle;
[0136] The second initial included angle calculation module is used to limit the movement deviation angle within the range of a straight angle to obtain the initial included angle;
[0137] The second radar angle conversion module is used to take the absolute value of the initial angle to obtain the radar angle formed by the normal of the current millimeter-wave radar and the normal of other millimeter-wave radars.
[0138] In one embodiment of the present invention, the device further includes:
[0139] The radio frequency signal information acquisition module, located in the millimeter-wave radar, is used to monitor the radio frequency signal information of channels corresponding to multiple preset frequency points; the radio frequency signal information includes co-frequency interference information and harmonic interference information;
[0140] An anti-interference strength calculation module, located in the millimeter-wave radar, is used to calculate the anti-interference strength of the channel based on the radio frequency signal information.
[0141] The target frequency point determination module, located in the current millimeter-wave radar, is used to select the frequency point corresponding to the channel with the strongest anti-interference strength as the target frequency point for communication between the current millimeter-wave radar and other millimeter-wave radars.
[0142] A start signal transmission module, located on the current millimeter-wave radar, is used to transmit a start signal to other millimeter-wave radars based on the target frequency; the start signal is accompanied by a first identifier;
[0143] A response signal transmitting module, located in the other millimeter-wave radar, is used to record the first identifier when a start signal is received, and to send a response signal to the current millimeter-wave radar whose identifier is the first identifier; the response signal is accompanied by a second identifier;
[0144] A calibration signal transmission module, located in the current millimeter-wave radar, is used to select the second identifier in one of the activation signals as a target identifier when the response signal is received, and to transmit the calibration signal to other millimeter-wave radars; the calibration signal is accompanied by the target identifier;
[0145] The confirmation signal transmission module, located in the other millimeter-wave radar, is used to send a confirmation signal to the current millimeter-wave radar when it receives a calibration signal and the second identifier matches the target identifier, and to set its own working state to the state of waiting for calibration.
[0146] The working status setting module, located in the current millimeter-wave radar, is used to set the working status to a state to be calibrated when a confirmation signal is received, so as to perform calibration work with other millimeter-wave radars whose working status is to be calibrated.
[0147] In one embodiment of the present invention, the device further includes:
[0148] The first synchronization pulse transmission module is located in the current millimeter-wave radar and is used to send a first synchronization pulse with a duration of a first value to the other millimeter-wave radars when the current millimeter-wave radar and the other millimeter-wave radars are in a state of waiting for calibration.
[0149] The second value acquisition module, located in the other millimeter-wave radar, is used to measure the duration of the first synchronization pulse when the first synchronization pulse is received, and record it as the second value.
[0150] The first error calculation module, located in the other millimeter-wave radar, is used to query the first value agreed upon for the first synchronization pulse, and divide the difference between the second value and the first value by the first value to obtain the first error on the clock.
[0151] The second synchronization pulse transmission module is located in the other millimeter-wave radar and is used to send a second synchronization pulse with a duration of the first value to the current millimeter-wave radar.
[0152] The third value acquisition module, located in the millimeter-wave radar, is used to measure the duration of the second synchronization pulse when the second synchronization pulse is received, and record it as the third value.
[0153] The second error calculation module, located in the millimeter-wave radar, is used to query the first value agreed upon for the second synchronization pulse, and divide the difference between the third value and the first value by the first value to obtain the second error on the clock.
[0154] In one embodiment of the present invention, the device further includes:
[0155] The first measurement signal transmission module, located in the current millimeter-wave radar, is used to record the first timestamp of the first measurement signal being transmitted when transmitting the first measurement signal to other millimeter-wave radars.
[0156] The second measurement signal transmission module, located in the other millimeter-wave radar, is used to record a second timestamp of receiving the first measurement signal when receiving the first measurement signal, to transmit the second measurement signal to the current millimeter-wave radar within a preset time range, and to record a third timestamp of transmitting the second measurement signal.
[0157] The time angle recording module, located in the current millimeter-wave radar, is used to record a fourth timestamp of receiving the second measurement signal and to record the first normal angle formed by the second measurement signal and the normal of the current millimeter-wave radar when the second measurement signal is received.
[0158] A first data signal transmission module, located at the current millimeter-wave radar, is used to transmit a first data signal to other millimeter-wave radars; the first data signal includes a first difference between the fourth timestamp and the first timestamp.
[0159] The second data signal transmission module, located in the other millimeter-wave radar, is used to, upon receiving the first data signal, calculate the first distance between the current millimeter-wave radar and the other millimeter-wave radars based on the first error, and transmit the second data signal to the current millimeter-wave radar; the second data signal includes a second difference between the third timestamp and the second timestamp, the first distance, and a third distance between the other millimeter-wave radars and the object.
[0160] The actual distance calculation module, located in the current millimeter-wave radar, is used to calculate the second distance between the current millimeter-wave radar and other millimeter-wave radars based on the second error when the second data signal is received, and to fuse the first distance and the second distance into the actual distance between the current millimeter-wave radar and other millimeter-wave radars.
[0161] The second radar coordinate calculation module, located in the current millimeter-wave radar, is used to calculate the second radar coordinates of other millimeter-wave radars based on the third distance, the actual distance, and the angle between the first normal and the second radar coordinates, and then send the second radar coordinates to the other millimeter-wave radars.
[0162] In one embodiment of the present invention, the second data signal transmitting module includes:
[0163] The first time multiplication calculation module is used to calculate the product between the second difference and the first error to obtain the first time multiplication value;
[0164] The first signal round-trip time calculation module is used to calculate the difference between the first difference and the first time multiplication value to obtain the first signal round-trip time;
[0165] The first distance calculation module is used to take half of the product between the round-trip time of the first signal and the speed of light to obtain the first distance between the current millimeter-wave radar and other millimeter-wave radars.
[0166] The actual distance calculation module includes:
[0167] The second time multiplication calculation module is used to calculate the product between the first difference and the second error to obtain the second time multiplication value.
[0168] The second signal round-trip time calculation module is used to calculate the difference between the second time multiplier and the second difference to obtain the second signal round-trip time;
[0169] The second distance calculation module is used to take half of the product between the round-trip time of the second signal and the speed of light to obtain the second distance between the current millimeter-wave radar and other millimeter-wave radars.
[0170] In one embodiment of the present invention, the second radar coordinate calculation module includes:
[0171] The first candidate coordinate X-value calculation module is used to add the X-value of the first radar coordinate of the current millimeter-wave radar to the product between the actual distance and the first cosine value, as the X-value of the first candidate coordinate of the other millimeter-wave radars; the first cosine value is the cosine value of the first normal angle.
[0172] The first candidate coordinate Y-value calculation module is used to add the Y-value of the first radar coordinate to the product between the actual distance and the first sine value, as the Y-value of the first candidate coordinate of the other millimeter-wave radar; the first sine value is the sine value of the first normal angle.
[0173] The second candidate coordinate X-value calculation module is used to add the X-value of the first radar coordinate to the product of the actual distance and the second cosine value, as the X-value of the second candidate coordinate of the other millimeter-wave radar; the second cosine value is the cosine value after taking the negative of the first normal angle;
[0174] The second candidate coordinate Y-value calculation module is used to add the Y-value of the first radar coordinate to the product between the actual distance and the second sine value, as the Y-value of the second candidate coordinate of the other millimeter-wave radar; the second sine value is the sine value after taking the negative of the first normal angle;
[0175] The object coordinate calculation module is used to calculate the first original coordinates of the object based on the object measurement information and the first radar coordinates; the object measurement information includes the fourth distance between the current millimeter-wave radar and the object, and the second normal angle between the object and the normal of the current millimeter-wave radar;
[0176] The second radar coordinate filtering module is used to filter out second radar coordinates belonging to other millimeter-wave radars from the first candidate coordinates and the second candidate coordinates based on the first original coordinates and the third distance.
[0177] The self-calibration device for radar networking provided in this embodiment of the invention can execute the self-calibration method for radar networking provided in any embodiment of the invention, and has the corresponding functional modules and beneficial effects for executing the self-calibration method for radar networking.
[0178] Example 3
[0179] See Figure 7This diagram illustrates a structural schematic of a computer device according to an embodiment of the present invention. The term "computer device" is intended to represent various forms of digital computers, such as laptop computers, desktop computers, workstations, personal digital assistants, blade servers, mainframe computers, and other suitable computers. The computer device can also represent various forms of mobile devices, such as personal digital processors, cellular phones, smartphones, wearable devices (e.g., helmets, glasses, watches, etc.), and other similar computing devices. The components shown herein, their connections and relationships, and their functions are merely illustrative and are not intended to limit the implementation of the invention described and / or claimed herein.
[0180] like Figure 7 As shown, the computer device 10 includes at least one processor 11 and a memory, such as a read-only memory (ROM) 12 or a random access memory (RAM) 13, communicatively connected to the at least one processor 11. The memory stores computer programs executable by the at least one processor. The processor 11 can perform various appropriate actions and processes based on the computer programs stored in the ROM 12 or loaded from storage unit 18 into the RAM 13. The RAM 13 may also store various programs and data required for the operation of the computer device 10. The processor 11, ROM 12, and RAM 13 are interconnected via a bus 14. An input / output (I / O) interface 15 is also connected to the bus 14.
[0181] Multiple components in computer device 10 are connected to I / O interface 15, including: input unit 16, such as keyboard, mouse, etc.; output unit 17, such as various types of monitors, speakers, etc.; storage unit 18, such as disk, optical disk, etc.; and communication unit 19, such as network card, modem, wireless transceiver, etc. Communication unit 19 allows computer device 10 to exchange information / data with other devices through computer networks such as the Internet and / or various telecommunications networks.
[0182] Processor 11 can be a variety of general-purpose and / or special-purpose processing components with processing and computing capabilities. Some examples of processor 11 include, but are not limited to, a central processing unit (CPU), a graphics processing unit (GPU), various special-purpose artificial intelligence (AI) computing chips, various processors running machine learning model algorithms, a digital signal processor (DSP), and any suitable processor, controller, microcontroller, etc. Processor 11 performs the various methods and processes described above, such as the self-calibration method for radar networking.
[0183] In some embodiments, the self-calibration method for radar networking can be implemented as a computer program tangibly contained in a computer-readable storage medium, such as storage unit 18. In some embodiments, part or all of the computer program can be loaded and / or installed on computer device 10 via ROM 12 and / or communication unit 19. When the computer program is loaded into RAM 13 and executed by processor 11, one or more steps of the self-calibration method for radar networking described above can be performed. Alternatively, in other embodiments, processor 11 can be configured to perform the self-calibration method for radar networking by any other suitable means (e.g., by means of firmware).
[0184] Various embodiments of the systems and techniques described above herein can be implemented in digital electronic circuit systems, integrated circuit systems, field-programmable gate arrays (FPGAs), application-specific integrated circuits (ASICs), application-specific standard products (ASSPs), systems-on-a-chip (SoCs), payload-programmable logic devices (CPLDs), computer hardware, firmware, software, and / or combinations thereof. These various embodiments may include implementations in one or more computer programs that can be executed and / or interpreted on a programmable system including at least one programmable processor, which may be a dedicated or general-purpose programmable processor, capable of receiving data and instructions from a storage system, at least one input device, and at least one output device, and transmitting data and instructions to the storage system, the at least one input device, and the at least one output device.
[0185] Computer programs used to implement the methods of the present invention may be written in any combination of one or more programming languages. These computer programs may be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, such that when executed by the processor, the computer programs cause the functions / operations specified in the flowcharts and / or block diagrams to be performed. The computer programs may be executed entirely on a machine, partially on a machine, or as a standalone software package, partially on a machine and partially on a remote machine, or entirely on a remote machine or server.
[0186] In the context of this invention, a computer-readable storage medium can be a tangible medium that may contain or store a computer program for use by or in conjunction with an instruction execution system, apparatus, or device. A computer-readable storage medium may include, but is not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, apparatus, or devices, or any suitable combination thereof. Alternatively, a computer-readable storage medium may be a machine-readable signal medium. More specific examples of machine-readable storage media include electrical connections based on one or more wires, portable computer disks, hard disks, random access memory (RAM), read-only memory (ROM), erasable programmable read-only memory (EPROM or flash memory), optical fibers, portable compact disk read-only memory (CD-ROM), optical storage devices, magnetic storage devices, or any suitable combination thereof.
[0187] To provide interaction with a user, the systems and techniques described herein can be implemented on a computer device having: a display device for displaying information to the user (e.g., a CRT (cathode ray tube) or LCD (liquid crystal display) monitor); and a keyboard and pointing device (e.g., a mouse or trackball) through which the user provides input to the computer device. Other types of devices can also be used to provide interaction with the user; for example, feedback provided to the user can be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and input from the user can be received in any form (including sound input, voice input, or tactile input).
[0188] The systems and technologies described herein can be implemented in computing systems that include backend components (e.g., as data servers), or middleware components (e.g., application servers), or frontend components (e.g., user computers with graphical user interfaces or web browsers through which users can interact with implementations of the systems and technologies described herein), or any combination of such backend, middleware, or frontend components. The components of the system can be interconnected via digital data communication of any form or medium (e.g., communication networks). Examples of communication networks include local area networks (LANs), wide area networks (WANs), blockchain networks, and the Internet.
[0189] A computing system can include clients and servers. Clients and servers are generally located far apart and typically interact through communication networks. The client-server relationship is created by computer programs running on the respective computers and having a client-server relationship with each other. The server can be a cloud server, also known as a cloud computing server or cloud host, which is a hosting product within the cloud computing service system to address the shortcomings of traditional physical hosts and VPS services, such as high management difficulty and weak business scalability.
[0190] Example 4
[0191] This invention also provides a computer program product, which includes a computer program that, when executed by a processor, implements the self-calibration method for radar networking as provided in any embodiment of this invention.
[0192] In implementing the computer program product, computer program code for performing the operations of this invention can be written in one or more programming languages or a combination thereof. Programming languages include object-oriented programming languages such as Java, Smalltalk, and C++, as well as conventional procedural programming languages such as C or similar languages. The program code can be executed entirely on the user's computer, partially on the user's computer, as a standalone software package, partially on the user's computer and partially on a remote computer, or entirely on a remote computer or server. In cases involving remote computers, the remote computer can be connected to the user's computer via any type of network—including a local area network (LAN) or a wide area network (WAN)—or can be connected to an external computer (e.g., via the Internet using an Internet service provider).
[0193] It should be understood that the various forms of processes shown above can be used, with steps reordered, added, or deleted. For example, the steps described in this invention can be executed in parallel, sequentially, or in different orders, as long as the desired result of the technical solution of this invention can be achieved, and this is not limited herein.
[0194] The specific embodiments described above do not constitute a limitation on the scope of protection of this invention. Those skilled in the art should understand that various modifications, combinations, sub-combinations, and substitutions can be made according to design requirements and other factors. Any modifications, equivalent substitutions, and improvements made within the spirit and principles of this invention should be included within the scope of protection of this invention.
Claims
1. A self-calibration method for radar networking, characterized in that, The radar network includes multiple millimeter-wave radars. An object moves between the multiple millimeter-wave radars. The radar coordinate system of the current millimeter-wave radar serves as the reference for calibrating the other millimeter-wave radars. The method includes: The millimeter-wave radar described above determines one of the other millimeter-wave radars for calibration. The millimeter-wave radar measures first movement information of the object, sends a recording signal to one of the other millimeter-wave radars, and measures the first original coordinates of the object based on the first movement information and the first radar coordinates of the current millimeter-wave radar. When one of the other millimeter-wave radars receives the recording signal, it measures second movement information of the object and measures the second original coordinates of the object based on the second movement information and the second radar coordinates of the other millimeter-wave radar. The current millimeter-wave radar fits a first moving trajectory belonging to a straight line to the object based on the first original coordinates, and sends the first moving angle formed by the first moving trajectory and the normal of the current millimeter-wave radar to one of the other millimeter-wave radars; The other millimeter-wave radar fits a second moving trajectory belonging to a straight line to the object based on the second original coordinates, and sends the second moving angle formed by the second moving trajectory and the normal of the other millimeter-wave radar to the current millimeter-wave radar; The millimeter-wave radar currently calculates the radar angle formed by the normal of the current millimeter-wave radar and the normal of one of the other millimeter-wave radars based on the first moving angle and the second moving angle; The other millimeter-wave radar calculates the radar angle formed by the normal of the current millimeter-wave radar and the normal of the other millimeter-wave radar based on the first moving angle and the second moving angle.
2. The method according to claim 1, characterized in that, The fitting of a first linear trajectory to the object based on the first original coordinates includes: The coordinates of the first object are obtained by arranging the first original coordinates in chronological order. Add a first window to the coordinates of the first object; During the sliding process of the first window, the first degree of dispersion is calculated for the coordinates of the first object within the first window; Based on the first object coordinates with the smallest degree of dispersion, fit a first movement trajectory of the object that belongs to a straight line; The fitting of a second linear trajectory to the object based on the second original coordinates includes: The second object coordinates are obtained by arranging the second original coordinates in chronological order. Add a second window to the coordinates of the second object; During the sliding of the second window, the second degree of dispersion is calculated for the coordinates of the second object within the second window; Based on the second object coordinates with the smallest degree of dispersion, a second movement trajectory belonging to a straight line is fitted to the object.
3. The method according to claim 1, characterized in that, The step of calculating the radar angle formed by the normal of the current millimeter-wave radar and the normal of one of the other millimeter-wave radars based on the first and second moving angles includes: Calculate the difference between the first and second movement angles, and use it as the movement deviation angle; The movement deviation angle is limited to the range of a straight angle to obtain the initial included angle; The absolute value of the initial angle is taken to obtain the radar angle formed by the normal of the current millimeter-wave radar and the normal of one of the other millimeter-wave radars.
4. The method according to any one of claims 1-3, characterized in that, Before the millimeter-wave radar measures the first movement information of the object, the method further includes: The millimeter-wave radar currently monitors radio frequency signal information of channels corresponding to multiple preset frequency points; the radio frequency signal information includes co-frequency interference information and harmonic interference information; The millimeter-wave radar currently uses the radio frequency signal information to calculate the anti-interference strength of the channel; The millimeter-wave radar currently selects the frequency point corresponding to the channel with the highest anti-interference strength as the target frequency point for communication between the current millimeter-wave radar and one of the other millimeter-wave radars; The millimeter-wave radar, based on the target frequency, sends a start signal to one of the other millimeter-wave radars; the start signal is accompanied by a first identifier; When one of the other millimeter-wave radars receives a start signal, it records the first identifier and sends a response signal to the current millimeter-wave radar whose identifier is the first identifier; the response signal is accompanied by a second identifier. When the millimeter-wave radar receives the response signal, it selects the second identifier in the activation signal as the target identifier and sends a calibration signal to one of the other millimeter-wave radars; the calibration signal includes the target identifier. When one of the other millimeter-wave radars receives a calibration signal and the second identifier matches the target identifier, it sends a confirmation signal to the current millimeter-wave radar and sets its own working state to the state of pending calibration. When the millimeter-wave radar receives an acknowledgment signal, it sets its operating state to a state awaiting calibration, and performs calibration work with one of the other millimeter-wave radars that is also in a state awaiting calibration.
5. The method according to any one of claims 1-3, characterized in that, Before the millimeter-wave radar measures the first movement information of the object, the method further includes: When the current millimeter-wave radar and one of the other millimeter-wave radars are both in a state of pending calibration, the current millimeter-wave radar sends a first synchronization pulse with a duration of a first value to one of the other millimeter-wave radars. When one of the other millimeter-wave radars receives the first synchronization pulse, it measures the duration of the first synchronization pulse and records it as a second value. The first value agreed upon by one of the other millimeter-wave radar queries the first synchronization pulse, and the first value is divided by the first value based on the difference between the second value and the first value to obtain the first error on the clock. One of the other millimeter-wave radars sends a second synchronization pulse with a duration of the first value to the current millimeter-wave radar; When the millimeter-wave radar receives the second synchronization pulse, it measures the duration of the second synchronization pulse and records it as a third value. The millimeter-wave radar query for the first value agreed upon by the second synchronization pulse is used to divide the difference between the third value and the first value by the first value to obtain the second error on the clock.
6. The method according to claim 5, characterized in that, Before the millimeter-wave radar measures the first movement information of the object, the method further includes: When the current millimeter-wave radar sends a first measurement signal to one of the other millimeter-wave radars, a first timestamp of the first measurement signal being sent is recorded; When one of the other millimeter-wave radars receives the first measurement signal, it records a second timestamp of receiving the first measurement signal, sends a second measurement signal to the current millimeter-wave radar within a preset time range, and records a third timestamp of sending the second measurement signal. When the millimeter-wave radar receives the second measurement signal, it records the fourth timestamp of receiving the second measurement signal and the first normal angle formed by the second measurement signal and the normal of the millimeter-wave radar. The millimeter-wave radar currently transmits a first data signal to one of the other millimeter-wave radars; the first data signal includes a first difference between the fourth timestamp and the first timestamp; When one of the other millimeter-wave radars receives the first data signal, it calculates the first distance between the current millimeter-wave radar and the other millimeter-wave radar based on the first error, and sends a second data signal to the current millimeter-wave radar; the second data signal includes a second difference between the third timestamp and the second timestamp, the first distance, and a third distance between the other millimeter-wave radar and the object; When the current millimeter-wave radar receives the second data signal, it calculates the second distance between the current millimeter-wave radar and one of the other millimeter-wave radars based on the second error, and fuses the first distance and the second distance into the actual distance between the current millimeter-wave radar and one of the other millimeter-wave radars. The millimeter-wave radar calculates the second radar coordinates of one of the other millimeter-wave radars based on the third distance, the actual distance, and the angle between the first normal and the second radar coordinates, and sends the second radar coordinates to the other millimeter-wave radar.
7. The method according to claim 6, characterized in that, The calculation of the first distance between the current millimeter-wave radar and one of the other millimeter-wave radars based on the first error includes: Calculate the product between the second difference and the first error to obtain the first time multiplier; The difference between the first difference and the first time multiplication value is calculated to obtain the round-trip time of the first signal; Half of the product between the round-trip time of the first signal and the speed of light is taken to obtain the first distance between the current millimeter-wave radar and one of the other millimeter-wave radars. The calculation of the second distance between the current millimeter-wave radar and one of the other millimeter-wave radars based on the second error includes: Calculate the product between the first difference and the second error to obtain the second time multiplier; Calculate the difference between the second time multiplier and the second difference to obtain the round-trip time of the second signal; Half of the product between the round-trip time of the second signal and the speed of light is taken to obtain the second distance between the current millimeter-wave radar and one of the other millimeter-wave radars.
8. The method according to claim 6, characterized in that, The calculation of the second radar coordinates of one of the other millimeter-wave radars based on the third distance, the actual distance, and the first normal angle includes: The X value of the first radar coordinate of the current millimeter-wave radar is added to the product of the actual distance and the first cosine value, and this is used as the X value of the first candidate coordinate of one of the other millimeter-wave radars; the first cosine value is the cosine of the first normal angle. The Y value of the first radar coordinate is added to the product of the actual distance and the first sine value to obtain the Y value of the first candidate coordinate of one of the other millimeter-wave radars; the first sine value is the sine of the first normal angle. The X value of the first radar coordinate is added to the product of the actual distance and the second cosine value to obtain the X value of the second candidate coordinate of one of the other millimeter-wave radars; the second cosine value is the cosine of the first normal angle after taking the negative value. The Y value of the first radar coordinate is added to the product of the actual distance and the second sine value to obtain the Y value of the second candidate coordinate of one of the other millimeter-wave radars; the second sine value is the sine of the first normal angle after taking the negative value. The first original coordinates of the object are calculated based on the object measurement information and the first radar coordinates; the object measurement information includes the fourth distance between the current millimeter-wave radar and the object, and the second normal angle between the object and the normal of the current millimeter-wave radar. Based on the first original coordinates and the third distance, the second radar coordinates belonging to one of the other millimeter-wave radars are selected from the first candidate coordinates and the second candidate coordinates.
9. A computer device, characterized in that, The computer device includes: One or more processors; Storage device for storing one or more programs; When the one or more programs are executed by the one or more processors, the one or more processors implement the self-calibration method for radar networking as described in any one of claims 1-8.
10. A computer-readable storage medium having a computer program stored thereon, characterized in that, When executed by the processor, the program implements the self-calibration method for radar networking as described in any one of claims 1-8.
Citation Information
Patent Citations
Multi-millimeter-wave radar combined self-calibration method and system
CN111398923A
Multi-radar automatic networking method and system based on millimeter wave area security
CN111830498A
