Method, device, vehicle, storage medium, processor and program product for determining distance between vehicles

Through the calculation and screening of the vehicle attitude matrix, the distance between vehicles is accurately determined, which solves the problem of inaccurate distance calculation in the prior art, and improves the accuracy and safety of the blind spot detection system.

CN118358582BActive Publication Date: 2024-11-05CHINA FAW CO LTD
View PDF 5 Cites 0 Cited by

Patent Information

Application Number
CN202410791026.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-06-19
Publication Date
2024-11-05
Estimated Expiration
2044-06-19

AI Technical Summary

Technical Problem

The prior art is difficult to accurately determine the distance between vehicles, especially when sensor measurement data is inaccurate, resulting in the inability to determine the distance between the target vehicle and the host vehicle.

Method used

By determining the attitude matrix of the subject vehicle and the target vehicle, the position information between the vehicles is calculated based on these matrices, the shortest distance point is selected, and the first attitude matrix and the second attitude matrix are used to quantify the vehicles to accurately calculate the distance.

Benefits of technology

It realizes that the shortest distance between vehicles can be accurately determined when the sensor data is inaccurate, improves the accuracy and reliability of the blind spot detection system, and avoids potential dangers caused by distance calculation errors.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118358582B_ABST
    Figure CN118358582B_ABST
Patent Text Reader

Abstract

The present invention discloses a method, device, vehicle, storage medium, processor and program product for determining the distance between vehicles. The method comprises: determining a first posture matrix of a subject vehicle and a second posture matrix of a target vehicle, wherein the first posture matrix is ​​used to characterize the position of the subject vehicle, the second posture matrix is ​​used to characterize the position of the target vehicle, and the distance between the target vehicle and the subject vehicle is less than a distance threshold; based on the second posture matrix, determining a plurality of first position information corresponding to a plurality of corner points in the target vehicle, wherein the plurality of corner points are used to form the shape of the target vehicle; based on the first posture matrix, determining reference position information; based on the reference position information, filtering out target position information from a plurality of first position information; based on the target position information, determining the target distance between the subject vehicle and the target vehicle. The present invention solves the technical problem that the distance between vehicles cannot be accurately determined.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of vehicles, and in particular to a method, device, vehicle, storage medium, processor and program product for determining a distance between vehicles. Background Art

[0002] In the related art, the monitoring of obstacles in the blind spot of the subject vehicle, such as the monitoring of the target vehicle, is usually carried out through a sensor system, and the method for calculating the distance between the subject vehicle and the target vehicle usually relies on the data measured by the system. However, when the data cannot be accurately measured, there will be a technical problem that the distance between the target vehicle and the subject vehicle cannot be determined.

[0003] To address the above-mentioned problems, no effective solution has been proposed yet. Summary of the invention

[0004] Embodiments of the present invention provide a method, device, vehicle, storage medium, processor and program product for determining the distance between vehicles, so as to at least solve the technical problem that the distance between vehicles cannot be accurately determined.

[0005] According to one aspect of an embodiment of the present invention, a method for determining the distance between vehicles is provided, and the method may include: determining a first posture matrix of a subject vehicle and a second posture matrix of a target vehicle, wherein the first posture matrix is ​​used to characterize the position of the subject vehicle, the second posture matrix is ​​used to characterize the position of the target vehicle, and the distance between the target vehicle and the subject vehicle is less than a distance threshold; based on the second posture matrix, determining a plurality of first position information corresponding to a plurality of corner points in the target vehicle, wherein the plurality of corner points are used to constitute the shape of the target vehicle; based on the first posture matrix, determining reference position information; based on the reference position information, filtering out target position information from a plurality of first position information, wherein the target position information is used to determine the point in the target vehicle that is closest to the subject vehicle; based on the target position information, determining a target distance between the subject vehicle and the target vehicle.

[0006] Optionally, based on the second posture matrix, multiple first position information corresponding to multiple corner points in the target vehicle is determined, including: obtaining a constructed geodetic coordinate system; in the geodetic coordinate system, determining the origin position information corresponding to the origin in the local coordinate system of the target vehicle; based on the origin position information and the second posture matrix, determining the first position information of the corner point in the geodetic coordinate system.

[0007] Optionally, based on the reference position information, target position information is filtered out from multiple first position information, including: based on the reference position information and the multiple first position information, respectively determining the installation distances between multiple corner points and the reference point at the reference position information to obtain multiple installation distances, wherein the multiple installation distances correspond one-to-one to the multiple first position information; based on the multiple installation distances, filtering out the target position information from the multiple first position information.

[0008] Optionally, based on multiple installation distances, target location information is filtered out from multiple first location information, including: determining the minimum installation distance among the multiple installation distances as the first installation distance; and determining the first location information corresponding to the first installation distance as the target location information.

[0009] Optionally, based on the target position information, the target distance between the subject vehicle and the target vehicle is determined, including: based on the target position information, determining the target corner point whose first position information is the target coordinate information; determining the vector coordinates corresponding to the vector formed by the target corner point and the reference point in the body coordinate system of the target vehicle; based on the vector coordinates, determining a target point in the target vehicle whose distance from the subject vehicle meets the screening requirements; determining a first distance between the target point and the subject vehicle; and determining the first distance as the target distance.

[0010] Optionally, determining a first distance between a target point and a subject vehicle includes: determining second position information of the target point in a geodetic coordinate system; converting the second position information and reference position information into third position information; and determining the first distance based on the third position information.

[0011] Optionally, determining reference position information of the reference point based on the first posture matrix includes: determining reference coordinates of the reference point in a local coordinate system of the subject vehicle; and determining the reference position information based on the reference coordinates and the first posture matrix.

[0012] Optionally, the method may further include: in response to the target distance being less than a distance threshold, outputting a prompt message, wherein the prompt message is used to prompt that the subject vehicle is in danger during driving.

[0013] According to another aspect of an embodiment of the present invention, a device for determining the distance between vehicles is also provided, and the device may include: a first determination unit, used to determine a first posture matrix of a subject vehicle, and a second posture matrix of a target vehicle, wherein the first posture matrix is ​​used to characterize the position of the subject vehicle, the second posture matrix is ​​used to characterize the position of the target vehicle, and the distance between the target vehicle and the subject vehicle is less than a distance threshold; a second determination unit, used to determine a plurality of first position information corresponding to a plurality of corner points in the target vehicle based on the second posture matrix, wherein the plurality of corner points are used to characterize the shape of the target vehicle; a third determination unit, used to determine reference position information based on the first posture matrix; a screening unit, used to screen out target position information from a plurality of first position information based on the reference position information, wherein the target position information is used to determine the point in the target vehicle that is closest to the subject vehicle; and a fourth determination unit, used to determine the target distance between the subject vehicle and the target vehicle based on the target position information.

[0014] According to another aspect of an embodiment of the present invention, a computer-readable storage medium is further provided, the computer-readable storage medium including a stored program, wherein when the program is running, the device where the computer-readable storage medium is located is controlled to execute the method for determining the vehicle-to-vehicle distance of an embodiment of the present invention.

[0015] According to another aspect of an embodiment of the present invention, a processor is further provided, the processor being used to run a program, wherein when the program is run by the processor, the method for determining the distance between vehicles according to an embodiment of the present invention is executed.

[0016] According to another aspect of an embodiment of the present invention, a vehicle is further provided. The vehicle is used to execute the method for determining the inter-vehicle distance according to an embodiment of the present invention.

[0017] According to another aspect of an embodiment of the present invention, a computer program product is further provided. The computer program product includes a computer program. When the computer program is executed by a processor, the method for determining the distance between vehicles according to an embodiment of the present invention is implemented.

[0018] In an embodiment of the present invention, a first posture matrix of a subject vehicle and a second posture matrix of a target vehicle are determined, wherein the first posture matrix is ​​used to characterize the position of the subject vehicle, and the second posture matrix is ​​used to characterize the position of the target vehicle, and the distance between the target vehicle and the subject vehicle is less than a distance threshold; based on the second posture matrix, multiple first position information corresponding to multiple corner points in the target vehicle are determined, wherein the multiple corner points are used to form the shape of the target vehicle; based on the first posture matrix, reference position information is determined; based on the reference position information, target position information is screened out from multiple first position information, wherein the target position information is used to determine the point in the target vehicle closest to the subject vehicle; based on the target position information, the target distance between the subject vehicle and the target vehicle is determined. That is, in an embodiment of the present invention, the subject vehicle and the target vehicle are quantified using the first posture matrix and the second posture matrix, and multiple first position information corresponding to multiple corner points in the target vehicle are determined based on the second posture matrix, and the reference position information of the reference point is determined based on the first posture matrix. Based on the reference position information, the target position information in multiple first position information is screened out; based on the target position information, the shortest distance between the subject vehicle and the target vehicle can be accurately determined, thereby achieving the technical effect of accurately determining the target distance between vehicles, and solving the technical problem of being unable to accurately determine the distance between vehicles. BRIEF DESCRIPTION OF THE DRAWINGS

[0019] The drawings described herein are used to provide a further understanding of the present invention and constitute a part of the present invention. The exemplary embodiments of the present invention and their descriptions are used to explain the present invention and do not constitute an improper limitation of the present invention. In the drawings:

[0020] Figure 1 is a flow chart of a method for determining a distance between vehicles according to an embodiment of the present invention;

[0021] Figure 2 is a flow chart of a distance calculation method according to an embodiment of the present invention;

[0022] Figure 3 is a schematic diagram of location information according to an embodiment of the present invention;

[0023] Figure 4 is a schematic diagram of a device for determining a distance between vehicles according to an embodiment of the present invention. DETAILED DESCRIPTION

[0024] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.

[0025] It should be noted that the terms "first", "second", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.

[0026] Example 1

[0027] According to an embodiment of the present invention, an embodiment of a method for determining the distance between vehicles is provided. The steps shown in the flowchart of the accompanying drawings can be executed in a computer system such as a set of computer executable instructions, and although a logical order is shown in the flowchart, in some cases, the steps shown or described can be executed in an order different from that shown here.

[0028] In this embodiment, a method for determining the distance between vehicles is proposed, which can be used to determine the distance between a subject vehicle (e.g., a vehicle currently being driven) and a target vehicle (e.g., vehicles around the subject vehicle). Furthermore, the method quantifies the subject vehicle and the target vehicle using a first posture matrix and a second posture matrix, determines a plurality of first position information corresponding to a plurality of corner points in the target vehicle based on the second posture matrix, and determines the reference position information of the reference point based on the first posture matrix. Based on the reference position information, the target position information among the plurality of first position information is screened out; based on the target position information, the shortest distance between the subject vehicle and the target vehicle can be accurately determined, thereby achieving the technical effect of accurately determining the target distance between vehicles, and solving the technical problem of being unable to accurately determine the distance between vehicles.

[0029] Figure 1 FIG. 1 is a flow chart of a method for determining the distance between vehicles according to an embodiment of the present invention. Figure 1 As shown, the method may include the following steps:

[0030] Step S102, determining a first posture matrix of the subject vehicle and a second posture matrix of the target vehicle, wherein the first posture matrix is ​​used to characterize the position of the subject vehicle, the second posture matrix is ​​used to characterize the position of the target vehicle, and the distance between the target vehicle and the subject vehicle is less than a distance threshold.

[0031] In the technical solution provided in step S102 of the present invention, the attitude angle of the subject vehicle can be determined, and the first attitude matrix of the subject vehicle can be determined based on the attitude angle. The subject vehicle can be the vehicle currently being driven, which can be referred to as the subject vehicle. The attitude angle of the subject vehicle can be used to describe the angle of rotation of the subject vehicle in three-dimensional space, which can include pitch angle, roll angle and yaw angle, which can be expressed as The first attitude matrix can be used to describe the attitude (rotation and tilt) of the subject vehicle, can be used to determine the rotation and tilt of the vehicle in three-dimensional space, and can be used to characterize the position of the subject vehicle.

[0032] For example, the position of the local coordinate system corresponding to the subject vehicle relative to the origin of the earth coordinate system is determined as , the attitude angle is , then the first posture matrix ( ) can be determined by the following formula:

[0033]

[0034] If only the yaw angle ( ),but

[0035]

[0036] in, Can be used to characterize the roll angle; Can be used to characterize the pitch angle; Can be used to characterize the yaw angle.

[0037] In this embodiment, the attitude angle of the target vehicle can be determined, and the second attitude matrix of the target vehicle can be determined based on the attitude angle of the target vehicle. The target vehicle can be a vehicle passing within the target range of the subject vehicle, which can be referred to as the target vehicle, a motor vehicle, or a measured vehicle. The attitude angle of the target vehicle can be used to describe the angle of rotation of the target vehicle in the geodetic coordinate system, and can include a yaw angle. The second attitude matrix can be used to describe the attitude (rotation and tilt) of the target vehicle, can be used to determine the rotation and tilt of the vehicle in three-dimensional space, and can be used to characterize the position of the target vehicle.

[0038] Optionally, the distance between the target vehicle and the subject vehicle is less than a distance threshold.

[0039] For example, the origin of the local coordinate system of the target vehicle relative to the earth coordinate system is: , where T can be used to represent transpose. Furthermore, the yaw angle of the target vehicle relative to the earth coordinate system is , then the second posture matrix of the target vehicle ( )for:

[0040]

[0041] If only the rotation in the horizontal plane is considered, then:

[0042]

[0043] Optionally, the geodetic coordinate system may be a coordinate system pre-constructed by the modeling software. The local coordinate system of the subject vehicle may be a coordinate system constructed by taking the two rear wheels of the subject vehicle as the x-axis and the point between the two rear wheels as the origin. The local coordinate system of the target vehicle may be a coordinate system constructed by taking the two rear wheels of the local vehicle as the x-axis and the point between the two rear wheels as the origin.

[0044] Optionally, when the subject vehicle is driving, if there is a vehicle driving near the subject vehicle and the distance between the vehicle and the subject vehicle is less than a distance threshold, the vehicle can be determined as the target vehicle. The distance threshold can be a value predetermined by a method such as a test.

[0045] Step S104: determining a plurality of first position information corresponding to a plurality of corner points in the target vehicle based on the second posture matrix, wherein the plurality of corner points are used to form a shape of the target vehicle.

[0046] In the technical solution provided in the above step S104 of the present invention, multiple first position information corresponding to multiple corner points in the target vehicle can be determined based on the second posture matrix. Among them, the multiple corner points can be four corner points of the target vehicle, which can be used to determine four positioning points in the target vehicle, and can be used to locate the target vehicle. After the four corner points are connected, they can be used to determine the shape of the target vehicle. For example, the target vehicle can be converted into a rectangular parallelepiped, and the four corner points can be four inflection points in the rectangular parallelepiped. The first position information can be used to determine the coordinates of the multiple corner points in the geodetic coordinate system, for example, Etc., which is only an example here, and there is no specific limitation on the form of expression of the first location information.

[0047] Optionally, the second posture matrix is ​​further calculated to obtain the first position information, wherein the number of the first position information is the same as the number of the corner points, and the plurality of first position information and the plurality of corner points correspond one to one.

[0048] Step S106: Determine reference position information based on the first posture matrix.

[0049] In the technical solution provided in the above step S106 of the present invention, the first posture matrix is ​​determined, and based on the first posture matrix, the reference position information of the reference point can be determined. The reference point can be a point deployed in the subject vehicle, or a radar installation point in the subject vehicle, for example, near the rear taillight of the subject vehicle. The reference position information can be used to determine the deployment position of the reference point, which can be a radar installation point, and can be used to characterize the position of the radar installation point in the geodetic coordinate system, which can be ( )express.

[0050] Optionally, in order to improve the accuracy of the distance test between the two vehicles, a radar may be installed in the main vehicle, and the radar installation point may be determined as a reference point. Based on the first posture matrix, reference position information of the reference point may be determined.

[0051] Step S108, based on the reference position information, filter out target position information from the plurality of first position information, wherein the target position information is used to determine the point in the target vehicle that is closest to the subject vehicle.

[0052] In the technical solution provided in step S108 of the present invention, the target position information can be screened out from the plurality of first position information based on the reference position information. The target position information can be the position information corresponding to the point in the target vehicle closest to the subject vehicle, and can be used to determine the point in the target vehicle closest to the subject vehicle.

[0053] Optionally, based on the reference position information, a point among the four corner points that is closest to the reference point may be determined, and the first position information of the point may be determined as the target position information.

[0054] Step S110, determining a target distance between the subject vehicle and the target vehicle based on the target position information.

[0055] In the technical solution provided in the above step S110 of the present invention, based on the target position information, the closest point in the target vehicle to the subject vehicle can be determined, and further, the distance between the closest point and the subject vehicle can be determined to achieve the purpose of determining the target distance between the subject vehicle and the target vehicle. The target distance can be the shortest distance between the subject vehicle and the target vehicle.

[0056] Through the above-mentioned step S102 and step S110 of the present invention, the first posture matrix of the subject vehicle and the second posture matrix of the target vehicle are determined, wherein the first posture matrix is ​​used to characterize the position of the subject vehicle, and the second posture matrix is ​​used to characterize the position of the target vehicle, and the distance between the target vehicle and the subject vehicle is less than the distance threshold; based on the second posture matrix, multiple first position information corresponding to multiple corner points in the target vehicle are determined, wherein the multiple corner points are used to form the shape of the target vehicle; based on the first posture matrix, reference position information is determined; based on the reference position information, target position information is screened out from multiple first position information, wherein the target position information is used to determine the point in the target vehicle closest to the subject vehicle; based on the target position information, the target distance between the subject vehicle and the target vehicle is determined. That is, in an embodiment of the present invention, the first posture matrix and the second posture matrix are used to quantify the subject vehicle and the target vehicle, based on the second posture matrix, multiple first position information corresponding to multiple corner points in the target vehicle are determined, and based on the first posture matrix, the reference position information of the reference point is determined. Based on the reference position information, the target position information among the multiple first position information is screened out; based on the target position information, the shortest distance between the subject vehicle and the target vehicle can be accurately determined, thereby achieving the technical effect of accurately determining the target distance between vehicles, solving the technical problem of being unable to accurately determine the distance between vehicles.

[0057] The above method of this embodiment is further introduced below.

[0058] As an optional implementation, step S104, based on the second posture matrix, determines multiple first position information corresponding to multiple corner points in the target vehicle, including: obtaining a constructed geodetic coordinate system; in the geodetic coordinate system, determining the origin position information corresponding to the origin in the local coordinate system of the target vehicle; based on the origin position information and the second posture matrix, determining the first position information of the corner point in the geodetic coordinate system.

[0059] In this embodiment, after obtaining the second posture matrix, the first position information can be determined by the following steps: a constructed geodetic coordinate system can be obtained; in the geodetic coordinate system, the origin position information corresponding to the origin in the local coordinate system of the target vehicle can be determined; based on the origin position information and the second posture matrix, the first position information of the corner point in the geodetic coordinate system can be determined. Among them, the geodetic coordinate system can be constructed in advance according to experiments or randomly for the modeling model. It should be noted that this is only an example, and there is no specific limitation on the method of constructing the geodetic coordinate system. The origin position information can be used to determine the position of the origin in the geodetic coordinate system, which can be used It should be noted that this is only an example and there is no specific limitation on the form of expression of the origin position information.

[0060] For example, determine the size information of the target vehicle and obtain the distance from the origin of the target coordinate system to the front point of the target vehicle ( ), and the distance from the origin of the target coordinate system to the rear point of the target vehicle ( ). In the geodetic coordinate system, the origin position information corresponding to the origin in the local coordinate system of the target vehicle can be determined. Based on the origin position information and the second posture matrix ( ), the first position information of the corner point in the geodetic coordinate system can be determined by the following formula:

[0061]

[0062]

[0063]

[0064] Where W can be used to represent the width of the vehicle. ) can be used to ensure the first position information corresponding to the first corner point, and the first corner point can be the corner point in front of the right side of the vehicle. ) can be used to ensure the first position information corresponding to the second corner point, and the second corner point can be the corner point at the right rear of the vehicle. ) can be used to ensure the first position information corresponding to the third corner point, and the third corner point can be the corner point at the left rear of the vehicle. ) can be used to ensure the first position information corresponding to the fourth corner point, and the fourth corner point can be the corner point in the left front of the vehicle. It should be noted that the calculation formula of the corner point here can be changed according to the position of the corner point, and no specific limitation is made here.

[0065] In this embodiment, in order to improve the accuracy of data processing, the nearest point in the target vehicle with the same height as the reference point can be determined, so that in the process of determining the target distance, only the calculation in the horizontal plane can be considered. It should be noted that this embodiment is not limited to this calculation method, and the calculation method can be adjusted according to actual conditions. As long as the method of determining the target distance using the reference point and the posture matrix should be within the protection scope of the present invention.

[0066] As an optional implementation, step S108, based on the reference position information, filters out the target position information from the multiple first position information, including: based on the reference position information and the multiple first position information, respectively determining the installation distances between the multiple corner points and the reference point at the reference position information to obtain multiple installation distances, wherein the multiple installation distances correspond one-to-one to the multiple first position information; based on the multiple installation distances, filtering out the target position information from the multiple first position information.

[0067] In this embodiment, based on the reference position information ( ) and multiple first position information, respectively determine the installation distances between multiple corner points and the reference point, and obtain multiple installation distances; based on the multiple installation distances, the target position information can be filtered out from the multiple first position information. Among them, the multiple installation distances correspond to the multiple first position information one by one, which can be used to characterize the distance between the corner point and the reference point, and can be used and express.

[0068] Optionally, the installation distance between each of the four corner points and the radar installation point can be determined by the following formula:

[0069]

[0070] As an optional implementation, based on multiple installation distances, target location information is filtered out from multiple first location information, including: determining the minimum installation distance among the multiple installation distances as the first installation distance; and determining the first location information corresponding to the first installation distance as the target location information.

[0071] In this embodiment, the minimum installation distance among multiple installation distances can be determined, the minimum installation distance can be determined as the first installation distance, and the first position information corresponding to the first installation distance can be determined as the target position information, wherein the first installation distance is smaller than other installation distances among the multiple installation distances except the first installation distance.

[0072] Optionally, the installation distances between multiple corner points and the reference point are determined respectively, and the minimum value of the multiple installation distances is determined as the first installation distance.

[0073] For example, the distances between corner point one, corner point two, corner point three and corner point four and the reference point are determined respectively to obtain multiple installation distances. If the installation distance between corner point one and the reference point is smaller than the installation distances between other corner points and the reference point, the installation distance between corner point one and the reference point can be determined as the first installation distance, and the first position information of corner point one can be determined as the target position information.

[0074] As an optional implementation, based on the target position information, the target distance between the subject vehicle and the target vehicle is determined, including: based on the target position information, determining the target corner point whose first position information is the target coordinate information; in the body coordinate system of the target vehicle, determining the vector coordinates corresponding to the vector formed by the target corner point and the reference point; based on the vector coordinates, determining the target point in the target vehicle whose distance from the subject vehicle meets the screening requirements; determining the first distance between the target point and the subject vehicle; and determining the first distance as the target distance.

[0075] In this embodiment, the target position information is determined, and based on the target position information, the corner point whose first position information is the target coordinate information among the multiple corner points can be determined as the target corner point. In the body coordinate system of the target vehicle, the vector coordinates corresponding to the vector formed by the target corner point and the reference point can be determined; based on the vector coordinates, the distance between the target point and the subject vehicle in the target vehicle is determined to be the target point that meets the screening requirements, and the screening requirement here can be the shortest distance; the first distance between the target point and the subject vehicle is determined; and the first distance is determined as the target distance.

[0076] Optionally, the above vector coordinates may be the coordinates of the vector formed by the target point to the reference point in the body coordinate system of the target vehicle, which can be expressed as ( )、( )、( )、( ) indicates that it should be noted that the representation method here is only for illustration and is not specifically limited. The above target point can be the point in the target vehicle that is closest to the main vehicle. The first distance can be used to represent the distance between the closest point and the reference point.

[0077] For example, the multiple corner points may be: corner point 1 at the right front of the target vehicle; corner point 2 at the right rear of the target vehicle; corner point 3 at the left rear of the target vehicle, and corner point 4 at the left front of the target vehicle. Determine the target corner point among the multiple corner points. If the installation distance between corner point 1 and the reference point is the first installation distance, then corner point 1 may be determined as the target corner point. If the target corner point is the right front corner point of the target vehicle (corner point 1), the vector coordinates of the vector constructed by the target corner point and the reference point in the body coordinate system of the target vehicle may be determined by the following formula:

[0078]

[0079]

[0080] in, Can be used to represent vector coordinates; It can be used to represent the vector coordinates of a reference point in two-dimensional space. For example, it can be used to determine the location of a radar installation point.

[0081] Furthermore, if the vector coordinates , we can determine that the target point (that is, the point in the target vehicle closest to the main vehicle) is on the edge connecting corner point 1 and corner point 2. Therefore, we can determine the position of the target point in the main body coordinate system of the target vehicle (Posmin) as:

[0082]

[0083] if , then the nearest point is on the edge connecting corner point 1 and corner point 4. Therefore, the position of the target point in the body coordinate system of the target vehicle can be determined as:

[0084]

[0085] Otherwise, the target point is corner point 1, then:

[0086]

[0087] If the target corner point is the second corner point in the target vehicle, the vector constructed by the target corner point and the reference point can be determined by the following formula. The vector coordinates in the body coordinate system of the target vehicle are ( ):

[0088]

[0089]

[0090] if , then the target point is on the edge connecting corner point 1 and corner point 2. Therefore, the position of the target point in the body coordinate system of the target vehicle can be determined as:

[0091]

[0092] if , then the target point is on the edge connecting corner point 2 and corner point 3. Therefore, the position of the target point in the body coordinate system of the target vehicle can be determined as:

[0093]

[0094] Otherwise, the target point is corner point 2. Therefore, the position of the target point in the body coordinate system of the target vehicle can be determined as:

[0095]

[0096] If the target corner point is the third corner point in the target vehicle, the vector constructed by the target corner point and the reference point can be determined by the following formula. The vector coordinates in the body coordinate system of the target vehicle are ( ):

[0097]

[0098]

[0099] if , we can determine that the target point is on the edge connecting corner points 3 and 4. Therefore, we can determine the position of the target point in the body coordinate system of the target vehicle as:

[0100]

[0101] if , we can determine that the target point is on the edge connecting corner point 2 and corner point 3. Therefore, we can determine the position of the target point in the body coordinate system of the target vehicle as:

[0102]

[0103] Otherwise, in other cases, the target point can be determined to be corner point 3. Therefore, the position of the target point in the body coordinate system of the target vehicle can be determined as:

[0104]

[0105] If the target corner point is the fourth corner point in the target vehicle, the vector constructed by the target corner point and the reference point can be determined by the following formula. The vector coordinates in the body coordinate system of the target vehicle are ( ):

[0106]

[0107]

[0108] if , we can determine that the target point is on the edge connecting corner points 3 and 4. Therefore, we can determine the position of the target point in the body coordinate system of the target vehicle as:

[0109]

[0110] if , we can determine that the target point is on the edge connecting corner point 1 and corner point 4. Therefore, we can determine the position of the target point in the body coordinate system of the target vehicle as:

[0111]

[0112] Otherwise, in other cases, the target point can be determined to be corner point 4. Therefore, the position of the target point in the body coordinate system of the target vehicle can be determined as:

[0113]

[0114] Further, after determining the position of the target point in the body coordinate system of the target vehicle, a first distance between the target point and the subject vehicle can be determined based on the determined position, and the first distance can be determined as the target distance.

[0115] As an optional implementation, determining the first distance between the target point and the subject vehicle includes: determining second position information of the target point in a geodetic coordinate system; converting the second position information and reference position information into third position information; and determining the first distance based on the third position information.

[0116] In this embodiment, the second position information of the target point in the geodetic coordinate system can be determined; the second position information and the reference position information can be converted into third position information; based on the third position information, the first distance can be determined, wherein the second position information can be used to characterize the position of the target point in the geodetic coordinate system.

[0117] Optionally, based on the position of the target point in the body coordinate system of the target vehicle, the second position information of the target point in the earth coordinate system can be determined, and the coordinates can be determined by the following formula:

[0118]

[0119] Since the coordinate value of the target point in the geodetic coordinate system in the z direction is the same as the coordinate value of the radar in the z direction, the second position information of the target point in the geodetic coordinate system can be determined as: .

[0120] Further, the second position information and the reference position information are converted into third position information ( ), that is, to determine the coordinate value of the vector from the radar to the target point in the geodetic coordinate system, which can be determined by the following formula:

[0121]

[0122] Optionally, the first distance can be determined based on the third position information by the following steps: the rotation angle of the reference point relative to the body coordinate system of the subject vehicle is , then its attitude matrix relative to the main vehicle's body coordinate system is:

[0123]

[0124] The position of the target point in the body coordinate system of the reference point is:

[0125]

[0126] in, is the first posture matrix The transposed matrix of is the attitude matrix of the radar's body coordinate system relative to the main vehicle's body coordinate system The transposed matrix of .

[0127] Optionally, based on the calculated position, a first distance may be determined.

[0128] Optionally, the body coordinate system of the reference point may be a coordinate system constructed with the reference point as the origin.

[0129] As an optional implementation, step S106, determining reference position information based on the first posture matrix, includes: determining reference coordinates of the reference point in the local coordinate system of the subject vehicle; and determining reference position information based on the reference coordinates and the first posture matrix.

[0130] In this embodiment, the reference coordinates of the reference point can be determined in the local coordinate system of the subject vehicle ( ), based on the reference coordinates and the first posture matrix, the reference position information can be determined, and the reference position information can be determined by the following formula:

[0131]

[0132] The reference position information may be used to determine the position of the reference point in the earth coordinate system.

[0133] As an optional implementation, the method may further include: in response to the target distance being less than a distance threshold, outputting a prompt message, wherein the prompt message is used to prompt the subject vehicle that there is danger during the driving process.

[0134] In this embodiment, after determining the target distance, it can be determined whether the target distance is less than the distance threshold, and if the target distance is less than the distance threshold, a prompt message can be output. The prompt message can be text, voice, pattern, etc., and can be sent through a microphone, software in the terminal, etc., and can be used to prompt that the distance between the subject vehicle and the target vehicle is too close, and the subject vehicle will be in danger during driving.

[0135] In the embodiment of the present invention, the subject vehicle and the target vehicle are quantified using the first posture matrix and the second posture matrix, and multiple first position information corresponding to multiple corner points in the target vehicle are determined based on the second posture matrix, and the reference position information of the reference point is determined based on the first posture matrix. Based on the reference position information, the target position information in the multiple first position information is screened out; based on the target position information, the shortest distance between the subject vehicle and the target vehicle can be accurately determined, thereby achieving the technical effect of accurately determining the target distance between vehicles, and solving the technical problem of being unable to accurately determine the distance between vehicles.

[0136] Example 2

[0137] The technical solution of the embodiment of the present invention is illustrated below in conjunction with preferred implementation modes.

[0138] At present, the blind spot detection system (BSD) is a sensor system used in the vehicle's autonomous driving function to detect obstacles in the vehicle's blind spot. The method for calculating the distance between the subject vehicle and the target vehicle usually relies on the data measured by the system. Among them, the blind spot detection system can monitor the environment around the subject vehicle in real time through a sensor array installed around the vehicle.

[0139] In the related art, the distance between the main vehicle and the target vehicle can be calculated by the following steps: Determine the relative position of the main vehicle and the target vehicle, which can be achieved by installing a positioning device such as a global positioning system (GPS) or an inertial measurement unit (IMU) on the main vehicle, and installing a corresponding positioning device on the target vehicle. Alternatively, the distance between the main vehicle and the target vehicle can be measured by sensors such as laser radar, ultrasonic sensors, or millimeter wave radars. The above sensors can send signals and receive signals reflected by the target vehicle, and calculate the distance by calculating the signal propagation time difference or phase difference. The driving speed and direction of the main vehicle and the target vehicle can be simulated, for example, using a kinematic model or a dynamic model to predict the future position and trajectory of the target vehicle. Based on the prediction, the BSD system can determine whether there is a risk of collision and take corresponding warning or control measures to avoid the collision.

[0140] However, in practical applications, the above method usually considers the target vehicle and the main vehicle as a particle, without considering the large size and volume of the vehicle, and is affected by factors such as sensor errors and vehicle dynamic changes. Errors will also occur during the data processing process, resulting in technical problems such as being unable to accurately determine the distance between vehicles.

[0141] Therefore, in order to solve the above problems and improve the accuracy and reliability of the BSD system, a more accurate distance calculation method is proposed in this embodiment, which quantifies the vehicle state by using the attitude matrix through the conversion between the local coordinate system of the vehicle and the earth coordinate system, taking into account the attitude angle of the vehicle. The point and distance closest to the main vehicle in the target vehicle around the main vehicle are calculated to obtain the target distance between the main vehicle and the target vehicle, thereby achieving the technical effect of accurately determining the target distance between vehicles and solving the technical problem of being unable to accurately determine the distance between vehicles.

[0142] The following will be combined with the accompanying drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments; the size of the numbers in the embodiments is only for illustration and is not specifically limited here. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of the present invention and are not specifically limited here.

[0143] Figure 2 is a flow chart of a distance calculation method according to an embodiment of the present invention. Figure 2 As shown, the method may include the following steps:

[0144] Step S202, determining a first posture matrix of the subject vehicle.

[0145] In this embodiment, the attitude angle of the subject vehicle can be determined, and the first attitude matrix of the subject vehicle can be determined based on the attitude angle. The subject vehicle can be the vehicle currently being driven, which can be referred to as the subject vehicle. The attitude angle of the subject vehicle can be used to describe the angle of rotation of the subject vehicle in three-dimensional space, which can include pitch angle, roll angle and yaw angle, which can be expressed as The first attitude matrix can be used to describe the attitude (rotation and tilt) of the subject vehicle, can be used to determine the rotation and tilt of the vehicle in three-dimensional space, and can be used to characterize the position of the subject vehicle.

[0146] For example, Figure 3 is a schematic diagram of location information according to an embodiment of the present invention. Figure 3 As shown, the origin 303 of the local coordinate system corresponding to the subject vehicle 301 is determined ( ) relative to the geodetic coordinate system is , the attitude angle is , then the first posture matrix ( ) can be determined by the following formula:

[0147]

[0148] If only the yaw angle ( ),but

[0149]

[0150] in, Can be used to characterize the roll angle; Can be used to characterize the pitch angle; Can be used to characterize the yaw angle.

[0151] Step S204: determine the reference position information of the reference point.

[0152] In this embodiment, the reference point 304 may be an installation point of a radar in the subject vehicle 301 , or may be near a rear taillight of the vehicle.

[0153] Optionally, in the local coordinate system of the subject vehicle 301, the reference coordinates of the reference point 304 (also referred to as point R) are determined ( ), based on the reference coordinates and the first posture matrix, the reference position information can be determined, and the reference position information can be determined by the following formula:

[0154]

[0155] The reference position information may be used to determine the position of the reference point 304 in the earth coordinate system.

[0156] Step S206, determining a second posture matrix of the target vehicle.

[0157] In this embodiment, the attitude angle of the target vehicle 302 may be determined, and the second attitude matrix of the target vehicle 302 may be determined based on the attitude angle of the target vehicle 302 .

[0158] Optionally, the origin 305 of the local coordinate system of the target vehicle 302 ( ) relative to the geodetic coordinate system can be: , the yaw angle of the target vehicle 302 relative to the earth coordinate system is , then the second posture matrix of the target vehicle 302 ( ) can be:

[0159]

[0160] If only the rotation in the horizontal plane is considered, then:

[0161]

[0162] Alternatively, the geodetic coordinate system may be a coordinate system pre-constructed by the modeling software. The local coordinate system of the subject vehicle 301 may be a coordinate system constructed by taking the two rear wheels of the subject vehicle 301 as the x-axis and the point between the two rear wheels as the origin. The local coordinate system of the target vehicle 302 may be a coordinate system constructed by taking the two rear wheels of the local vehicle as the x-axis and the point between the two rear wheels as the origin.

[0163] Optionally, when the subject vehicle is driving, if there is a vehicle driving near the subject vehicle and the distance between the vehicle and the subject vehicle is less than a distance threshold, the vehicle can be determined as the target vehicle. The distance threshold can be a value predetermined by a method such as a test.

[0164] Step S208, calculating the coordinates of the four corner points of the target vehicle in the geodetic coordinate system.

[0165] In this embodiment, the size information of the target vehicle 302 can be determined, and the distance from the origin of the target coordinate system to the front point of the target vehicle 302 can be obtained ( ), and the distance from the origin of the target coordinate system to the rear point of the target vehicle 302 ( In the geodetic coordinate system, the origin position information corresponding to the origin 305 in the local coordinate system of the target vehicle 302 can be determined ( ). Based on the origin position information and the second attitude matrix, the first position information of the corner point in the earth coordinate system can be determined. The first position information can be determined by the following formula:

[0166]

[0167]

[0168]

[0169] Where W can be used to represent the width of the vehicle. ) can be used to ensure the first position information corresponding to the corner point 306, and the corner point 306 can be the corner point in the right front of the vehicle. ) can be used to ensure the first position information corresponding to the corner point 307, and the corner point 307 can be the corner point at the right rear of the vehicle. ) can be used to ensure the first position information corresponding to the corner point 308, and the corner point 308 can be the corner point at the left rear of the vehicle. ) can be used to ensure the first position information corresponding to the corner point 309, and the corner point 309 can be the corner point in the left front of the vehicle. It should be noted that the calculation formula of the corner point here can be changed according to the position of the corner point, and no specific limitation is made here.

[0170] Step S210, determining the installation distances between the four corner points and the reference point.

[0171] In this embodiment, in order to improve the accuracy of data processing, the nearest point in the target vehicle with the same height as the reference point can be determined, so that in the process of determining the target distance, only the calculation in the horizontal plane can be considered. It should be noted that this embodiment is not limited to this calculation method, and the calculation method can be adjusted according to actual conditions. As long as the method of determining the target distance using the reference point and the posture matrix should be within the protection scope of the present invention.

[0172] In this embodiment, the installation distances between the four corner points and the radar installation point can be determined. It should be noted that the number of corner points can be increased or decreased according to actual conditions, and the number here is only an example and is not specifically limited.

[0173] The installation distance between each of the four corner points and the radar installation point can be determined by the following formula:

[0174]

[0175] Step S212, determining a target point in the target vehicle based on the closest point among the four corner points.

[0176] In this embodiment, the target point may be the point in the target vehicle that is closest to the subject vehicle.

[0177] In this embodiment, it is determined , The minimum value among the plurality of corner points, that is, the target corner point among the plurality of corner points is determined. If the installation distance between the corner point 306 and the reference point 304 is the first installation distance, the corner point 306 can be determined as the target corner point. If the target corner point is the right front corner point (corner point 306) of the target vehicle 302, the vector coordinates of the vector constructed by the target corner point and the reference point 304 in the body coordinate system of the target vehicle 302 can be determined by the following formula:

[0178]

[0179]

[0180] in, Can be used to represent vector coordinates.

[0181] Furthermore, if the vector coordinates , it can be determined that the target point (that is, the point in the target vehicle 302 that is closest to the subject vehicle 301) is on the edge connecting the corner point 306 and the corner point 307. Therefore, the position (Posmin) of the target point in the body coordinate system of the target vehicle 302 can be determined as:

[0182]

[0183] if , then the target point is on the edge connecting corner point 306 and corner point 309. Therefore, the position of the target point in the body coordinate system of the target vehicle 302 can be determined as:

[0184]

[0185] Otherwise, the target point is corner point 306, then:

[0186]

[0187] If the target corner point is a corner point 307 in the target vehicle 302, the vector constructed by the target corner point and the reference point 304 can be determined by the following formula. The vector coordinates in the body coordinate system of the target vehicle 302 are ( ):

[0188]

[0189]

[0190] if , then the target point is on the edge connecting corner point 306 and corner point 307. Therefore, the position of the target point in the body coordinate system of the target vehicle 302 can be determined as:

[0191]

[0192] if , then the target point is on the edge connecting corner point 307 and corner point 308. Therefore, the position of the target point in the body coordinate system of the target vehicle 302 can be determined as:

[0193]

[0194] Otherwise, the target point is the corner point 307. Therefore, the position of the target point in the body coordinate system of the target vehicle 302 can be determined as:

[0195]

[0196] If the target corner point is a corner point 308 in the target vehicle 302, the vector constructed by the target corner point and the reference point 304 can be determined by the following formula. The vector coordinates in the body coordinate system of the target vehicle 302 are ( ):

[0197]

[0198]

[0199] if , it can be determined that the target point is on the edge connecting corner point 308 and corner point 309. Therefore, the position of the target point in the body coordinate system of the target vehicle 302 can be determined as:

[0200]

[0201] if , it can be determined that the target point is on the edge connecting corner point 307 and corner point 308. Therefore, the position of the target point in the body coordinate system of the target vehicle 302 can be determined as:

[0202]

[0203] Otherwise, in other cases, the target point can be determined to be the corner point 308, and therefore, the position of the target point in the body coordinate system of the target vehicle 302 can be determined as:

[0204]

[0205] If the target corner point is a corner point 309 in the target vehicle 302, the vector constructed by the target corner point and the reference point 304 can be determined by the following formula. The vector coordinates in the body coordinate system of the target vehicle 302 are ( ):

[0206]

[0207]

[0208] if , it can be determined that the target point is on the edge connecting corner point 308 and corner point 309. Therefore, the position of the target point in the body coordinate system of the target vehicle 302 can be determined as:

[0209]

[0210] if , it can be determined that the target point is on the edge connecting corner point 306 and corner point 309. Therefore, the position of the target point in the body coordinate system of the target vehicle 302 can be determined as:

[0211]

[0212] Otherwise, in other cases, the target point can be determined to be the corner point 309. Therefore, the position of the target point in the body coordinate system of the target vehicle 302 can be determined to be:

[0213]

[0214] Further, after determining the position of the target point in the body coordinate system of the target vehicle 302, the first distance between the target point and the subject vehicle 301 can be determined based on the determined position, and the first distance can be determined as the target distance.

[0215] Step S214, determining the position information of the target point in the local coordinate system of the radar.

[0216] In this embodiment, based on the position of the target point in the body coordinate system of the target vehicle 302, the second position information of the target point in the earth coordinate system can be determined, and the coordinates can be determined by the following formula:

[0217]

[0218] Since the coordinate value of the target point in the geodetic coordinate system in the z direction is the same as the coordinate value of the radar in the z direction, the second position information of the target point in the geodetic coordinate system can be determined as: .

[0219] Further, the second position information and the reference position information are converted into third position information ( ), that is, to determine the coordinate value of the vector from the radar to the target point in the geodetic coordinate system, which can be determined by the following formula:

[0220]

[0221] Optionally, the first distance can be determined based on the third position information by the following steps: the rotation angle of the reference point 304 relative to the body coordinate system of the subject vehicle 301 is , then its attitude matrix relative to the body coordinate system of the subject vehicle 301 is:

[0222]

[0223] The position of the target point in the body coordinate system of the reference point 304 is:

[0224]

[0225] in, is the first posture matrix The transposed matrix of is the attitude matrix of the radar's body coordinate system relative to the body coordinate system of the subject vehicle 301 The transposed matrix of .

[0226] Optionally, based on the position of the target point in the body coordinate system of the reference point, the position of the target point from the origin in the body coordinate system of the reference point can be determined, and the position can be determined as the first distance.

[0227] In an embodiment of the present invention, a specific method for calculating the closest point between the main vehicle and the target vehicle in a blind spot monitoring system is proposed. The method selects the detection height of the closest point as the same height as the radar, converts the three-dimensional calculation into a horizontal plane, greatly reduces the amount of calculation, improves the calculation efficiency, and effectively increases the sensitivity of the blind spot monitoring system. The main vehicle and the target vehicle are quantified using the first posture matrix and the second posture matrix. Based on the second posture matrix, multiple first position information corresponding to multiple corner points in the target vehicle is determined. Based on the first posture matrix, the reference position information of the reference point is determined. Based on the reference position information, the target position information among the multiple first position information is screened out; based on the target position information, the shortest distance between the main vehicle and the target vehicle can be accurately determined, thereby achieving the technical effect of accurately determining the target distance between vehicles and solving the technical problem of being unable to accurately determine the distance between vehicles.

[0228] Example 3

[0229] According to an embodiment of the present invention, a device for determining the distance between vehicles is also provided. It should be noted that the device for determining the distance between vehicles of this embodiment can be used to execute the method for determining the distance between vehicles of embodiment 1 of the present invention.

[0230] Figure 4 is a schematic diagram of a device for determining the distance between vehicles according to an embodiment of the present invention. Figure 4 As shown, the device 40 for determining the distance between vehicles may include: a first determining unit 41 , a second determining unit 42 , a third determining unit 43 , a screening determining unit 44 and a fourth determining unit 45 .

[0231] The first determination unit 41 is used to determine a first posture matrix of the subject vehicle and a second posture matrix of the target vehicle, wherein the first posture matrix is ​​used to characterize the position of the subject vehicle, the second posture matrix is ​​used to characterize the position of the target vehicle, and the distance between the target vehicle and the subject vehicle is less than a distance threshold.

[0232] The second determining unit 42 is used to determine a plurality of first position information corresponding to a plurality of corner points in the target vehicle based on the second posture matrix, wherein the plurality of corner points are used to characterize the shape of the target vehicle.

[0233] The third determining unit 43 is used to determine reference position information based on the first posture matrix.

[0234] The screening unit 44 is used to screen out target position information from the plurality of first position information based on the reference position information, wherein the target position information is used to determine the point in the target vehicle that is closest to the subject vehicle.

[0235] The fourth determining unit 45 is used to determine the target distance between the subject vehicle and the target vehicle based on the target position information.

[0236] In this embodiment, a first determination unit is used to determine a first posture matrix of a subject vehicle and a second posture matrix of a target vehicle, wherein the first posture matrix is ​​used to characterize the position of the subject vehicle, the second posture matrix is ​​used to characterize the position of the target vehicle, and the distance between the target vehicle and the subject vehicle is less than a distance threshold; a second determination unit is used to determine a plurality of first position information corresponding to a plurality of corner points in the target vehicle based on the second posture matrix, wherein the plurality of corner points are used to characterize the shape of the target vehicle; a third determination unit is used to determine reference position information based on the first posture matrix; a screening unit is used to screen out target position information from a plurality of first position information based on the reference position information, wherein the target position information is used to determine the point in the target vehicle that is closest to the subject vehicle; a fourth determination unit is used to determine a target distance between the subject vehicle and the target vehicle based on the target position information, thereby achieving a technical effect of accurately determining the target distance between vehicles and solving the technical problem that the distance between vehicles cannot be accurately determined.

[0237] Example 4

[0238] According to an embodiment of the present invention, there is further provided a computer-readable storage medium, the computer-readable storage medium including a stored program, wherein the program executes the method for determining the inter-vehicle distance in Embodiment 1.

[0239] Optionally, in this embodiment, the computer-readable storage medium may be located in any one of the computer terminals in a computer terminal group in a computer network, or in any one of the mobile terminals in a mobile terminal group.

[0240] Example 5

[0241] According to another aspect of an embodiment of the present invention, a vehicle is further provided. The vehicle is used to execute the method for determining the inter-vehicle distance according to an embodiment of the present invention.

[0242] Example 6

[0243] According to an embodiment of the present invention, a processor is further provided. The processor is used to run a program. When the program is run by the processor, the method for determining the distance between vehicles in Embodiment 1 is executed.

[0244] Example 7

[0245] According to an embodiment of the present invention, a computer program product is further provided. The computer program product includes computer instructions. When the computer instructions are executed by a processor, the method for determining the distance between vehicles in Embodiment 1 is implemented.

[0246] The serial numbers of the above embodiments of the present invention are only for description and do not represent the advantages or disadvantages of the embodiments.

[0247] In the above embodiments of the present invention, the description of each embodiment has its own emphasis. For parts that are not described in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.

[0248] In the several embodiments provided by the present invention, it should be understood that the disclosed technical content can be implemented in other ways. Among them, the device embodiments described above are only schematic, for example, the division of units can be a logical function division, and there can be other division methods in actual implementation, such as multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point, the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of units or modules, which can be electrical or other forms.

[0249] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed over multiple units. Some or all of the units may be selected according to actual needs to achieve the purpose of the present embodiment.

[0250] In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above-mentioned integrated unit may be implemented in the form of hardware or in the form of software functional units.

[0251] If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, in essence, or the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software product. The computer software product is stored in a storage medium, including several instructions for a computer device (which can be a personal computer, server or network device, etc.) to perform all or part of the steps of the methods of each embodiment of the present invention. The aforementioned storage medium includes: U disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), mobile hard disk, disk or optical disk, etc. Various media that can store program codes.

[0252] The above are only preferred embodiments of the present invention. It should be pointed out that, for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles of the present invention. These improvements and modifications should also be regarded as the scope of protection of the present invention.

Claims

1. A method for determining the distance between vehicles, characterized in that: include: Determine a first posture matrix of a subject vehicle and a second posture matrix of a target vehicle, wherein the first posture matrix is ​​used to characterize a position of the subject vehicle, the second posture matrix is ​​used to characterize a position of the target vehicle, and a distance between the target vehicle and the subject vehicle is less than a distance threshold; Based on the second posture matrix, determining a plurality of first position information corresponding to a plurality of corner points in the target vehicle, wherein the plurality of corner points are used to form a shape of the target vehicle; Based on the first posture matrix, determining reference position information; Based on the reference position information and the plurality of first position information, respectively determine the installation distances between the plurality of corner points and the reference point at the reference position information to obtain a plurality of installation distances; based on the plurality of installation distances, filter out target position information from the plurality of first position information, wherein the target position information is used to determine the point in the target vehicle that is closest to the subject vehicle, and the plurality of installation distances correspond to the plurality of first position information one by one; Based on the target position information, determine that the first position information is the target corner point of the target position information; in the body coordinate system of the target vehicle, determine the vector coordinates corresponding to the vector formed by the target corner point and the reference point; based on the vector coordinates, determine a target point in the target vehicle whose distance from the subject vehicle meets the screening requirements; determine a first distance between the target point and the subject vehicle; and determine the first distance as the target distance.

2. The method according to claim 1, characterized in that Determining the plurality of first position information corresponding to the plurality of corner points in the target vehicle based on the second posture matrix includes: Get the constructed geodetic coordinate system; In the earth coordinate system, determining the origin position information corresponding to the origin in the local coordinate system of the target vehicle; Based on the origin position information and the second posture matrix, the first position information of the corner point in the earth coordinate system is determined.

3. The method according to claim 1, characterized in that: Filtering the target location information from the plurality of first location information based on the plurality of installation distances includes: Determine the minimum installation distance among the multiple installation distances as the first installation distance; The first position information corresponding to the first installation distance is determined as the target position information.

4. The method according to claim 1, characterized in that: Determining the first distance between the target point and the subject vehicle includes: Determine second position information of the target point in the geodetic coordinate system; converting the second position information and the reference position information into third position information; Based on the third position information, the first distance is determined.

5. The method according to claim 1, characterized in that Determining the reference position information based on the first posture matrix includes: Determining reference coordinates of a reference point in a local coordinate system of the subject vehicle; The reference position information is determined based on the reference coordinates and the first posture matrix.

6. The method according to any one of claims 1 to 5, characterized in that The method further comprises: In response to the target distance being less than a distance threshold, a prompt message is output, wherein the prompt message is used to prompt the subject vehicle that there is danger during driving.

7. A distance determination device, characterized in that: include: A first determination unit is used to determine a first posture matrix of a subject vehicle and a second posture matrix of a target vehicle, wherein the first posture matrix is ​​used to characterize a position of the subject vehicle, the second posture matrix is ​​used to characterize a position of the target vehicle, and a distance between the target vehicle and the subject vehicle is less than a distance threshold; A second determining unit is used to determine a plurality of first position information corresponding to a plurality of corner points in the target vehicle based on the second posture matrix, wherein the plurality of corner points are used to form a shape of the target vehicle; A third determining unit, configured to determine reference position information based on the first posture matrix; A screening unit is used to determine, based on the reference position information and the plurality of first position information, installation distances between the plurality of corner points and the reference point at the reference position information, respectively, to obtain a plurality of installation distances; based on the plurality of installation distances, screen out target position information from the plurality of first position information, wherein the target position information is used to determine the point in the target vehicle that is closest to the subject vehicle, and the plurality of installation distances correspond to the plurality of first position information one by one; The fourth determination unit is used to determine that the first position information is the target corner point of the target position information based on the target position information; determine the vector coordinates corresponding to the vector formed by the target corner point and the reference point in the body coordinate system of the target vehicle; determine, based on the vector coordinates, a target point in the target vehicle whose distance from the subject vehicle meets the screening requirements; determine a first distance between the target point and the subject vehicle; and determine the first distance as the target distance.

8. A vehicle, characterized in that: Used to perform the method according to any one of claims 1 to 6.

9. A computer-readable storage medium, characterized in that: The computer-readable storage medium includes a stored program, wherein when the program is executed, the device where the computer-readable storage medium is located is controlled to execute the method according to any one of claims 1 to 6.

10. A processor, characterized in that: The processor is used to run a program, wherein the program executes the method according to any one of claims 1 to 6 when run by the processor.

11. A computer program product, characterized in that The invention comprises a computer program which, when executed by a processor, implements the method according to any one of claims 1 to 6.

Citation Information

Patent Citations

  • Vehicle distance determining method and device and vehicle

    CN110472571A

  • Vehicle collision prediction method and device

    CN112061118A

  • Vehicle pose measurement method and device, electronic equipment and storage medium

    CN114705121A

  • Vehicle positioning evaluation method and device, electronic equipment and computer readable medium

    CN115993137A

  • Device for determining drag sequence, has distance measuring device that is arranged at car for determining distances to other cars, where comparator compares distances determined by distance measuring device with distance threshold value

    DE102007035131A1