CN116106894A - Target tracking method, device and storage medium based on 5D millimeter wave radar - Google Patents

Target tracking method, device and storage medium based on 5D millimeter wave radar Download PDF

Info

Publication number
CN116106894A
CN116106894A CN202310133062.9A CN202310133062A CN116106894A CN 116106894 A CN116106894 A CN 116106894A CN 202310133062 A CN202310133062 A CN 202310133062A CN 116106894 A CN116106894 A CN 116106894A
Authority
CN
China
Prior art keywords
target
beat signal
signal
transmitting antenna
beat
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202310133062.9A
Other languages
Chinese (zh)
Inventor
王向荣
刘恒峰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beihang University
Original Assignee
Beihang University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beihang University filed Critical Beihang University
Priority to CN202310133062.9A priority Critical patent/CN116106894A/en
Publication of CN116106894A publication Critical patent/CN116106894A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/66Radar-tracking systems; Analogous systems
    • G01S13/72Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/58Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S13/583Velocity or trajectory determination systems; Sense-of-movement determination systems using transmission of continuous unmodulated waves, amplitude-, frequency-, or phase-modulated waves and based upon the Doppler effect resulting from movement of targets
    • G01S13/584Velocity or trajectory determination systems; Sense-of-movement determination systems using transmission of continuous unmodulated waves, amplitude-, frequency-, or phase-modulated waves and based upon the Doppler effect resulting from movement of targets adapted for simultaneous range and velocity measurements
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/58Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S13/60Velocity or trajectory determination systems; Sense-of-movement determination systems wherein the transmitter and receiver are mounted on the moving object, e.g. for determining ground speed, drift angle, ground track
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/66Radar-tracking systems; Analogous systems
    • G01S13/72Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
    • G01S13/723Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/35Details of non-pulse systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/35Details of non-pulse systems
    • G01S7/352Receivers

Abstract

The application provides a target tracking method, device and storage medium based on a 5D millimeter wave radar. The millimeter wave radar comprises a millimeter wave radar which utilizes a TDM MIMO technology to perform three-transmission four-reception, the method performs signal processing on transmitting and receiving signals of the radar, so as to obtain 5D pedestrian information comprising target distance, target azimuth angle, target pitch angle information, target radial speed and target tangential speed, performs target point detection according to the 5D pedestrian information, and performs target tracking and data updating according to the 5D pedestrian information by utilizing a Kalman filtering method. The method is more perfect in acquiring the speed information, and the Kalman filtering is performed on the basis of the radial speed and the tangential speed of the target to track and update the target, so that the target track is estimated and tracked better.

Description

Target tracking method, device and storage medium based on 5D millimeter wave radar
Technical Field
The application relates to radar signal processing technology, in particular to a target tracking method, device and storage medium based on a 5D millimeter wave radar.
Background
With the rapid development of economy and the continuous improvement of the living standard of people, the conservation rate of automobiles is gradually increased, but the traffic accident event is also increased. Therefore, the demand of an Advanced Driving Assistance System (ADAS) for the safer intelligent automobile field is remarkably improved, and the ADAS can make active judgment and preventive measures before a driver finds an emergency, so that the harm caused by improper operation of the driver is reduced, and the driving safety is improved.
In an ADAS system, pedestrians who are typical disadvantaged road users are of great importance in environmental perception. The ADAS detects pedestrians by collecting data reflected by surrounding environments through sensors installed in the vehicle, so that dangerous conditions of roads are predicted, and corresponding protection measures are made. The sensors commonly used for ADAS mainly include cameras, ultrasonic radars, laser radars (Lidar), and 4D millimeter wave radars. However, the former sensors suffer from various drawbacks, in that the camera is particularly light-sensitive; the ultrasonic radar has long detection period, short maximum detection distance and large influence by temperature and environment; the laser radar has large volume, high cost, fast attenuation and extremely narrow wave beam, and can only search and capture targets in a small range. The millimeter wave radar has the characteristics of all-weather operation, no influence of light, long detection distance, high detection precision, low cost, small volume and the like, and gradually occupies an increasingly important position in the ADAS sensor.
However, the conventional 4D millimeter wave vehicle radar is weak in perception in terms of movement direction and speed information, so that it is impossible to accurately detect and track a target.
Disclosure of Invention
The application provides a target tracking method, device and storage medium based on a 5D millimeter wave radar, which are used for solving the problem that the target tracking cannot be accurately performed in the prior art.
In a first aspect, the present application provides a target tracking method based on a 5D millimeter wave radar, where the 5D millimeter wave radar includes three transmitting antennas sequentially arranged in a horizontal direction and four receiving antennas sequentially arranged in the horizontal direction, horizontal distances between two adjacent transmitting antennas are λ, vertical distances between a second transmitting antenna in a middle position and a first transmitting antenna and a second transmitting antenna are λ/2, and vertical distances between the first transmitting antenna and the second transmitting antenna are 0; the horizontal distance between two adjacent receiving antennas is lambda/2; the method comprises the following steps:
the carrier frequency f is transmitted by three transmitting antennas respectively in a time division multiplexing mode 0 FMCW signal of 77GHz (lambda=c/f 0 C is the speed of light), and obtains the received signals of four receiving antennas for each transmitting antenna, and carries out mixing processing according to the transmitted signals corresponding to the received signals to obtain beat signals S corresponding to 12 virtual array elements Bij (t); wherein i represents an ith transmitting antenna, j represents a jth receiving antenna, and i and j are positive integers;
for beat signal S B1j (t) and beat signal S B3j (t) processing by Fourier beamforming techniques, respectively, to obtain enhanced beat signals S B1 And S is B3 For the enhanced beat signal S B1 And S is B3 2D-FFT processing is carried out to obtain a target distance R and a target radial velocity v r
According to the enhanced beat signal S B1 And S is B3 Performing emission interference processing, obtaining coherent signals, and performing time-frequency analysis processing to obtain target tangential velocity v a
For beat signal S B1j (t) and beat signal S B3j (t) obtaining a target azimuth angle theta according to a sum-difference beam amplitude measurement method;
according to the array arrangement of three transmitting antennas in the vertical direction, a specific phase angle measurement method is adopted to obtain a target pitch angle
Figure BDA0004087456980000021
According to the target distance R, the azimuth angle theta and the target pitch angle information
Figure BDA0004087456980000022
Performing three-dimensionalCoordinate conversion processing is carried out to obtain a target detection point;
according to the target distance R, the azimuth angle theta and the target radial velocity v r And a target tangential velocity v a And updating the target state by adopting Kalman filtering to finish target tracking.
In one possible design, the signal S is based on an enhanced beat signal B1 And S is B3 Performing emission interference processing, obtaining coherent signals, and performing time-frequency analysis processing to obtain target tangential velocity v a Comprising:
for the enhanced beat signal S B1 And S is B3 Doppler compensation processing is carried out to obtain a compensated beat signal S B1 And S is B3
For Doppler compensated beat signal S B1 And S is B3 Performing emission interference treatment to obtain related signals;
performing FFT processing on the coherent signal to acquire tangential Doppler frequency;
obtaining a target tangential velocity v according to the tangential Doppler frequency a
In one possible design, the target radial velocity v is determined according to the target distance R, the azimuth angle θ, and the target radial velocity v r And a target tangential velocity v a The method for updating the target state by adopting Kalman filtering to complete target tracking comprises the following steps:
the state of the setting target at time k-1 is:
Figure BDA0004087456980000031
then, according to the kalman filter, the predicted value of the next time state is:
Figure BDA0004087456980000032
wherein F is k Is a state transition matrix in which is the time interval between different frame signals, v is the process noise, in which] T Is transposed toA matrix.
In one possible design, the signal S is a beat signal B1j (t) and beat signal S B3j (t) processing by Fourier beamforming techniques, respectively, to obtain enhanced beat signals S B1 And S is B3 For the enhanced beat signal S B1 And S is B3 2D-FFT processing is carried out to obtain a target distance R and a target radial velocity v r Comprising:
To beat signal S B1j (t) and beat signal S B3j (t) processing by Fourier beamforming techniques, respectively, to obtain enhanced beat signals S B1 And enhancing the beat signal S B3
For the enhanced beat signal S B1 And enhancing the beat signal S B3 Performing fast time FFT processing, obtaining a fast time Fourier signal, obtaining an intermediate frequency related to a target distance from the fast time Fourier signal, and obtaining the target distance according to the intermediate frequency;
performing slow time FFT processing on the fast time Fourier signal to obtain a slow time Fourier signal, obtaining radial Doppler frequency shift according to the slow time Fourier signal, and obtaining a target radial velocity v according to the Doppler frequency shift r
In one possible embodiment, the signal S is a beat signal B1j (t) and beat signal S B3j (t) obtaining a target azimuth angle θ according to a sum-difference beam amplitude mapping method, including:
constructing auxiliary beams for 8 virtual array elements corresponding to the first transmitting antenna and the third transmitting antenna, setting DBF coefficients, constructing a group of auxiliary beams to form 7 groups of auxiliary beams, and acquiring an angle discrimination curve according to the auxiliary beams;
to beat signal S B1j (t) and beat signal S B3j (t) performing Doppler compensation processing after performing 2D-CFAR to obtain a compensated beat signal S B1j (t) and beat signal S B3j (t);
Will compensate the beat signal S B1j (t) and beat signal S B3j (t) multiplying the DBF coefficient and extracting the maximum value and its subscript Idx, obtaining a measuring angle range of which the target direction is in an Idx group auxiliary beam;
and obtaining a target azimuth angle theta by using a table look-up method according to the measurement angle range and the angle discrimination curve. In one possible design, the DBF coefficient dbfCoff is calculated by the following formula:
dbfCoff=exp{-j2π(n-1)dSinθ dbf /λ}
where n=1, …,8, where the beam orientations θ of the 7 sets of auxiliary beams are set dbf Two are two by two, respectively: (-45.5 °, -32.5 °), (-32.5 °, -19.5 °), (-19.5 °, -6.5 °), (-6.5 °,6.5 °), (6.5 °,19.5 °), (19.5 °,32.5 °) and (32.5 °,45.5 °).
In one possible design, the target pitch angle is extracted by adopting a phase contrast angle measurement method according to the array arrangement of the three transmitting antennas in the vertical direction
Figure BDA0004087456980000041
Comprising the following steps:
performing Fourier wave beam forming technology processing on the beat signals of the 4 virtual array elements corresponding to the second transmitting antenna to obtain an enhanced beat signal S BB2
Performing Fourier beam forming on beat signals corresponding to the first transmitting antenna, the third receiving antenna, the first transmitting antenna, the fourth receiving antenna, the third transmitting antenna, the first receiving antenna and the third transmitting antenna, and the second receiving antenna to obtain an enhanced beat signal S' BB13
According to the enhanced beat signal S BB2 And enhancing the beat signal S' BB13 Is of the phase difference phi z Extracting target pitch angle
Figure BDA0004087456980000042
In a second aspect, the present application provides a target tracking device based on a 5D millimeter wave radar, where the 5D millimeter wave radar includes three transmitting antennas sequentially arranged in a horizontal direction and four receiving antennas sequentially arranged in the horizontal direction, horizontal distances between two adjacent transmitting antennas are λ, vertical distances between a second transmitting antenna in a middle position and a first transmitting antenna and a second transmitting antenna are λ/2, and vertical distances between the first transmitting antenna and the second transmitting antenna are 0; the horizontal distance between two adjacent receiving antennas is lambda/2; the apparatus comprises:
a target distance and target radial velocity acquisition module for the beat signal S B1j (t) and beat signal S B3j (t) processing by Fourier beamforming techniques, respectively, to obtain enhanced beat signals S B1 And S is B3 For the enhanced beat signal S B1 And S is B3 2D-FFT processing is carried out to obtain a target distance R and a target radial velocity v r
A target tangential velocity acquisition module for acquiring a target tangential velocity according to the enhanced beat signal S B1 And S is B3 Performing emission interference processing, obtaining coherent signals, and performing time-frequency analysis processing to obtain target tangential velocity v a
A target azimuth acquisition module for the beat signal S B1j (t) and beat signal S B3j (t) obtaining a target azimuth angle theta according to a sum-difference beam amplitude measurement method;
the target pitch angle acquisition module is used for acquiring a target pitch angle by adopting a phase contrast angle measurement method according to array arrangement of three transmitting antennas in the vertical direction
Figure BDA0004087456980000051
The target detection module is used for detecting the target distance R, the azimuth angle theta and the target pitch angle information according to the target distance R, the azimuth angle theta and the target pitch angle information
Figure BDA0004087456980000052
Performing three-dimensional coordinate conversion processing to obtain a target detection point;
a target tracking module for tracking the target radial velocity v according to the target distance R, the azimuth angle theta and the target radial velocity v r And a target tangential velocity v a And updating the target state by adopting Kalman filtering to finish target tracking.
In a third aspect, the present application provides an electronic device, comprising: a processor, and a memory communicatively coupled to the processor;
the memory stores computer-executable instructions;
and the processor executes the computer-executed instructions stored in the memory to realize a target tracking method based on the 5D millimeter wave radar.
In a fourth aspect, the present application provides a computer-readable storage medium having stored therein computer-executable instructions that, when executed by a processor, are configured to implement a 5D millimeter wave radar-based target tracking method.
The method comprises the steps of performing signal processing on transmitting and receiving signals of the radar, so as to obtain 5D pedestrian information comprising target distance, azimuth angle, target pitch angle information, target radial speed and target tangential speed, performing target point detection according to the 5D pedestrian information, and performing target tracking and data updating according to the 5D pedestrian information by using a Kalman filtering method. The following technical effects are realized:
according to the invention, two paths of enhanced beat signals can be obtained for 4 paths of beat signals respectively corresponding to the first transmitting antenna and the third transmitting antenna, so that 6dB receiving gain is realized; thereby performing emission interference and acquiring tangential velocity information; according to the invention, two paths of enhanced beat signals are obtained through a Fourier wave beam forming technology for 4 paths of beat signals corresponding to the second transmitting antenna and 4 paths of beat signals in the middle of 8 paths of beat signals corresponding to the 1 st transmitting antenna and the 3 rd transmitting antenna, so that 6dB receiving gain is realized; extracting pitch angle information from the vertical phase difference by utilizing the array arrangement relation of the 4 paths of beat signals corresponding to the second transmitting antenna and the middle 4 paths of beat signals in the vertical direction, wherein the obtained pitch angle information is more accurate; in addition, the invention adopts the method to perform emission interference and acquire tangential velocity information so that the target is more perfect in velocity information, and according to tangential velocity and other pedestrian information; and tracking and updating the target by utilizing Kalman filtering, so that the track of the target is estimated and tracked better.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions of the prior art, the following description will briefly explain the drawings used in the embodiments or the description of the prior art, and it is obvious that the drawings in the following description are some embodiments of the present invention, and other drawings can be obtained according to these drawings without inventive effort for a person skilled in the art.
Fig. 1 is a schematic flow chart of a target tracking method based on a 5D millimeter wave radar according to an embodiment of the present application;
FIG. 2A is an array layout diagram of transmit antennas in a millimeter wave radar as used in embodiments of the present application;
FIG. 2B is an array layout diagram of a receive antenna in a millimeter wave radar as used in embodiments of the present application;
fig. 3A is a schematic diagram of angular distance information in 5D pedestrian information obtained in an embodiment of the present application;
fig. 3B is a schematic diagram of velocity information in 5D pedestrian information obtained in an embodiment of the present application;
fig. 4 is an auxiliary beam acquired in an embodiment of the present application;
FIG. 5 is an angular curve obtained in an embodiment of the present application;
FIG. 6 is an array layout diagram of 12 virtual array elements according to an embodiment of the present application;
FIG. 7A is a graph of the 3-dimensional object output results when the object moves in a trajectory from back to front in an embodiment of the present application;
FIG. 7B is a graph of the 2-dimensional object output results when the object moves in a trajectory from back to front in an embodiment of the present application;
FIG. 8A is a graph of the output results of a 3-dimensional object when the object moves in a left-to-right trajectory in an embodiment of the present application;
FIG. 8B is a graph of the output results of a 2-dimensional object when the object moves in a left-to-right trajectory in an embodiment of the present application;
FIG. 9A is a graph of the 3-dimensional object output results when the object moves in a clockwise wrap trajectory in an embodiment of the present application;
FIG. 9B is a graph of the output results of a 2-dimensional object as it moves in a clockwise wrap trajectory in an embodiment of the present application;
FIG. 10A is a graph of the output results of a 3-dimensional object when the object moves along the trajectory of the W-route in an embodiment of the present application;
FIG. 10B is a graph of 2-dimensional object output results when the object moves along the trajectory of the W-route in an embodiment of the present application;
fig. 11 is a schematic structural diagram of a target tracking device based on a 5D millimeter wave radar according to an embodiment of the present application;
fig. 12 is a schematic hardware structure of an electronic device according to an embodiment of the present application.
Detailed Description
Reference will now be made in detail to exemplary embodiments, examples of which are illustrated in the accompanying drawings. When the following description refers to the accompanying drawings, the same numbers in different drawings refer to the same or similar elements, unless otherwise indicated. The implementations described in the following exemplary examples are not representative of all implementations consistent with the present application. Rather, they are merely examples of apparatus and methods consistent with some aspects of the present application, as detailed in the accompanying claims, rather than all embodiments. All other embodiments, which can be made by those skilled in the art based on the embodiments of the invention without making any inventive effort, are intended to be within the scope of the invention.
Related concepts or nouns referred to in this application are explained first:
TDM technology (Time Division, time Division multiplexing): techniques for transmitting signals in a stream at different times by multiple transmit antennas.
MIMO technology (Multiple Input Multiple Output ): radar includes multiple-input multiple-output radar transmitting technology by multiple transmitting antennas and multiple receiving antennas.
FMCW (Frequency Modulated Continuous Wave ): the FMCW technology is a technology used in high-precision radar ranging, the basic principle is that the transmitted wave is a high-frequency continuous wave, the received echo frequency is the same as the change rule of the transmitted frequency, and is a triangle wave or a sawtooth wave rule.
The method can be carried in an Advanced Driving Assistance System (ADAS) system, and a 77GHz millimeter wave radar is adopted as an ADAS sensor to detect and track a far-field target. The following describes in detail a vehicle following control method provided in an embodiment of the present application with reference to the accompanying drawings.
Fig. 1 is a schematic flow chart of a target tracking method based on a 5D millimeter wave radar according to an embodiment of the present application.
Wherein fig. 2 is an array layout diagram of antennas in a millimeter wave radar adopted in the embodiment of the present application, the millimeter wave radar adopted in the embodiment of the present application includes three transmitting antennas and four transmitting antennas, where fig. 2A is an array layout diagram of transmitting antennas in the millimeter wave radar, fig. 2B is an array layout diagram of receiving antennas in the millimeter wave radar, as in fig. 2, T1, T2 and T3 are a first transmitting antenna, a second transmitting antenna and a third transmitting antenna sequentially arranged in a horizontal direction, respectively, and R1, R2, R3 and R4 are four receiving antennas sequentially arranged at equal intervals in the horizontal direction. The millimeter wave radar comprises three transmitting antennas which are sequentially arranged in the horizontal direction and four receiving antennas which are sequentially arranged in the horizontal direction, wherein the horizontal distance between two adjacent transmitting antennas is lambda, the vertical distance between a second transmitting antenna at the middle position and the first transmitting antenna and the second transmitting antenna is lambda/2, and the vertical distance between the first transmitting antenna and the second transmitting antenna is 0; the horizontal distance between two adjacent receiving antennas is lambda/2;
the method of this embodiment uses MIMO technology, and adopts array arrangement as shown in fig. 2 to transmit carrier frequency f 0 Transmitting FMCW signals for 77GHz millimeter wave radar in a Time Division Multiplexing (TDM) mode, and performing mixing processing according to the transmitting signals corresponding to the receiving signals to obtain beat signals corresponding to 12 virtual array elements;
The beat signals corresponding to the 12 virtual array elements are processed by the method of the embodiment to obtain the signal shown in figure 3The 5D pedestrian information is shown, wherein FIG. 3 is a millimeter wave radar 5D information pedestrian according to the method of the invention, and FIG. 3A is a schematic diagram of angular distance information in the 5D pedestrian information obtained according to the embodiment of the application, including target distance R, azimuth angle θ and target pitch angle information
Figure BDA0004087456980000081
FIG. 3B is a schematic diagram of velocity information in 5D pedestrian information obtained in an embodiment of the present application, including a target radial velocity v r And a target tangential velocity v a The method comprises the steps of carrying out a first treatment on the surface of the And processing by adopting a Kalman filtering method according to the obtained 5D pedestrian information, thereby completing detection and tracking of the target.
The method is more perfect in acquiring the speed information, and the Kalman filtering is performed on the basis of the radial speed and the tangential speed of the target to track and update the target, so that the target track is estimated and tracked better.
As shown in fig. 1, the method includes:
s110, respectively transmitting carrier frequency f through three transmitting antennas by adopting a time division multiplexing mode 0 FMCW signal of 77GHz (lambda=c/f 0 C is the speed of light), and obtains the received signals of four receiving antennas for each transmitting antenna, and carries out mixing processing according to the transmitted signals corresponding to the received signals to obtain beat signals S corresponding to 12 virtual array elements Bij (t); wherein i represents an ith transmitting antenna, j represents a jth receiving antenna, and i and j are positive integers;
λ=c/f 0 c is the speed of light
Specifically, the processing method of step 110 includes:
let the transmission signal of the ith transmission antenna be T i The calculation is performed by the following formula:
Figure BDA0004087456980000091
wherein f 0 For the center frequency, K is the chirp rate, t=nt+t s ,(0≤t s T is pulse repetition period,t s Time within a single Chirp; the transmission signal of the nth Chirp is expressed as:
Figure BDA0004087456980000092
the four receiving antennas receive the echo signals reflected by the target, and the distance between the far-field target and the ith transmitting antenna and the jth receiving antenna is assumed to be R ij Radial velocity v rij Delay τ of echo signal ij The method comprises the following steps:
Figure BDA0004087456980000093
wherein c is the speed of light, R 0 For the initial distance of the target, the received signals of the four receiving antennas are recorded as R ij (t) obtained by the following formula
Figure BDA0004087456980000094
The beat signal S obtained by mixing the ith transmitting antenna and the jth receiving antenna Bij (t) is:
Figure BDA0004087456980000095
wherein the method comprises the steps of
Figure BDA0004087456980000096
Is R ij Conjugate signal of (t), f LPF {. The pass through low pass filter.
S120, for beat signal S B1j (t) and beat signal S B3j (t) processing by Fourier beamforming techniques, respectively, to obtain enhanced beat signals S B1 And S is B3 For the enhanced beat signal S B1 And S is B3 2D-FFT processing is carried out to obtain a target distance R and a target radial velocity v r
Specifically, step 120 includes the steps of:
s121, opposite beat signal S B1j (t) and beat signal S B3j (t) processing by Fourier beamforming techniques, respectively, to obtain enhanced beat signals S B1 And enhancing the beat signal S B3
Specifically, the beat signal S can be processed using Fourier beamforming techniques B1j (t) and beat signal S B3j (t) performing phase compensation, so that the phase of the four paths of received signals reaching a radar receiving end achieves the purpose of enhancing the received signals, and thereby 6dB receiving gain is realized;
in step S101, the first transmitting antenna transmits four receiving antenna echo signals:
Figure BDA0004087456980000101
wherein τ 1i =[τ 1i τ 1i0 τ 1i +2τ 0 τ 1i +3τ 0 ],
Figure BDA0004087456980000102
For the delay time caused by the arrangement of two adjacent receiving antennas, d is the base line length between the two receiving antennas, θ is the azimuth angle, +.>
Figure BDA0004087456980000105
Is pitch angle, R 1i (t) mixing with the first transmit antenna transmit signal to obtain a beat signal as:
Figure BDA0004087456980000103
the phase compensation is carried out on the 4 paths of beat signals corresponding to the first transmitting antenna by utilizing the beam forming technology, so that the signals which are strengthened after summation processing in space can be obtained:
S B1 (t)=exp{j2π[f 0 τ 11 +Kτ 11 t s ]} (8)
similarly, 4 paths of received signals corresponding to the third transmitting antenna are mixed with the transmitting signals to obtain beat signals, and fourier wave beam formation is performed to obtain enhancement signals, wherein the enhancement signals are as follows:
S B3 (t)=exp{j2π[f 0 τ 11 +Kτ 11 t s +(f 0 +Kt sD ]} (9)
Wherein the method comprises the steps of
Figure BDA0004087456980000104
D is the baseline length of the first transmit antenna and the third transmit antenna.
S122, pair-enhancing beat signal S B1 And enhancing the beat signal S B3 Performing fast time FFT processing, acquiring a fast time Fourier signal, acquiring an intermediate frequency related to the target distance from the fast time Fourier signal, and acquiring the target distance according to the intermediate frequency;
specifically, a fast time FFT process is used to solve for the target distance R, the time variable of the time FFT is t s The beat signal is subjected to fast time FFT to obtain a frequency domain signal from which an intermediate frequency can be extracted, and the obtained intermediate frequency is f IF =2KR ij And/c, obtaining the target distance R=f through formula conversion IF c/(2K)。
S123, performing slow time FFT processing on the fast time Fourier signals to obtain slow time Fourier signals, obtaining radial Doppler frequency shift according to the slow time Fourier signals, and obtaining the target radial velocity v according to the Doppler frequency shift r
Specifically, a slow time FFT process is used to solve for the target radial velocity v r For the frequency domain signal obtained in step S122, a time variable nT is set, and a slow time FFT is performed for nT to obtain a doppler shift, where the doppler shift is f r =2v r (nT)/lambda, the target radial velocity v can be obtained by formula conversion r (nT)=f r Lambda/2, wherein the velocity information is assumed to be constant for each frame of radar echo signal.
S130, according to the enhanced beat signalNumber S B1 And S is B3 Performing emission interference processing, obtaining coherent signals, and performing time-frequency analysis processing to obtain target tangential velocity v a
Specifically, step S130 includes the steps of:
s131, pair-enhanced beat signal S B1 And S is B3 Doppler compensation processing is carried out to obtain a compensated beat signal S B1 And S is B3
Specifically, the Doppler compensation process is performed by adopting a Fourier beamforming technology, wherein the compensation factor is delta, and delta= (2 phi) dop )/3=2πf dop (3T)*2/3,fd op Is the doppler frequency.
S132, the Doppler compensated beat signal S B1 And S is B3 Performing emission interference processing to obtain a coherent signal;
specifically, the coherent signal is:
Figure BDA0004087456980000111
wherein the method comprises the steps of
Figure BDA0004087456980000112
Is S B3 (t) conjugated signals.
S133, performing FFT processing on the coherent signal to obtain tangential Doppler frequency, and obtaining a target tangential velocity v according to the tangential Doppler frequency a
Wherein the coherent frequency shift caused by the angular velocity can be determined by the phase term Φ in (10) inter Obtained by the time derivative of (a), the inverse time of which is:
Figure BDA0004087456980000113
wherein the method comprises the steps of
Figure BDA0004087456980000114
Is angular velocity, and sin theta is approximately equal to 0 and cos theta is approximately equal to 0 at small angles1 the target tangential velocity +.>
Figure BDA0004087456980000115
S140, for beat signal S Blj (t) and beat signal S B3j (t) obtaining a target azimuth angle theta according to a sum-difference beam amplitude measurement method;
Specifically, S140 includes the steps of:
s141, constructing auxiliary beams for 8 virtual array elements corresponding to the first transmitting antenna and the third transmitting antenna, setting DBF coefficients, constructing one group of auxiliary beams to form 7 groups of auxiliary beams, and acquiring an angle discrimination curve according to the auxiliary beams;
wherein the DBF coefficient of the auxiliary beam is,
dbfCoff=exp{-j2π(n-1)dsinθ dbf /λ} (12)
wherein n=1,..8; θ dbf = -45.5 °:13 °:45.5 °; the beam directors of the first two auxiliary beams are set to (-45.5 °, -32.5 °), and then the beam directors of each group are shifted to the right by 13 °, so the beam directors of the 7 auxiliary beams are respectively: (-45.5 °, -32.5 °), (-32.5 °, -19.5 °), (-19.5 °, -6.5 °), (-6.5 ° ), (6.5 °,19.5 °), (19.5 °,32.5 °) and (32.5 °,45.5 °) are simultaneously formed, and an angle discrimination curve is formed, the angle measurement range of which is-52 ° to 52 °, and the resulting final formed 7 sets of auxiliary beams are shown in fig. 4, and the angle discrimination curve is shown in fig. 5.
S142 is a beat signal S B1j (t) and beat signal S B3j (t) performing Doppler compensation processing after performing 2D-CFAR to obtain a compensated beat signal S B1j (t) and beat signal S B3j (t);
Specifically, after executing 2D-CFAR, traversing in distance and doppler dimensions, extracting the maximum value of 8 virtual array element signals at each distance speed, judging whether the maximum amplitude exceeds a threshold, if so, storing the current target distance speed information, and performing doppler compensation on the virtual array element beat signals, wherein the compensation factor is delta= (2 phi) dop )/3=2πf dop (3T) x 2/3 is f dop For Doppler frequency。
S143, the compensated beat signal S B1j (t) and beat signal S B3j (t) multiplying the target direction by the DBF coefficient, and extracting the maximum value and the subscript Idx thereof to obtain a measurement angle range of which the target direction is in the Idx-th auxiliary beam;
s144, obtaining the target azimuth angle theta by using a table look-up method according to the measured angle range and the angle discrimination curve.
S150, obtaining a target pitch angle by adopting a phase contrast angle measurement method according to array arrangement of three transmitting antennas in the vertical direction
Figure BDA0004087456980000121
/>
Let the virtual array element synthesized by the ith transmitting antenna and the jth receiving antenna be VR ij According to the arrangement of the millimeter wave radar (as shown in fig. 2), the array arrangement of 12 virtual array elements is shown in fig. 6, wherein 4 virtual array elements corresponding to the first transmitting antenna and 4 virtual array elements [ VR ] among the 8 virtual array elements corresponding to the third transmitting antenna l1 VR 12 VR l3 VR l4 VR 31 VR 32 VR 33 VR 34 ]The phase difference between two adjacent virtual array elements in the horizontal direction is phi x Wherein
Figure BDA0004087456980000122
4-path virtual array element [ VR ] corresponding to second transmitting antenna 21 VR 22 VR 2a VR 24 ]4 virtual array elements [ VR ] among 8 paths of beat signals corresponding to 1 st and 3 rd transmitting antennas 13 VR 14 VR 31 VR 32 ]The phase difference phi in the vertical direction exists between every two z Wherein->
Figure BDA0004087456980000123
Here we use the phase difference in the vertical direction to solve for the pitch angle +. >
Figure BDA0004087456980000124
Specifically, step S150 may be implemented by the following steps:
s151, performing Fourier wave beam forming technology processing on the beat signals of the 4 virtual array elements corresponding to the second transmitting antenna to obtain an enhanced beat signal S BB2
S152, performing Fourier wave beam formation on the beat signals corresponding to the first transmitting antenna-third receiving antenna, the first transmitting antenna-fourth receiving antenna, the third transmitting antenna-first receiving antenna and the third transmitting antenna-second receiving antenna to obtain enhanced beat signals S' BB13
Specifically, assume that the target is at VR 11 The signal generated at the point is A 0 exp{jΦ 0 },A 0 Is the amplitude, phi 0 Is the phase. The 8 virtual array elements formed by the 1 st transmitting antenna and the 3 rd transmitting antenna can be expressed as follows by vectors:
VEC x =A 0 exp{jΦ 0 }[1 exp{jΦ x }exp{j2Φ x }...exp{j7Φ x }] (13)
the 4 virtual array elements corresponding to the second transmitting antenna can be expressed as:
VEC z =A 2 exp{j(Φ 0 +2Φ xz )}[1 exp{jΦ x }exp{j2Φ x }exp{j3Φ x }] (14)
wherein phi is z Is a vertical virtual array phase difference, in which VEC x The 3 rd to 6 th elements are VEC' x =A 0 exp{jΦ 0 }[exp{j2Φ x }exp{j3Φ x }exp{j4Φ x }exp{i5Φ x }]And VEC (vehicle) z The phase difference of the four elements is phi z
For VEC' x And VEC (video cassette) z Fourier beamforming to obtain an enhanced signal S BB2 And S' BB13 A 6dB receive gain is achieved.
S153 based on the enhanced beat signal S BB2 And enhancing the beat signal S' BB13 Is of the phase difference phi z Extracting target pitch angle
Figure BDA0004087456980000131
Specifically, by enhancing the signal S BB2 And S' BB13 Can obtain the phase difference phi z While the target pitch angle
Figure BDA0004087456980000132
The solution can be achieved by,
Figure BDA0004087456980000133
s160, according to the target distance R, the azimuth angle theta and the target pitch angle information
Figure BDA0004087456980000134
Performing three-dimensional coordinate conversion processing to obtain a target detection point;
specifically, according to the steps, 5D millimeter wave Lei Dadian cloud data of each frame of radar signals, namely target distance, target radial speed, target azimuth angle, target pitch angle and target tangential speed, can be obtained, and the 5D millimeter wave radar point cloud data of each frame can be obtained, and the target distance, the target azimuth angle and the target pitch angle are converted into (x, y, z) in three-dimensional coordinates according to the following formula and output;
Figure BDA0004087456980000135
/>
then, a centroid algorithm is executed on each dimension information in the 5D millimeter wave Lei Dadian cloud data of each frame of radar signal, and each dimension information after the centroid algorithm is executed is used as 5D point cloud data of a target at a track point of a current frame and is converted into three-dimensional coordinates (x, y, z) to be output;
s170, according to the target distance R, the azimuth angle theta and the target radial velocity v r And a target tangential velocity v a And updating the target state by adopting Kalman filtering to finish target tracking.
Specifically, after the 5D millimeter wave Lei Dadian cloud data of each frame of track point is obtained, the 5D Lei Dadian cloud data of the track point is updated by using kalman filtering and converted into two-dimensional coordinates (x, y) to be output as shown in a right image of fig. 8, so that the target track is predicted and tracked. The detailed operation is as follows, and since only the target two-dimensional trajectory is tracked, the state at time k-1 can be expressed as,
Figure BDA0004087456980000141
The predicted value of the state at the next moment is,
Figure BDA0004087456980000142
wherein F is k Is a state transition matrix, where t is the time interval between different frame signals
Figure BDA0004087456980000143
For kalman filtering, the first part is the prediction process and the second part is the update process.
The prediction process comprises the following steps:
Figure BDA0004087456980000144
P k ′=F k P k-1 F k T +Q (21)
wherein the updating process:
Figure BDA0004087456980000145
P k =P k ′-K′H k P k ′ (23)
K′=P k ′H k T (H k P k ′H k T +R k ) -1 (24)
wherein P is k-1 For the estimation error of time k-1, P' k For the estimation error predicted at the next moment, K' represents the optimal Kalman gain, v is the process noise taking Q as covariance, and Q obeys the following distribution in a continuous white noise acceleration motion model:
Figure BDA0004087456980000151
the process noise Q is determined by the motion characteristics of the target, and the matrix H is observed k Is that
Figure BDA0004087456980000152
After the 5D millimeter wave Lei Dadian cloud data of each frame of track point is updated, the 5D millimeter wave Lei Dadian cloud data is converted into a two-dimensional track by utilizing the distance and the azimuth angle, and the two-dimensional track is output, wherein the conversion formula is as follows:
x=Rsinθ
y=Rcosθ (27)
in the embodiment, when the targets respectively move along 4 tracks, the target detection and tracking are carried out by adopting the method of the invention, and as shown in fig. 7-10, the target output result diagrams are respectively obtained when the targets move along tracks of a circle and a W route from back to front, from left to right and clockwise; wherein the A graph is a 3-dimensional target output result graph during target detection; and B, a 2-dimensional target output result graph during target tracking. In the graph A, X represents three-dimensional coordinate output of 5D millimeter wave Lei Dadian cloud of each frame signal, O represents three-dimensional coordinate output of 5D millimeter wave Lei Dadian cloud of target track point in each frame signal; the B panel represents the two-dimensional coordinate output of the 5D millimeter wave Lei Dadian cloud of the kalman-filtered target trajectory point in each frame signal.
According to the method provided by the embodiment, the TDM MIMO technology is utilized to perform three-transmission four-reception millimeter wave radar, signal processing is performed on the transmitting and receiving signals of the radar, so that 5D pedestrian information comprising target distance, azimuth angle, target pitch angle information, target radial speed and target tangential speed is obtained, target point detection is performed according to the 5D pedestrian information, and tracking and data updating of targets are performed according to the 5D pedestrian information by using a Kalman filtering method. The following technical effects are realized:
according to the invention, two paths of enhanced beat signals can be obtained for 4 paths of beat signals respectively corresponding to the first transmitting antenna and the third transmitting antenna, so that 6dB receiving gain is realized; thereby performing emission interference and acquiring tangential velocity information; according to the invention, two paths of enhanced beat signals are obtained through a Fourier wave beam forming technology for 4 paths of beat signals corresponding to the second transmitting antenna and 4 paths of beat signals in the middle of 8 paths of beat signals corresponding to the 1 st transmitting antenna and the 3 rd transmitting antenna, so that 6dB receiving gain is realized; extracting pitch angle information from the vertical phase difference by utilizing the array arrangement relation of the 4 paths of beat signals corresponding to the second transmitting antenna and the middle 4 paths of beat signals in the vertical direction, wherein the obtained pitch angle information is more accurate; in addition, the invention adopts the method to perform emission interference and acquire tangential velocity information so that the target is more perfect in velocity information, and according to tangential velocity and other pedestrian information; and tracking and updating the target by utilizing Kalman filtering, so that the track of the target is estimated and tracked better.
The embodiment of the invention can divide the functional modules of the electronic device or the main control device according to the method example, for example, each functional module can be divided corresponding to each function, and two or more functions can be integrated in one processing unit. The integrated units may be implemented in hardware or in software functional modules. It should be noted that, in the embodiment of the present invention, the division of the modules is schematic, which is merely a logic function division, and other division manners may be implemented in actual implementation.
Fig. 11 is a schematic structural diagram of a target tracking device based on a 5D millimeter wave radar according to an embodiment of the present application. The 5D millimeter wave radar comprises three transmitting antennas which are sequentially arranged in the horizontal direction and four receiving antennas which are sequentially arranged in the horizontal direction, wherein the horizontal distance between two adjacent transmitting antennas is lambda, the vertical distance between a second transmitting antenna at the middle position and the first transmitting antenna and the second transmitting antenna is lambda/2, and the vertical distance between the first transmitting antenna and the second transmitting antenna is 0; the horizontal distance between two adjacent receiving antennas is lambda/2; as shown in fig. 11, the apparatus 1100 includes:
A mixing module 1101 for transmitting carrier frequency f through three transmitting antennas in a time division multiplexing manner 0 FMCW signal of 77GHz (lambda=c/f 0 C is the speed of light), and obtains the received signals of four receiving antennas for each transmitting antenna, and carries out mixing processing according to the transmitted signals corresponding to the received signals to obtain beat signals S corresponding to 12 virtual array elements Bij (t); wherein i represents an ith path of transmitting antenna, j represents a jth path of receiving antenna, and i and j are positive integers;
a target distance and target radial velocity acquisition module 1102 for the beat signal S B1j (t) and beat signal S B3j (t) processing by Fourier beamforming techniques, respectively, to obtain enhanced beat signals S B1 And S is B3 For the enhanced beat signal S B1 And S is B3 2D-FFT processing is carried out to obtain a target distance R and a target radial velocity v r
A target tangential velocity acquisition module 1103 for generating an enhanced beat signal S B1 And S is B3 Performing emission interference processing, obtaining coherent signals, and performing time-frequency analysis processing to obtain target tangential velocity v a
A target azimuth acquisition module 1104 for the beat signal S B1j (t) and beat signal S B3j (t) obtaining a target azimuth angle theta according to a sum-difference beam amplitude measurement method;
a target pitch angle acquisition module 1105, configured to acquire a target pitch angle by using a phase contrast angle measurement method according to array arrangement of three transmitting antennas in a vertical direction
Figure BDA0004087456980000171
A target detection module 1106 for detecting a target pitch angle according to the target distance R, the azimuth angle θ, and the target pitch angle information
Figure BDA0004087456980000172
Performing three-dimensional coordinate conversion processing to obtain a target detection point;
a target tracking module 1107 for tracking the target radial velocity v according to the target distance R, the azimuth angle θ r And a target tangential velocity v a And updating the target state by adopting Kalman filtering to finish target tracking.
Further, the target tangential velocity acquisition module 1103 is specifically configured to:
for the enhanced beat signal S B1 And S is B3 Doppler compensation processing is carried out to obtain a compensated beat signal S B1 And S is B3
For Doppler compensated beat signal S B1 And S is B3 Performing emission interference treatment to obtain related signals;
performing FFT processing on the coherent signal to obtain tangential Doppler frequency;
obtaining the tangential velocity v of the target according to the tangential Doppler frequency a
Further, the target tracking module 1107 is specifically configured to:
the state of the setting target at time k-1 is:
Figure BDA0004087456980000173
then, according to the kalman filter, the predicted value of the next time state is:
Figure BDA0004087456980000174
wherein F is k Is a state transition matrix, where t is the time interval between different frame signals, v is the process noise, [] T Is the transposed matrix.
Further, the target distance and target radial velocity acquisition module 1102 is specifically configured to:
To beat signal S B1j (t) and beat signal S B3j (t) processing by Fourier beamforming techniques, respectively, to obtain enhanced beat signals S B1 And enhancing the beat signal S B3
For the enhanced beat signal S B1 And enhancing the beat signal S B3 Performing fast time FFT processing, acquiring a fast time Fourier signal, acquiring an intermediate frequency related to the target distance from the fast time Fourier signal, and acquiring the target distance according to the intermediate frequency;
performing slow time FFT processing on the fast time Fourier signal to obtain a slow time Fourier signal, acquiring radial Doppler shift according to the slow time Fourier signal, and obtaining the target radial velocity v according to the Doppler shift r
Further, the target azimuth acquisition module 1104 is specifically configured to:
constructing auxiliary beams for 8 virtual array elements corresponding to the first transmitting antenna and the third transmitting antenna, setting DBF coefficients, constructing a group of auxiliary beams two by two to form 7 groups of auxiliary beams, and acquiring an angle discrimination curve according to the auxiliary beams;
to beat signal S B1j (t) and beat signal S B3j (t) performing Doppler compensation processing after performing 2D-CFAR to obtain a compensated beat signal S B1j (t) and beat signal S B3j (t);
Will compensate the beat signal S B1j (t) and beat signal S B3j (t) multiplying the target direction by the DBF coefficient, and extracting the maximum value and the subscript Idx thereof to obtain a measurement angle range of which the target direction is in the Idx-th auxiliary beam;
And obtaining the target azimuth angle theta by using a table look-up method according to the measured angle range and the angle discrimination curve.
Further, the target azimuth acquisition module 1104 is further configured to:
the DBF coefficient dbfCoff is calculated by the following formula:
dbfCoff=exp{-j2π(n-1)dsinθ dbf /λ} (12)
where n=1.Beam pointing θ of 7 sets of auxiliary beams is set therein dbf Two are two by two, respectively: (-45.5 °, -32.5 °), (-32.5 °, -19.5 °), (-19.5 °, -6.5 °), (-6.5 °,6.5 °), (6.5 °,19.5 °), (19.5 °,32.5 °) and (32.5 °,45.5 °).
Further, the target pitch angle acquisition module 1105 is specifically configured to:
performing Fourier wave beam forming technology processing on the beat signals of the 4 virtual array elements corresponding to the second transmitting antenna to obtain an enhanced beat signal S BB2
Performing Fourier beam forming on beat signals corresponding to the first transmitting antenna, the third receiving antenna, the first transmitting antenna, the fourth receiving antenna, the third transmitting antenna, the first receiving antenna and the third transmitting antenna, and the second receiving antenna to obtain an enhanced beat signal S' BB13
According to the enhanced beat signal S BB2 And enhancing the beat signal S' BB13 Is of the phase difference phi z Extracting target pitch angle
Figure BDA0004087456980000181
The target tracking method based on the 5D millimeter wave radar provided in the present embodiment may perform the target tracking method based on the 5D millimeter wave radar in the above embodiment, and its implementation principle and technical effects are similar, and this embodiment will not be described here again.
In the foregoing specific implementation of a target tracking device based on a 5D millimeter wave radar, each module may be implemented as a processor, and the processor may execute computer-executable instructions stored in the memory, so that the processor executes a target tracking method based on a 5D millimeter wave radar.
Fig. 12 is a schematic structural diagram of an electronic device according to an embodiment of the present application. As shown in fig. 12, the electronic apparatus 1200 includes: at least one processor 1201 and memory 1202. The electronic device 1200 further comprises a communication part 1203. The processor 1201, the memory 1202, and the communication section 1203 are connected via a bus 1204.
In a specific implementation, the at least one processor 1201 executes computer-executable instructions stored in the memory 1202, such that the at least one processor 1201 performs a target tracking method based on a 5D millimeter wave radar as performed on the electronic device side above.
The specific implementation process of the processor 1201 can be referred to the above method embodiment, and its implementation principle and technical effects are similar, and this embodiment will not be described herein again.
In the above embodiment, it should be understood that the processor may be a central processing unit (english: central Processing Unit, abbreviated as CPU), or may be other general purpose processors, digital signal processors (english: digital Signal Processor, abbreviated as DSP), application specific integrated circuits (english: application Specific Integrated Circuit, abbreviated as ASIC), or the like. A general purpose processor may be a microprocessor or the processor may be any conventional processor or the like. The steps of a method disclosed in connection with the present invention may be embodied directly in a hardware processor for execution, or in a combination of hardware and software modules in a processor for execution.
The memory may comprise high speed RAM memory or may further comprise non-volatile storage NVM, such as at least one disk memory.
The bus may be an industry standard architecture (Industry Standard Architecture, ISA) bus, an external device interconnect (Peripheral Component, PCI) bus, or an extended industry standard architecture (Extended Industry Standard Architecture, EISA) bus, among others. The buses may be divided into address buses, data buses, control buses, etc. For ease of illustration, the buses in the drawings of the present application are not limited to only one bus or one type of bus.
The scheme provided by the embodiment of the invention is introduced aiming at the functions realized by the electronic equipment and the main control equipment. It will be appreciated that the electronic device or the master device, in order to implement the above-described functions, includes corresponding hardware structures and/or software modules that perform the respective functions. The present embodiments can be implemented in hardware or a combination of hardware and computer software in combination with the various exemplary elements and algorithm steps described in connection with the embodiments disclosed in the embodiments of the present invention. Whether a function is implemented as hardware or computer software driven hardware depends upon the particular application and design constraints imposed on the solution. Those skilled in the art may implement the described functionality using different approaches for each particular application, but such implementation is not to be considered as beyond the scope of the embodiments of the present invention.
The application also provides a computer readable storage medium, wherein computer execution instructions are stored in the computer readable storage medium, and when a processor executes the computer execution instructions, the target tracking method based on the 5D millimeter wave radar is realized.
The computer readable storage medium described above may be implemented by any type of volatile or non-volatile memory device or combination thereof, such as Static Random Access Memory (SRAM), electrically erasable programmable read-only memory (EEPROM), erasable programmable read-only memory (EPROM), programmable read-only memory (PROM), read-only memory (ROM), magnetic memory, flash memory, magnetic disk, or optical disk. A readable storage medium can be any available medium that can be accessed by a general purpose or special purpose computer.
An exemplary readable storage medium is coupled to the processor such the processor can read information from, and write information to, the readable storage medium. In the alternative, the readable storage medium may be integral to the processor. The processor and the readable storage medium may reside in an application specific integrated circuit (Application Specific Integrated Circuits, ASIC for short). The processor and the readable storage medium may reside as discrete components in an electronic device or a master device.
The present application also provides a computer program product comprising: a computer program stored in a readable storage medium, from which at least one processor of an electronic device can read, the at least one processor executing the computer program causing the electronic device to perform the solution provided by any one of the embodiments described above.
Those of ordinary skill in the art will appreciate that: all or part of the steps for implementing the method embodiments described above may be performed by hardware associated with program instructions. The foregoing program may be stored in a computer readable storage medium. The program, when executed, performs steps including the method embodiments described above; and the aforementioned storage medium includes: various media that can store program code, such as ROM, RAM, magnetic or optical disks.
Finally, it should be noted that: the above embodiments are only for illustrating the technical solution of the present invention, and not for limiting the same; although the invention has been described in detail with reference to the foregoing embodiments, it will be understood by those of ordinary skill in the art that: the technical scheme described in the foregoing embodiments can be modified or some or all of the technical features thereof can be replaced by equivalents; such modifications and substitutions do not depart from the spirit of the invention.

Claims (10)

1. The target tracking method based on the 5D millimeter wave radar is characterized in that the millimeter wave radar comprises three transmitting antennas which are sequentially arranged in the horizontal direction and four receiving antennas which are sequentially arranged in the horizontal direction, the horizontal distance between two adjacent transmitting antennas is lambda, the vertical distance between a second transmitting antenna at the middle position and a first transmitting antenna and a second transmitting antenna is lambda/2, and the vertical distance between the first transmitting antenna and the second transmitting antenna is 0; the horizontal distance between two adjacent receiving antennas is lambda/2; the method comprises the following steps:
the carrier frequency f is transmitted by three transmitting antennas respectively in a time division multiplexing mode 0 An FMCW signal of 77GHz, where λ=c/f 0 C is the light speed, and obtains the receiving signals of four receiving antennas aiming at each transmitting antenna, and carries out mixing processing according to the transmitting signals corresponding to the receiving signals to obtain beat signals S corresponding to 12 virtual array elements Bij (t); wherein i represents an ith transmitting antenna, j represents a jth receiving antenna, and i and j are positive integers;
for beat signal S B1j (t) and beat signal S B3j (t) respectively lead toProcessing by Fourier wave beam forming technology to obtain enhanced beat signal S B1 And S is B3 For the enhanced beat signal S B1 And S is B3 2D-FFT processing is carried out to obtain a target distance R and a target radial velocity v r
According to the enhanced beat signal S B1 And S is B3 Performing emission interference processing, obtaining coherent signals, and performing time-frequency analysis processing to obtain target tangential velocity v a
For beat signal S B1j (t) and beat signal S B3j (t) obtaining a target azimuth angle theta according to a sum-difference beam amplitude measurement method;
according to the array arrangement of three transmitting antennas in the vertical direction, a specific phase angle measurement method is adopted to obtain a target pitch angle
Figure FDA0004087456970000011
According to the target distance R, the azimuth angle theta and the target pitch angle information
Figure FDA0004087456970000012
Performing three-dimensional coordinate conversion processing to obtain a target detection point;
according to the target distance R, the azimuth angle theta and the target radial velocity v r And a target tangential velocity v a And updating the target state by adopting Kalman filtering to finish target tracking.
2. The method according to claim 1, wherein the step-up beat signal S is based on B1 And S is B3 Performing emission interference processing, obtaining coherent signals, and performing time-frequency analysis processing to obtain target tangential velocity v a Comprising:
for the enhanced beat signal S B1 And S is B3 Doppler compensation processing is carried out to obtain a compensated beat signal S B1 And S is B3
For Doppler compensated beat signal S B1 And S is B3 Performing emission interference treatment to obtainTo the associated signal;
performing FFT processing on the coherent signal to acquire tangential Doppler frequency;
obtaining the tangential velocity v of the target according to the tangential Doppler frequency a
3. The method according to claim 1, wherein the target radial velocity v is determined according to the target distance R, target azimuth angle θ, target radial velocity v r And a target tangential velocity v a The method for updating the target state by adopting Kalman filtering to complete target tracking comprises the following steps:
the state of the setting target at time k-1 is:
Figure FDA0004087456970000021
then, according to the kalman filter, the predicted value of the next time state is:
Figure FDA0004087456970000022
wherein F is k Is a state transition matrix, where t is the time interval between different frame signals, v is the process noise, where [ [] T Is the transposed matrix.
4. The method according to claim 1, characterized in that the signal S is a beat signal B1j (t) and beat signal S B3j (t) processing by Fourier beamforming techniques, respectively, to obtain enhanced beat signals S B1 And S is B3 For the enhanced beat signal S B1 And S is B3 2D-FFT processing is carried out to obtain a target distance R and a target radial velocity v r Comprising:
to beat signal S B1j (t) and beat signal S B3j (t) processing by Fourier beamforming techniques, respectively, to obtain enhanced beat signals S B1 And enhancing the beat signal S B3
For the enhanced beat signal S B1 And enhancing the beat signal S B3 Performing fast time FFT processing, obtaining a fast time Fourier signal, obtaining an intermediate frequency related to a target distance from the fast time Fourier signal, and obtaining the target distance according to the intermediate frequency;
performing slow time FFT processing on the fast time Fourier signal to obtain a slow time Fourier signal, obtaining radial Doppler frequency shift according to the slow time Fourier signal, and obtaining a target radial velocity v according to the Doppler frequency shift r
5. The method according to claim 1, characterized in that the signal S is a beat signal B1j (t) and beat signal S B3j (t) obtaining a target azimuth angle θ according to a sum-difference beam amplitude mapping method, including:
constructing auxiliary beams for 8 virtual array elements corresponding to the first transmitting antenna and the third transmitting antenna, setting DBF coefficients, constructing a group of auxiliary beams to form 7 groups of auxiliary beams, and acquiring an angle discrimination curve according to the auxiliary beams;
to beat signal S B1j (t) and beat signal S B3j (t) performing Doppler compensation processing after performing 2D-CFAR to obtain a compensated beat signal S B1j (t) and beat signal S B3j (t);
Will compensate the beat signal S B1j (t) and beat signal S B3j (t) multiplying the target direction by the DBF coefficient, and extracting the maximum value and the subscript Idx thereof to obtain a measurement angle range of which the target direction is in the Idx-th auxiliary beam;
and obtaining a target azimuth angle theta by using a table look-up method according to the measurement angle range and the angle discrimination curve.
6. The method of claim 5, wherein the DBF coefficient dbfCoff is calculated by the formula:
dbfCoff=exp{-j2π(n-1)dsinθ dbf /λ}
where n=1,..8, beam fingers in which 7 sets of auxiliary beams are setTo theta dbf Two are two by two, respectively: (-45.5 °, -32.5 °), (-32.5 °, -19.5 °), (-19.5 °, -6.5 °), (-6.5 °,6.5 °), (6.5 °,19.5 °), (19.5 °,32.5 °) and (32.5 °,45.5 °).
7. The method of claim 6, wherein the target pitch angle is extracted by a phase contrast angle method according to the array arrangement of three transmitting antennas in the vertical direction
Figure FDA0004087456970000032
Comprising the following steps:
performing Fourier wave beam forming technology processing on the beat signals of the 4 virtual array elements corresponding to the second transmitting antenna to obtain an enhanced beat signal S BB2
Performing Fourier beam forming on beat signals corresponding to the first transmitting antenna, the third receiving antenna, the first transmitting antenna, the fourth receiving antenna, the third transmitting antenna, the first receiving antenna and the third transmitting antenna, and the second receiving antenna to obtain an enhanced beat signal S' BB13
According to the enhanced beat signal S BB2 And enhancing the beat signal S' BB13 Is of the phase difference phi z Extracting target pitch angle
Figure FDA0004087456970000031
8. The target tracking device based on the 5D millimeter wave radar is characterized in that the 5D millimeter wave radar comprises three transmitting antennas which are sequentially arranged in the horizontal direction and four receiving antennas which are sequentially arranged in the horizontal direction, the horizontal distance between two adjacent transmitting antennas is lambda, the vertical distance between a second transmitting antenna in the middle position and a first transmitting antenna and a second transmitting antenna is lambda/2, and the vertical distance between the first transmitting antenna and the second transmitting antenna is 0; the horizontal distance between two adjacent receiving antennas is lambda/2; the apparatus comprises:
a frequency mixing module for passing through three transmitting antennas in a time division multiplexing modeRespectively transmitting carrier frequency f 0 FMCW signal of 77GHz (lambda=c/f 0 C is the speed of light), and obtains the received signals of four receiving antennas for each transmitting antenna, and carries out mixing processing according to the transmitted signals corresponding to the received signals to obtain beat signals S corresponding to 12 virtual array elements Bij (t); wherein i represents an ith path of transmitting antenna, j represents a jth path of receiving antenna, and i and j are positive integers;
a target distance and target radial velocity acquisition module for the beat signal S B1j (t) and beat signal S B3j (t) processing by Fourier beamforming techniques, respectively, to obtain enhanced beat signals S B1 And S is B3 For the enhanced beat signal S B1 And S is B3 2D-FFT processing is carried out to obtain a target distance R and a target radial velocity v r
A target tangential velocity acquisition module for acquiring a target tangential velocity according to the enhanced beat signal S B1 And S is B3 Performing emission interference processing, obtaining coherent signals, and performing time-frequency analysis processing to obtain target tangential velocity v a
A target azimuth acquisition module for the beat signal S B1j (t) and beat signal S B3j (t) obtaining a target azimuth angle theta according to a sum-difference beam amplitude measurement method;
the target pitch angle acquisition module is used for acquiring a target pitch angle by adopting a phase contrast angle measurement method according to array arrangement of three transmitting antennas in the vertical direction
Figure FDA0004087456970000041
The target detection module is used for detecting the target distance R, the azimuth angle theta and the target pitch angle information according to the target distance R, the azimuth angle theta and the target pitch angle information
Figure FDA0004087456970000042
Performing three-dimensional coordinate conversion processing to obtain a target detection point;
a target tracking module for tracking the target radial velocity v according to the target distance R, the azimuth angle theta and the target radial velocity v r And a target tangential velocity v a By usingAnd updating the target state by Kalman filtering to finish target tracking.
9. An electronic device, comprising: a processor, and a memory communicatively coupled to the processor;
The memory stores computer-executable instructions;
the processor executes computer-executable instructions stored in the memory to implement the method of any one of claims 1 to 7.
10. A computer readable storage medium having stored therein computer executable instructions which when executed by a processor are adapted to carry out the method of any one of claims 1 to 7.
CN202310133062.9A 2023-02-07 2023-02-07 Target tracking method, device and storage medium based on 5D millimeter wave radar Pending CN116106894A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310133062.9A CN116106894A (en) 2023-02-07 2023-02-07 Target tracking method, device and storage medium based on 5D millimeter wave radar

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310133062.9A CN116106894A (en) 2023-02-07 2023-02-07 Target tracking method, device and storage medium based on 5D millimeter wave radar

Publications (1)

Publication Number Publication Date
CN116106894A true CN116106894A (en) 2023-05-12

Family

ID=86259679

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310133062.9A Pending CN116106894A (en) 2023-02-07 2023-02-07 Target tracking method, device and storage medium based on 5D millimeter wave radar

Country Status (1)

Country Link
CN (1) CN116106894A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117331047A (en) * 2023-12-01 2024-01-02 德心智能科技(常州)有限公司 Human behavior data analysis method and system based on millimeter wave radar

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117331047A (en) * 2023-12-01 2024-01-02 德心智能科技(常州)有限公司 Human behavior data analysis method and system based on millimeter wave radar

Similar Documents

Publication Publication Date Title
Engels et al. Automotive radar signal processing: Research directions and practical challenges
US11860267B2 (en) Systems and methods for interpolated virtual aperture radar tracking
US11346933B2 (en) Doppler ambiguity resolution in MIMO radars using a SIMO evaluation
US10338216B2 (en) Object detection in multiple radars
US20180128916A1 (en) Object detection in multiple radars
US7545311B2 (en) Method and system for predicting air-to-surface target missile
Zhang et al. Super resolution DOA based on relative motion for FMCW automotive radar
US11762084B2 (en) Vehicle radar system
JP4829517B2 (en) Radar signal processing device
US10345439B2 (en) Object detection in multiple radars
CN111679266B (en) Automobile millimeter wave radar sparse array grating lobe false target identification method and system
US20190086512A1 (en) Method and apparatus for vehicular radar calibration
JP6713946B2 (en) In-vehicle radar device
US11762079B2 (en) Distributed radar antenna array aperture
US9134407B2 (en) Motion parameter estimating method, angle estimating method and determination method
US20210239825A1 (en) Object tracking apparatus
US20190086509A1 (en) Synchronization of multiple radars start up time for interference mitigation
CN116106894A (en) Target tracking method, device and storage medium based on 5D millimeter wave radar
CN109799505B (en) Method and apparatus for continuous tracking in a multi-radar system
US20180128912A1 (en) Object detection in multiple radars
Engels Target shape estimation using an automotive radar
CN111522010B (en) Method and system for processing automobile anti-collision radar signals
Deng et al. Modelling and simulation of sensor-guided autonomous driving
US11067686B2 (en) Obstacle position and extent measurement by automotive radar
JP2021073452A (en) Electronic device, electronic device control method, and electronic device control program

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination