Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
CN115270066B - A method, system, device, and medium for determining the relative velocity of a target object. - Google Patents
[go: Go Back, main page]

CN115270066B - A method, system, device, and medium for determining the relative velocity of a target object. - Google Patents

A method, system, device, and medium for determining the relative velocity of a target object.

Info

Publication number
CN115270066B
CN115270066B CN202210912557.7A CN202210912557A CN115270066B CN 115270066 B CN115270066 B CN 115270066B CN 202210912557 A CN202210912557 A CN 202210912557A CN 115270066 B CN115270066 B CN 115270066B
Authority
CN
China
Prior art keywords
matrix
target object
vehicle
radar
velocity
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.)
Active
Application number
CN202210912557.7A
Other languages
Chinese (zh)
Other versions
CN115270066A (en
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.)
Chongqing Changan Technology Co Ltd
Original Assignee
Chongqing Changan Automobile Co Ltd
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 Chongqing Changan Automobile Co Ltd filed Critical Chongqing Changan Automobile Co Ltd
Priority to CN202210912557.7A priority Critical patent/CN115270066B/en
Publication of CN115270066A publication Critical patent/CN115270066A/en
Application granted granted Critical
Publication of CN115270066B publication Critical patent/CN115270066B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G06COMPUTING OR CALCULATING; COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/16Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
    • 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
    • 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/41Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Mathematical Physics (AREA)
  • Mathematical Analysis (AREA)
  • Computational Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Pure & Applied Mathematics (AREA)
  • Data Mining & Analysis (AREA)
  • Theoretical Computer Science (AREA)
  • Computing Systems (AREA)
  • Algebra (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明提供一种目标对象相对速度确定方法、系统、设备、介质,通过获取目标对象的多个雷达点的方位角,确定各所述雷达点的方位角正弦值和方位角余弦值;基于各所述雷达点的方位角正弦值和方位角余弦值生成第一矩阵和第二矩阵,确定第三矩阵,根据所述第三矩阵确定矩阵行列式值、第三矩阵的特征值;若所述矩阵行列式值大于第一预设阈值,且特征商大于第二预设阈值,对所述第三矩阵进行正则化处理;基于所述雷达点的地面径向速度、正则化处理后的第三矩阵和第二矩阵确定所述目标对象相对于本车的目标对象相对速度,所述雷达点的地面径向速度通过本车的纵向速度、横向速度和所述方位角确定,所述方位角通过所述本车的前毫米波雷达采集得到。

This invention provides a method, system, device, and medium for determining the relative velocity of a target object. The method involves acquiring the azimuth angles of multiple radar points on the target object, determining the sine and cosine values of the azimuth angles for each radar point, generating a first matrix and a second matrix based on the sine and cosine values of the azimuth angles of each radar point, determining a third matrix, and determining the matrix determinant and eigenvalues of the third matrix based on the third matrix. If the matrix determinant is greater than a first preset threshold and the eigenvalue is greater than a second preset threshold, the third matrix is regularized. The relative velocity of the target object with respect to the vehicle is determined based on the ground radial velocity of the radar points, the regularized third matrix, and the second matrix. The ground radial velocity of the radar points is determined by the longitudinal and lateral velocity of the vehicle and the azimuth angle, which is acquired by the vehicle's front millimeter-wave radar.

Description

Method, system, equipment and medium for determining relative speed of target object
Technical Field
The application relates to the technical field of vehicle radar speed measurement, in particular to a method, a system, equipment and a medium for determining the relative speed of a target object.
Background
In the automatic driving technique, it is extremely important for accurate measurement of the vehicle speed. In the prior art, the point of the millimeter wave radar on the target object obtained by obtaining signals through each channel of the front millimeter wave radar is the radial speed of the front radar relative to the vehicle measured under the polar coordinate system, the speed of the front millimeter wave radar relative to the vehicle generated when the front millimeter wave radar strikes a certain position of the target is represented, the number of the points of the front millimeter wave radar on the same target depends on the size of the target, the distance of the target and the material quality of the target, the estimated speed of the target is more accurate when the points are often more, but certain situations exist, such as the points are generated when the radar strikes the wheels of the target, the relative radial speed is often large when the points strike the tire due to the linear speed of the wheels, the speed estimation of the target under the vehicle coordinate system is influenced by the points including a pile of noise points detected by the front radar, and the speed estimation of the target under the vehicle coordinate system is also influenced. In addition, including if the points on the target object are all near the line AB, i.e., equivalent to collinear, there is a great impact on solving the solution of the linear equation set, and also on the speed estimation of the target in the vehicle coordinate system. Therefore, in the prior art, there are various problems that the measurement of the target speed is wrong due to too many factors influencing the measurement, low test precision and the like.
Disclosure of Invention
In view of the above-mentioned shortcomings of the prior art, the present invention provides a solution, a system, a device, a medium for estimating a target speed based on a detection radar, so as to solve the above-mentioned technical problems.
The invention provides a method for manufacturing a semiconductor device, which comprises the following steps:
a method of determining a relative speed of a target object, the method of determining an estimated speed of the target object comprising:
acquiring azimuth angles of a plurality of radar points of a target object, and determining azimuth angle sine values and azimuth angle cosine values of the radar points;
Generating a first matrix and a second matrix based on azimuth sine values and azimuth cosine values of the radar points, and determining a third matrix, wherein the second matrix is an inverse matrix of the first matrix, and the third matrix is a product of the first matrix and the second matrix;
determining matrix determinant values and characteristic values of a third matrix according to the third matrix;
if the matrix determinant value is larger than a first preset threshold value and the characteristic quotient is larger than a second preset threshold value, regularizing the third matrix, wherein the characteristic quotient is the quotient of the maximum characteristic value and the minimum characteristic value of the third matrix;
And determining the relative speed of the target object relative to the target object of the vehicle based on the ground radial speed of the radar point, the regularized third matrix and the second matrix, wherein the ground radial speed of the radar point is determined by the longitudinal speed, the transverse speed and the azimuth angle of the vehicle, and the azimuth angle is acquired by the front millimeter wave radar of the vehicle.
In an embodiment of the present application, the first matrix is a matrix of n×2, n is a number of radar points acquired by the target object, a first column of the first matrix is an azimuth cosine value of each radar point, and a second column of the first matrix is an azimuth sine value of each radar point;
The second matrix is a transposed matrix of the first matrix, and the second matrix is a 2*n matrix;
the third matrix is a second matrix multiplied by the first matrix, and the third matrix is a matrix of 2 x 2.
In one embodiment of the present application, the ground radial velocity of the radar point comprises:
Collecting a vehicle CAN signal based on the vehicle CAN, and obtaining the longitudinal speed and the transverse speed of the vehicle according to the vehicle CAN signal;
and respectively projecting the longitudinal speed and the transverse speed of the vehicle to the direction of the connecting line of the vehicle and the radar point, wherein the ground radial speed of the radar point is the projection value of the longitudinal speed of the vehicle in the direction of the connecting line of the vehicle and the radar point plus the projection value of the transverse speed of the vehicle in the direction of the connecting line of the vehicle and the radar point.
In an embodiment of the present application, if the matrix determinant value is greater than a first preset threshold value and the feature quotient is greater than a second preset threshold value, regularizing the third matrix includes the steps of:
introducing regularization to process the third matrix to obtain an optimized third matrix solution set;
Introducing regularization iteration to optimize the third matrix according to preset times, combining the third matrix after each iteration to calculate a characteristic quotient, judging whether the characteristic quotient of each iteration is larger than a second preset threshold value, if not, determining that the calculated ground radial velocity of the radar point is accurate and reserved, and if so, discarding the calculated ground radial velocity of the radar point.
In an embodiment of the present application, the preset number of times is five, and after the regularization iteration is introduced into the third matrix for five times, if the eigenvector calculated according to the third matrix is still greater than the second preset threshold, the relative speed of the target object with respect to the target object of the host vehicle is abandoned.
In an embodiment of the present application, the third matrix introducing regularization iteration process includes the steps of:
And calculating the characteristic quotient of the third matrix after regularization every time the third matrix is subjected to regularization, stopping L2 regularization on the third matrix if the calculated characteristic quotient of the third matrix is not greater than a second preset threshold value, and reserving the ground radial speed of the radar point calculated according to the third matrix after regularization.
In an embodiment of the present application, the third matrix introducing regularization iteration process further includes the steps of:
And calculating matrix determinant values of the third matrix after regularization every time the third matrix is subjected to regularization, and if the matrix determinant values of the third matrix after regularization are larger than a first preset threshold value, abandoning the calculation of the relative speed of the target object relative to the target object of the vehicle by using the third matrix.
In an embodiment of the present application, regularizing the third matrix includes:
l1 regularization or L2 regularization.
A system for estimating a target speed based on a detection radar, comprising:
the acquisition module acquires azimuth angles of a plurality of radar points of the target object, and determines an azimuth angle sine value and an azimuth angle cosine value of the radar points;
The calculation module generates a first matrix and a second matrix based on azimuth sine values and azimuth cosine values of the radar points, determines a third matrix, wherein the second matrix is an inverse matrix of the first matrix, the third matrix is a product of the first matrix and the second matrix, and determines the relative speed of the target object relative to the target object of the vehicle based on the ground radial speed of the radar points, the regularized third matrix and the second matrix;
And the optimization module is used for determining matrix determinant values and characteristic values of the third matrix according to the third matrix, and carrying out regularization treatment on the third matrix if the matrix determinant values are larger than a first preset threshold value and the characteristic quotient is larger than a second preset threshold value, wherein the characteristic quotient is the quotient of the maximum characteristic value and the minimum characteristic value of the third matrix.
An electronic device, the electronic device comprising:
One or more processors;
Storage means for storing one or more programs that, when executed by the one or more processors, cause the electronic device to implement the target object relative velocity determination method of any of claims 1 to 9.
A computer-readable storage medium having stored thereon a computer program which, when executed by a processor of a computer, causes the computer to perform the target object relative velocity determination method of any one of claims 1 to 9.
The invention has the beneficial effects that:
according to the method, the radial speed of the vehicle under the polar coordinate system is converted into the absolute radial speed relative to the ground, the absolute radial speed matrix equation of the millimeter wave Lei Dadian cloud data relative to the ground is combined and established, the absolute radial speed matrix equation solution set is calculated to obtain the speed of the target point, whether a pathological matrix exists or not is judged, L1 or L2 regularization adjustment is introduced to optimize the pathological matrix solution set, errors are eliminated more accurately, and the speed of the target is calculated.
It is to be understood that both the foregoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the application as claimed.
Drawings
The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the application and together with the description, serve to explain the principles of the application. It is evident that the drawings in the following description are only some embodiments of the present application and that other drawings may be obtained from these drawings without inventive effort for a person of ordinary skill in the art. In the drawings:
FIG. 1 is a schematic diagram showing a positional relationship between a radar and a target according to an exemplary embodiment of the present application;
FIG. 2 is a schematic diagram illustrating a positional relationship between a radar and a target in accordance with an exemplary embodiment of the present application;
FIG. 3 is a schematic diagram of a system architecture shown in an exemplary embodiment of the present application;
FIG. 4 is a schematic diagram showing a disease matrix judgment step according to an exemplary embodiment of the present application;
FIG. 5 is a schematic diagram illustrating a ill-conditioned matrix optimization step according to an exemplary embodiment of the application;
fig. 6 shows a schematic diagram of a computer system suitable for use in implementing an embodiment of the application.
Detailed Description
Further advantages and effects of the present invention will become readily apparent to those skilled in the art from the disclosure herein, by referring to the accompanying drawings and the preferred embodiments. The invention may be practiced or carried out in other embodiments that depart from the specific details, and the details of the present description may be modified or varied from the spirit and scope of the present invention. It should be understood that the preferred embodiments are presented by way of illustration only and not by way of limitation.
It should be noted that the illustrations provided in the following embodiments merely illustrate the basic concept of the present invention by way of illustration, and only the components related to the present invention are shown in the drawings and are not drawn according to the number, shape and size of the components in actual implementation, and the form, number and proportion of the components in actual implementation may be arbitrarily changed, and the layout of the components may be more complicated.
In the following description, numerous details are set forth in order to provide a more thorough explanation of embodiments of the present invention, it will be apparent, however, to one skilled in the art that embodiments of the present invention may be practiced without these specific details, in other embodiments, well-known structures and devices are shown in block diagram form, rather than in detail, in order to avoid obscuring the embodiments of the present invention.
It should be noted that radar speed measurement mainly uses the Doppler Effect (Doppler Effect) principle that when a target approaches the radar antenna, the frequency of the reflected signal will be higher than the frequency of the transmitter, whereas when the target approaches the antenna, the frequency of the reflected signal will be lower than the frequency of the transmitter. Thus, the relative speed between the target and the radar can be calculated by means of the frequency change value (the target flies towards the radar, the Doppler frequency is positive, and the Doppler frequency is negative when the target flies away from the radar). As shown in fig. 1, the embodiment of the application relates to millimeter wave radar speed measurement, and the millimeter wave radar is a radar working in millimeter wave band (MILLIMETER WAVE) detection. Typically millimeter waves refer to the frequency domain (wavelength 1-10 mm) of 30-300 GHz. The millimeter wave has the wavelength between centimetre wave and light wave, so that the millimeter wave has the advantages of microwave guidance and photoelectric guidance.
As shown in fig. 2, a method for determining a relative speed of a target object, the method comprising:
S210, acquiring azimuth angles of a plurality of radar points of a target object, and determining azimuth angle sine values and azimuth angle cosine values of the radar points;
S220, generating a first matrix and a second matrix based on azimuth sine values and azimuth cosine values of the radar points, and determining a third matrix, wherein the second matrix is an inverse matrix of the first matrix, and the third matrix is a product of the first matrix and the second matrix;
S230, determining matrix determinant values and characteristic values of a third matrix according to the third matrix;
S240, if the matrix determinant value is greater than a first preset threshold value and the characteristic quotient is greater than a second preset threshold value, regularizing the third matrix, wherein the characteristic quotient is the quotient of the maximum characteristic value and the minimum characteristic value of the third matrix;
S250, determining the relative speed of the target object relative to the target object of the vehicle based on the ground radial speed of the radar point, the third matrix and the second matrix after regularization treatment, wherein the ground radial speed of the radar point is determined by the longitudinal speed, the transverse speed and the azimuth angle of the vehicle, and the azimuth angle is acquired by the front millimeter wave radar of the vehicle.
As shown in fig. 1, the moving speed of the vehicle is decomposed, the radial speed along the straight line direction of the vehicle-target point is calculated, and the absolute radial speed relative to the ground is obtained by converting the point cloud speed measured by the projection of the millimeter wave radar onto the target point. And (3) combining to form an absolute radial matrix equation of millimeter wave radar point cloud data relative to the ground by obtaining a data set, and calculating a solution set of the absolute radial velocity matrix equation to obtain the velocity of the target point.
Regularization (Regularization) is a generic term for a class of methods in machine learning that introduce additional information into the original loss function in order to prevent overfitting and improve model generalization performance. That is, the objective function becomes the original loss function+the additional term, and there are two general types of additional terms, english called L1-norm and L2-norm, chinese called L1 regularization and L2 regularization, or L1 norm and L2 norm (actually, the square of the L2 norm). L2 regularization can prevent model overfitting.
The ground radial velocity of the radar point comprises:
collecting a vehicle CAN signal based on the vehicle CAN, and obtaining the longitudinal speed Vx and the transverse speed Vy of the vehicle according to the vehicle CAN signal;
And projecting the longitudinal speed Vx and the transverse speed Vy of the vehicle to the radial speed direction of the millimeter Bao Leida under the polar coordinate, and acquiring the absolute radial speed of the millimeter wave Lei Dadian cloud relative to the ground according to a first preset formula.
The first preset formula is:
RRotg=Vx*cosα+Vy*sinα;
Wherein RRotg is the absolute radial velocity relative to the ground in the polar coordinate system, and α is the azimuth of the millimeter wave radar generation point.
The method comprises the steps of receiving some vehicle CAN signals on a vehicle body CAN to obtain some vehicle information, estimating some vehicle information by a vehicle state estimation module to obtain the information of Vx and Vy of the vehicle, projecting the Vx and Vy of the vehicle to the radial speed direction of a millimeter wave radar under polar coordinates to obtain the absolute radial speed of a millimeter wave Lei Dadian cloud relative to the ground, and converting all point cloud data according to a first preset formula to obtain the absolute radial speed as shown in the first preset formula.
The step of calculating the absolute radial velocity matrix equation solution to obtain the velocity of the target point comprises the following steps:
Establishing a second preset formula for calculating the absolute radial speed of the millimeter wave Lei Dadian cloud relative to the ground based on a least square method, simplifying the second preset formula into a third preset formula, and solving the absolute radial speed of the millimeter wave Lei Dadian cloud data relative to the ground through a transposed matrix.
In an embodiment of the present invention, the second preset formula is:
Wherein RRotg is the absolute radial speed of the millimeter wave Lei Dadian cloud relative to the ground, alpha is the azimuth angle of the millimeter wave radar striking a point on a target vehicle, 1 to n represent the number of the point clouds striking the target vehicle, vx_obj is the longitudinal speed of the target vehicle under the vehicle coordinate system, and Vy_obj is the transverse speed of the target vehicle under the vehicle coordinate system;
In theory, the accuracy of estimating the speed of the target point by utilizing the millimeter wave radar point cloud data depends on the number of the points, the millimeter wave radar is hit on the same target point, the speed of the target is estimated according to a least square method, and the calculation is performed by combining a second preset formula.
In an embodiment of the present invention, the third predetermined formula is y=ax, wherein Y isA isI.e. the first matrix, x is
Wherein the second preset formula may be reduced to y=ax,
And multiplying both sides of the third preset formula by the transposed matrix A T of A to obtain A TY=AT Ax, wherein A T is a second matrix and A T A is a third matrix.
Wherein A T A is a matrix solution set and is a reversible matrix, and x is the radial velocity of the millimeter wave Lei Dadian cloud relative to the ground.
Since there are many points on the object, the a matrix is a matrix of a plurality of rows and two columns, that is, a matrix of n×2, which is not a square matrix, and the inversion operation cannot be performed, so both sides of the equation are multiplied by a T (the transposed matrix of the a matrix) to make it a square matrix of 2×2, the equation is converted into a matrix of a TA=ATAx,AT a now being 2×2, assuming ATA is a reversible matrix, and the solution of the vector of x is successful at this time.
In an embodiment of the present invention, as shown in fig. 4, the more the number of point clouds is, the more accurate the estimated speed of the target point is, but there are often specific situations, such as radar hitting the wheels of the target vehicle, because there is a linear speed of the moving wheels, the points hitting the moving tires are often larger than the points hitting the vehicle except the tires, the relative radial speed is larger than the general points, and there are a plurality of noise points detected by the radar, and further, if hitting the target vehicle, there are many points, but these points are all near the AB straight line, that is, equivalent to being collinear, there is a great influence on the solution for solving the linear equation set, which may cause occurrence of a disease matrix, that is, the third matrix may be a disease matrix, affecting the ground radial speed of the radar points calculated by the third matrix, and further affecting the relative speed accuracy of the target object with respect to the target object of the vehicle, so the method needs to determine whether the third matrix is a disease matrix, including the steps of:
S410, calculating a value of a determinant of the matrix A T A, judging whether the value of the determinant is larger than a preset threshold, if so, continuing to solve the radial velocity of the millimeter wave Lei Dadian cloud relative to the ground, and if not, directly discarding the radial velocity of the millimeter wave Lei Dadian cloud relative to the ground calculated by using the absolute radial velocity matrix;
S420, solving the eigenvalue of the matrix A T A, dividing the maximum eigenvalue obtained by solving by the minimum eigenvalue to obtain the condition number of the matrix A T A, judging whether the condition number of the matrix A T A is larger than a preset threshold, if not, the matrix A T A is not a disease state matrix, and if so, the matrix A T A is a disease state matrix.
In one embodiment of the present invention, as shown in fig. 5, the step of introducing regularization adjustment to optimize the solution set of the disease state matrix includes:
S510, regularization is introduced into a solution of the absolute radial velocity of the millimeter wave Lei Dadian cloud relative to the ground, so that an optimized pathological matrix solution set is obtained;
S520, introducing regularization iteration optimization of the pathological matrix according to preset times, calculating the condition number of the pathological matrix after each iteration, judging whether the condition number of each iteration is larger than a preset threshold value, if not, determining that the calculated radial velocity of the millimeter wave Lei Dadian cloud relative to the ground is accurate and reserved, and if so, discarding the calculated velocity.
After each iteration, the condition number is calculated, whether the condition number is larger than a preset threshold value or not is judged, if the condition number is larger than the preset threshold value, the iteration is continued for 5 times, and if the condition number is larger than the preset threshold value after 5 times, the estimated speed of the target point is abandoned.
In an embodiment of the present invention, the solution of the radial velocity of the millimeter wave Lei Dadian cloud with respect to the ground is expressed as x= (a TA)-1*AT Y;
The regularized optimal solution set is expressed as x= (A TA+λI)-1*AT Y).
As shown in fig. 3, a system for estimating a target speed based on a detection radar, comprising:
the acquisition module acquires azimuth angles of a plurality of radar points of the target object, and determines an azimuth angle sine value and an azimuth angle cosine value of the radar points;
The calculation module generates a first matrix and a second matrix based on azimuth sine values and azimuth cosine values of the radar points, determines a third matrix, wherein the second matrix is an inverse matrix of the first matrix, the third matrix is a product of the first matrix and the second matrix, and determines the relative speed of the target object relative to the target object of the vehicle based on the ground radial speed of the radar points, the regularized third matrix and the second matrix;
And the optimization module is used for determining matrix determinant values and characteristic values of the third matrix according to the third matrix, and carrying out regularization treatment on the third matrix if the matrix determinant values are larger than a first preset threshold value and the characteristic quotient is larger than a second preset threshold value, wherein the characteristic quotient is the quotient of the maximum characteristic value and the minimum characteristic value of the third matrix.
The embodiment of the application also provides electronic equipment, which comprises one or more processors and a storage device, wherein the storage device is used for storing one or more programs, and the electronic equipment is enabled to realize the target object relative speed determining method provided in the above embodiments when the one or more programs are executed by the one or more processors.
Fig. 6 shows a schematic diagram of a computer system suitable for use in implementing an embodiment of the application. It should be noted that, the computer system 600 of the electronic device shown in fig. 6 is only an example, and should not impose any limitation on the functions and the application scope of the embodiments of the present application.
As shown in fig. 6, the computer system 600 includes a central processing unit (Central Processing Unit, CPU) 601 that can perform various appropriate actions and processes, such as performing the methods described in the above embodiments, according to a program stored in a Read-Only Memory (ROM) 602 or a program loaded from a storage portion 608 into a random access Memory (Random Access Memory, RAM) 603. In the RAM 603, various programs and data required for system operation are also stored. The CPU 601, ROM 602, and RAM 603 are connected to each other through a bus 604. An Input/Output (I/O) interface 605 is also connected to bus 604.
Connected to the I/O interface 605 are an input section 606 including a keyboard, a mouse, and the like, an output section 607 including a display such as a Cathode Ray Tube (CRT), a Liquid crystal display (Liquid CRYSTAL DISPLAY, LCD), and a speaker, a storage section 608 including a hard disk, and the like, and a communication section 609 including a network interface card such as a LAN (Local Area Network) card, a modem, and the like. The communication section 609 performs communication processing via a network such as the internet. The drive 610 is also connected to the I/O interface 605 as needed. Removable media 611 such as a magnetic disk, an optical disk, a magneto-optical disk, a semiconductor memory, or the like is installed as needed on drive 610 so that a computer program read therefrom is installed as needed into storage section 608.
In particular, according to embodiments of the present application, the processes described above with reference to flowcharts may be implemented as computer software programs. For example, embodiments of the present application include a computer program product comprising a computer program embodied on a computer readable medium, the computer program comprising a computer program for performing the method shown in the flowchart. In such an embodiment, the computer program may be downloaded and installed from a network through the communication portion 609, and/or installed from the removable medium 611. When executed by a Central Processing Unit (CPU) 601, performs the various functions defined in the system of the present application.
It should be noted that, the computer readable medium shown in the embodiments of the present application may be a computer readable signal medium or a computer readable storage medium, or any combination of the two. The computer readable storage medium may be, for example, an electronic, magnetic, optical, electromagnetic, infrared, or semiconductor system, apparatus, or device, or any combination thereof. More specific examples of a computer-readable storage medium may include, but are not limited to, an electrical connection having one or more wires, a portable computer diskette, a hard disk, a Random Access Memory (RAM), a read-Only Memory (ROM), an erasable programmable read-Only Memory (Erasable Programmable Read Only Memory, EPROM), a flash Memory, an optical fiber, a portable compact disc read-Only Memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing. In the present application, a computer-readable signal medium may comprise a data signal propagated in baseband or as part of a carrier wave, with a computer-readable computer program embodied therein. Such a propagated data signal may take any of a variety of forms, including, but not limited to, electro-magnetic, optical, or any suitable combination of the foregoing. A computer readable signal medium may also be any computer readable medium that is not a computer readable storage medium and that can communicate, propagate, or transport a program for use by or in connection with an instruction execution system, apparatus, or device. A computer program embodied on a computer readable medium may be transmitted using any appropriate medium, including but not limited to wireless, wireline, etc., or any suitable combination of the foregoing.
The flowcharts and block diagrams in the figures illustrate the architecture, functionality, and operation of possible implementations of systems, methods and computer program products according to various embodiments of the present application. Where each block in the flowchart or block diagrams may represent a module, segment, or portion of code, which comprises one or more executable instructions for implementing the specified logical function(s). It should also be noted that, in some alternative implementations, the functions noted in the block may occur out of the order noted in the figures. For example, two blocks shown in succession may, in fact, be executed substantially concurrently, or the blocks may sometimes be executed in the reverse order, depending upon the functionality involved. It will also be noted that each block of the block diagrams or flowchart illustration, and combinations of blocks in the block diagrams or flowchart illustration, can be implemented by special purpose hardware-based systems which perform the specified functions or acts, or combinations of special purpose hardware and computer instructions.
The units involved in the embodiments of the present application may be implemented by software, or may be implemented by hardware, and the described units may also be provided in a processor. Wherein the names of the units do not constitute a limitation of the units themselves in some cases.
Another aspect of the present application also provides a computer-readable storage medium having stored thereon a computer program which, when executed by a processor of a computer, causes the computer to perform the target object relative velocity determination method as described above. The computer-readable storage medium may be included in the electronic device described in the above embodiment or may exist alone without being incorporated in the electronic device.
Another aspect of the application also provides a computer program product or computer program comprising computer instructions stored in a computer readable storage medium. The processor of the computer device reads the computer instructions from the computer-readable storage medium, and the processor executes the computer instructions, so that the computer device performs the target object relative velocity determination method provided in the above-described respective embodiments.
The above embodiments are merely illustrative of the principles of the present invention and its effectiveness, and are not intended to limit the invention. Modifications and variations may be made to the above-described embodiments by those skilled in the art without departing from the spirit and scope of the invention. It is therefore intended that all equivalent modifications and changes made by those skilled in the art without departing from the spirit and technical spirit of the present invention shall be covered by the appended claims.

Claims (10)

1.一种目标对象相对速度确定方法,其特征在于,所述目标对象的估计速度确定方法包括:1. A method for determining the relative velocity of a target object, characterized in that the method for determining the estimated velocity of the target object includes: 获取目标对象的多个雷达点的方位角,确定各所述雷达点的方位角正弦值和方位角余弦值;Acquire the azimuth angles of multiple radar points of the target object, and determine the azimuth sine and azimuth cosine values of each radar point; 基于各所述雷达点的方位角正弦值和方位角余弦值生成第一矩阵,确定第三矩阵,第二矩阵为所述第一矩阵的转置矩阵,所述第三矩阵为所述第一矩阵和所述第二矩阵的乘积;A first matrix is generated based on the azimuth sine and azimuth cosine values of each radar point, and a third matrix is determined. The second matrix is the transpose of the first matrix, and the third matrix is the product of the first matrix and the second matrix. 根据所述第三矩阵确定矩阵行列式值、第三矩阵的特征值;Determine the matrix determinant value and the eigenvalues of the third matrix based on the third matrix; 若所述矩阵行列式值大于第一预设阈值,且特征商大于第二预设阈值,按预设次数对所述第三矩阵引入正则化迭代优化第三矩阵,所述特征商为所述第三矩阵最大特征值与最小特征值的商;If the determinant of the matrix is greater than a first preset threshold and the feature quotient is greater than a second preset threshold, the third matrix is subjected to regularization iterative optimization for a preset number of times, and the feature quotient is the quotient of the maximum and minimum eigenvalues of the third matrix; 基于所述雷达点的地面径向速度、正则化处理后的第三矩阵和第二矩阵确定所述目标对象相对于本车的目标对象相对速度,所述雷达点的地面径向速度通过本车的纵向速度、横向速度和所述方位角确定,所述方位角通过所述本车的前毫米波雷达采集得到;The relative velocity of the target object with respect to the vehicle is determined based on the ground radial velocity of the radar point, the regularized third matrix, and the second matrix. The ground radial velocity of the radar point is determined by the longitudinal velocity, lateral velocity, and azimuth angle of the vehicle. The azimuth angle is acquired by the front millimeter-wave radar of the vehicle. 以及,所述预设次数为五次,所述第三矩阵引入正则化迭代处理五次后,若根据第三矩阵计算出的特征商仍大于第二预设阈值,则放弃该次所述目标对象的相对于本车的目标对象相对速度。Furthermore, the preset number of iterations is five. After the third matrix is introduced into regularization iterations five times, if the feature quotient calculated based on the third matrix is still greater than the second preset threshold, then the relative speed of the target object with respect to the target object of the vehicle in that iteration is abandoned. 2.根据权利要求1所述的目标对象相对速度确定方法,其特征在于,2. The method for determining the relative velocity of a target object according to claim 1, characterized in that, 所述第一矩阵为n*2的矩阵,n为所述目标对象的雷达点获取数目,所述第一矩阵的第一纵列为各所述雷达点的方位角余弦值,所述第一矩阵的第二纵列为各所述雷达点的方位角正弦值;The first matrix is an n*2 matrix, where n is the number of radar points acquired for the target object. The first column of the first matrix is the cosine value of the azimuth angle of each radar point, and the second column of the first matrix is the sine value of the azimuth angle of each radar point. 所述第二矩阵为所述第一矩阵的转置矩阵,所述第二矩阵为2*n的矩阵;The second matrix is the transpose of the first matrix, and the second matrix is a 2*n matrix; 所述第三矩阵为第二矩阵左乘所述第一矩阵,所述第三矩阵为2*2的矩阵。The third matrix is the second matrix multiplied by the first matrix on the left, and the third matrix is a 2*2 matrix. 3.根据权利要求1所述的目标对象相对速度确定方法,其特征在于,所述雷达点的地面径向速度包括:3. The method for determining the relative velocity of a target object according to claim 1, wherein the ground radial velocity of the radar point includes: 基于车身CAN收集车辆CAN信号,根据车身CAN信号得出车辆的纵向速度和横向速度;The vehicle's longitudinal and lateral speeds are obtained by collecting vehicle CAN signals based on the body CAN signals. 将车辆的纵向速度和横向速度分别投影到车辆与雷达点连线方向上,所述雷达点的地面径向速度为车辆的纵向速度在车辆与雷达点连线方向上的投影值加上车辆的横向速度在车辆与雷达点连线方向上的投影值。The vehicle's longitudinal and lateral velocities are projected onto the line connecting the vehicle and the radar point, respectively. The radial velocity of the radar point on the ground is the sum of the projection of the vehicle's longitudinal velocity onto the line connecting the vehicle and the radar point and the projection of the vehicle's lateral velocity onto the line connecting the vehicle and the radar point. 4.根据权利要求1所述的目标对象相对速度确定方法,其特征在于,若所述矩阵行列式值大于第一预设阈值,且特征商大于第二预设阈值,对所述第三矩阵进行正则化处理,包括步骤:4. The method for determining the relative velocity of a target object according to claim 1, characterized in that, if the determinant value of the matrix is greater than a first preset threshold and the feature quotient is greater than a second preset threshold, the third matrix is subjected to regularization processing, including the following steps: 引入正则化处理所述第三矩阵,得到优化的第三矩阵解集;By introducing regularization to the third matrix, an optimized solution set for the third matrix is obtained; 结合每次迭代后的第三矩阵计算特征商;判断每次迭代的特征商是否均大于第二预设阈值;若否,则认定计算出的所述雷达点的地面径向速度准确并保留;若是,则放弃该次计算出的所述雷达点的地面径向速度。The feature quotient is calculated by combining the third matrix after each iteration; it is determined whether the feature quotient of each iteration is greater than the second preset threshold; if not, the calculated ground radial velocity of the radar point is considered accurate and retained; if so, the calculated ground radial velocity of the radar point is discarded. 5.根据权利要求4所述的目标对象相对速度确定方法,其特征在于,所述第三矩阵引入正则化迭代处理包括步骤:5. The method for determining the relative velocity of a target object according to claim 4, characterized in that the regularization iterative processing of the third matrix includes the following steps: 对所述第三矩阵每进行一次正则化处理,计算正则化处理后的第三矩阵的特征商,若计算得到的第三矩阵特征商不大于第二预设阈值,则停止对所述第三矩阵进行L2正则化处理,保留根据正则化处理后的第三矩阵计算出的雷达点的地面径向速度。Each time the third matrix is regularized, the feature quotient of the regularized third matrix is calculated. If the calculated feature quotient of the third matrix is not greater than the second preset threshold, the L2 regularization of the third matrix is stopped, and the ground radial velocity of the radar point calculated based on the regularized third matrix is retained. 6.根据权利要求5所述的目标对象相对速度确定方法,其特征在于,所述第三矩阵引入正则化迭代处理还包括步骤:6. The method for determining the relative velocity of a target object according to claim 5, characterized in that the regularization iterative processing of the third matrix further includes the step of: 对所述第三矩阵每进行一次正则化处理,计算正则化处理后的第三矩阵的矩阵行列式值,若正则化处理后的第三矩阵的矩阵行列式值大于第一预设阈值,则放弃利用第三矩阵计算该次所述目标对象的相对于本车的目标对象相对速度。Each time the third matrix is regularized, the determinant of the regularized third matrix is calculated. If the determinant of the regularized third matrix is greater than a first preset threshold, the calculation of the relative speed of the target object with respect to the vehicle using the third matrix is abandoned. 7.根据权利要求5所述的目标对象相对速度确定方法,其特征在于,对所述第三矩阵进行正则化处理包括:7. The method for determining the relative velocity of a target object according to claim 5, characterized in that, the regularization processing of the third matrix includes: L1正则化处理或者L2正则化处理。L1 regularization or L2 regularization. 8.一种基于检测雷达估计目标速度的系统,其特征在于,包括:8. A system for estimating target velocity based on detection radar, characterized in that it comprises: 采集模块,获取目标对象的多个雷达点的方位角,确定获取雷达点方位角正弦值和方位角余弦值;The acquisition module obtains the azimuth angles of multiple radar points of the target object and determines the sine and cosine values of the azimuth angles of the acquired radar points. 计算模块,基于各所述雷达点的方位角正弦值和方位角余弦值生成第一矩阵,确定第三矩阵,第二矩阵为所述第一矩阵的转置矩阵,所述第三矩阵为所述第一矩阵和所述第二矩阵的乘积,基于所述雷达点的地面径向速度、正则化处理后的第三矩阵和第二矩阵确定所述目标对象相对于本车的目标对象相对速度;The calculation module generates a first matrix based on the azimuth sine and azimuth cosine values of each radar point, determines a third matrix, the second matrix is the transpose of the first matrix, and the third matrix is the product of the first matrix and the second matrix. Based on the ground radial velocity of the radar point, the regularized third matrix, and the second matrix, the relative velocity of the target object with respect to the vehicle is determined. 优化模块,根据所述第三矩阵确定矩阵行列式值、第三矩阵的特征值,若所述矩阵行列式值大于第一预设阈值,且特征商大于第二预设阈值,按预设次数对所述第三矩阵引入正则化迭代优化第三矩阵,所述特征商为所述第三矩阵最大特征值与最小特征值的商,以及,所述预设次数为五次,所述第三矩阵引入正则化迭代处理五次后,若根据第三矩阵计算出的特征商仍大于第二预设阈值,则放弃该次所述目标对象的相对于本车的目标对象相对速度。The optimization module determines the determinant value and eigenvalues of the third matrix based on the third matrix. If the determinant value is greater than a first preset threshold and the eigenvalue quotient is greater than a second preset threshold, the module introduces regularization iterative optimization of the third matrix for a preset number of iterations. The eigenvalue quotient is the quotient of the largest and smallest eigenvalues of the third matrix. The preset number of iterations is five. If, after five iterations of regularization, the eigenvalue quotient calculated based on the third matrix is still greater than the second preset threshold, the module abandons the relative speed of the target object with respect to the target object of the vehicle in that iteration. 9.一种电子设备,其特征在于,所述电子设备包括:9. An electronic device, characterized in that the electronic device comprises: 一个或多个处理器;One or more processors; 存储装置,用于存储一个或多个程序,当所述一个或多个程序被所述一个或多个处理器执行时,使得所述电子设备实现如权利要求1至7中任一项所述的目标对象相对速度确定方法。A storage device for storing one or more programs, which, when executed by the one or more processors, cause the electronic device to implement the target object relative velocity determination method as described in any one of claims 1 to 7. 10.一种计算机可读存储介质,其特征在于,其上存储有计算机程序,当所述计算机程序被计算机的处理器执行时,使计算机执行权利要求1至7中任一项所述的目标对象相对速度确定方法。10. A computer-readable storage medium, characterized in that it stores a computer program thereon, which, when executed by a computer's processor, causes the computer to perform the target object relative velocity determination method according to any one of claims 1 to 7.
CN202210912557.7A 2022-07-30 2022-07-30 A method, system, device, and medium for determining the relative velocity of a target object. Active CN115270066B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210912557.7A CN115270066B (en) 2022-07-30 2022-07-30 A method, system, device, and medium for determining the relative velocity of a target object.

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210912557.7A CN115270066B (en) 2022-07-30 2022-07-30 A method, system, device, and medium for determining the relative velocity of a target object.

Publications (2)

Publication Number Publication Date
CN115270066A CN115270066A (en) 2022-11-01
CN115270066B true CN115270066B (en) 2026-02-13

Family

ID=83746416

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210912557.7A Active CN115270066B (en) 2022-07-30 2022-07-30 A method, system, device, and medium for determining the relative velocity of a target object.

Country Status (1)

Country Link
CN (1) CN115270066B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115755080A (en) * 2022-11-30 2023-03-07 重庆长安汽车股份有限公司 Method, device, electronic device and vehicle for estimating speed of target object outside vehicle

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111712722A (en) * 2018-02-15 2020-09-25 罗伯特·博世有限公司 Estimate the lateral or Cartesian velocity of a point target with the aid of a radar sensor

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019118521A1 (en) * 2017-12-11 2019-06-20 The Regents Of The University Of California Accoustic beamforming
CN109143242B (en) * 2018-09-07 2020-04-14 百度在线网络技术(北京)有限公司 Obstacle absolute velocity estimation method, system, computer device, and storage medium
WO2021134441A1 (en) * 2019-12-31 2021-07-08 深圳元戎启行科技有限公司 Automated driving-based vehicle speed control method and apparatus, and computer device
CN114821526B (en) * 2022-04-14 2024-11-15 重庆长安汽车股份有限公司 Obstacle 3D bounding box detection method based on 4D millimeter wave radar point cloud

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111712722A (en) * 2018-02-15 2020-09-25 罗伯特·博世有限公司 Estimate the lateral or Cartesian velocity of a point target with the aid of a radar sensor

Also Published As

Publication number Publication date
CN115270066A (en) 2022-11-01

Similar Documents

Publication Publication Date Title
CN110531357B (en) Method and Radar Detection System for Estimating the Velocity of Moving Target in Horizontal Plane
US10613227B2 (en) Method and apparatus for positioning vehicle
EP3769091B1 (en) Wind flow sensing system for determining velocity fields of wind flow
US10366282B2 (en) Human detection apparatus and method using low-resolution two-dimensional (2D) light detection and ranging (LIDAR) sensor
CN110390237A (en) Processing Method of Point-clouds and system
CN102426700B (en) Level set SAR image segmentation method based on local and global area information
CN113486961A (en) Radar RD image target detection method and system based on deep learning under low signal-to-noise ratio and computer equipment
CN108196251A (en) Accelerated iteration regularization super-resolution imaging method based on vector extrapolation
CN115270066B (en) A method, system, device, and medium for determining the relative velocity of a target object.
CN105699950A (en) Radar clutter suppression method based on self-adaptive iteration forward and background smooth conjugate gradient
WO2021189420A1 (en) Data processing method and device
CN106772361A (en) A kind of implementation method of the ultra-broadband wall-through radar imagery algorithm based on FPGA
CN115047459A (en) Millimeter wave radar-based method for calculating vehicle speed and steering angle of vehicle
WO2020192182A1 (en) Indoor positioning method and system, and electronic device
US10740962B2 (en) Method and apparatus for uncertainty modeling of point cloud
CN115222692B (en) Method and device for identifying ground point cloud
CN110940994B (en) Positioning initialization method and system thereof
CN114152946B (en) SAR imaging method and system based on sparse and generalized total variation joint regularization
CN116027326A (en) A Feature Inversion Method and Device Based on 3D Imaging of Distributed Radar Targets
CN116311961A (en) Traffic jam detection method, device, electronic device and storage medium
CN114663478A (en) Method for estimating anchor point position according to multi-reference point prediction information
CN114216412B (en) A method, device and storage medium for obtaining angle information of traffic participants
CN116161040B (en) Parking space information generation method, device, electronic equipment and computer readable medium
Yang et al. Unsupervised radar point cloud enhancement via arbitrary lidar guided diffusion prior
WO2024011510A1 (en) Sound pressure evaluation method and apparatus based on model order reduction boundary element method, and terminal device

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
GR01 Patent grant
GR01 Patent grant
TA01 Transfer of patent application right

Effective date of registration: 20260209

Address after: 401135 Chongqing Yubei District Longxing Town Xindai Road 120 No. 1 Building

Applicant after: Chongqing Chang'an Technology Co.,Ltd.

Country or region after: China

Address before: 400023 Chongqing Jiangbei District, the new East Road, No. 260

Applicant before: Chongqing Changan Automobile Co.,Ltd.

Country or region before: China

TA01 Transfer of patent application right