Method for detecting position and posture of detection vehicle based on highway guardrail

By using lidar to detect the relative distance and direction angle between the vehicle and the expressway guardrail in highway safety assessment, the cost problem in the existing technology is solved and efficient and accurate posture detection is achieved.

CN120044546AInactive Publication Date: 2025-05-27NINGBO ANGLIN INTELLIGENT EQUIP CO LTD
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202510511220.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2025-04-23
Publication Date
2025-05-27
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

In the highway safety assessment, when detecting the distance and direction angle between a vehicle and a highway guardrail, it is necessary to rely on high-precision, expensive perception equipment and high-power dedicated processors, resulting in increased costs.

Method used

Lidar detection method is adopted, by installing lidar on the top of the detection vehicle and using the highway guardrail as a reference, the data set of the highway guardrail is collected and processed to calculate the relative distance and direction angle between the detection vehicle and the highway guardrail.

Benefits of technology

It reduces the detection and calculation costs during the pose detection process, avoids the need to use high-precision sensing devices and high-computing processors, and improves the accuracy and reliability of the detection results.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN120044546A_ABST
    Figure CN120044546A_ABST
Patent Text Reader

Abstract

The invention provides a pose detection method for a detection vehicle based on a highway guardrail. The pose detection method comprises the following steps: installing a laser radar on the top of the detection vehicle; when the vehicle is detected to be located at the initial position, the laser radar collects a first guardrail data set of the highway guardrail; the laser radar collects a second guardrail data set of the highway guardrail in real time in the process of detecting that the vehicle advances; according to the first guardrail data set and the second guardrail data set, the relative distance between the detection vehicle and the guardrail in the advancing process and the direction included angle between the advancing direction and the guardrail are determined; the technical problem to be solved by the invention is that a detection technology in the prior art needs to depend on high-precision and expensive sensing equipment and a high-computing-power special processor when detecting the distance and the direction included angle between a detection vehicle and a highway guardrail in a highway safety evaluation process; therefore, the highway safety assessment cost is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of road traffic safety assessment. Specifically, it relates to a method for detecting the pose of a detection vehicle based on a highway guardrail. Background Art

[0002] In the practical applications in the field of highway safety assessment (such as highway patrol and rescue), during the detection of the pose of a detection vehicle, the distance and the direction angle between the detection vehicle and the highway guardrail are mainly detected. Currently, outdoor positioning technologies mainly include Global Navigation Satellite System (GNSS) positioning, differential positioning, and multi-sensor fusion positioning solutions based on artificial intelligence.

[0003] However, there are at least the following problems in the related technologies: In the process of highway safety assessment, when the existing detection technologies detect the distance and the direction angle between the detection vehicle and the highway guardrail, they need to rely on high-precision and expensive sensing devices and high-computing-power dedicated processors, thereby increasing the cost of highway safety assessment. Summary of the Invention

[0004] The technical problem solved by the present invention is that in the process of highway safety assessment by the existing detection technologies, when detecting the distance and the direction angle between the detection vehicle and the highway guardrail, they need to rely on high-precision and expensive sensing devices and high-computing-power dedicated processors, thereby increasing the cost of highway safety assessment.

[0005] To solve the above technical problem, the present invention provides a method for detecting the pose of a detection vehicle based on a highway guardrail. The pose detection method uses lidar detection. The pose detection method includes installing the lidar on the top of the detection vehicle, and the forward direction of the detection vehicle is parallel to the highway guardrail; when the detection vehicle is at the initial position, the lidar collects the first guardrail data set of the highway guardrail; during the forward movement of the detection vehicle, the lidar continuously collects the second guardrail data set of the highway guardrail; according to the first guardrail data set and the second guardrail data set, the relative distance between the detection vehicle and the highway guardrail during the forward movement is determined, as well as the direction angle between the forward direction and the highway guardrail; wherein, the first guardrail data set includes the first scanning angle and the first scanning length of the lidar when the detection vehicle is at the initial position, and the second guardrail data set includes the second scanning angle and the second scanning length of the lidar when the detection vehicle is in the forward movement process.

[0006] Compared with the prior art, the technical effects achieved by adopting this technical solution: This technical solution takes the highway guardrail as a reference, and uses the lidar installed on the top of the detection vehicle to detect the highway guardrail, without the need to use high-precision and expensive sensing devices, thereby reducing the detection cost in the pose detection process. Further, by collecting the first guardrail data set and the second guardrail data set of the highway guardrail, and based on the first guardrail data set and the second guardrail data set, during the forward movement of the detection vehicle, the relative distance and the direction angle between the detection vehicle and the highway guardrail are calculated, avoiding the use of a high-computing-power dedicated processor in the pose detection process, reducing the computing cost in the pose detection process, and thus reducing the cost of highway safety assessment.

[0007] In an example of the present invention, the pose detection method further includes establishing a three-dimensional rectangular coordinate array system (x, y, z) with the position where the lidar is located as the origin O, where the positive direction of the x-axis is the forward direction of the detection vehicle, the positive direction of the y-axis is perpendicular to the left of the positive direction of the x-axis, and the positive direction of the z-axis is vertically upward; when the detection vehicle is at the initial position, calculate the first coordinate array of each scanning point on the first installation surface of the highway guardrail in the three-dimensional rectangular coordinate array system (x, y, z) according to the first guardrail data set; during the forward movement of the detection vehicle, calculate the second coordinate array of each scanning point on the first installation surface in the three-dimensional rectangular coordinate array system (x, y, z) according to the second guardrail data set; determine the relative distance and the direction angle according to the first coordinate array and the second coordinate array.

[0008] Compared with the prior art, the technical effects achieved by adopting this technical solution: This technical solution establishes a three-dimensional rectangular coordinate array system (x, y, z), and in the three-dimensional rectangular coordinate array system (x, y, z), calculates the first coordinate array of each scanning point on the first installation surface according to the first guardrail data set and calculates the second coordinate array of each scanning point on the first installation surface according to the second guardrail data set, so as to obtain the accurate position of the detection vehicle in the three-dimensional coordinate array system (x, y, z) in real time during the forward movement, thereby improving the accuracy of the calculation results of the relative distance and the direction angle of the detection vehicle in the pose detection process, and further improving the accuracy of the highway safety assessment results.

[0009] In an example of the present invention, when the detection vehicle is at the initial position, the scanning plane of the lidar coincides with the yoz plane in the three-dimensional rectangular coordinate array system (x, y, z), and when the detection vehicle is in the forward movement process, the scanning plane coincides with the y´oz´ plane in the three-dimensional rectangular coordinate array system (x, y, z); Define the first guardrail data set as and define the second guardrail data set as Define the first coordinate array as Define the second coordinate array as , the pose detection method further includes: According to the first guardrail data set, the calculation formula for calculating the first coordinate array is: , ; According to the second guardrail data set, the calculation formula for calculating the second coordinate array is: , ; Wherein, α is the first scanning angle, l is the first scanning length, n is the first array serial number of the first guardrail data set, 1 ≤ n ≤ N , β is the second scanning angle, d is the second scanning length, m is the second array serial number of the second guardrail data set, and 1 ≤ m ≤ M , N , M are both the number of valid scanning data.

[0010] Compared with the prior art, the technical effect achieved by adopting this technical solution: This technical solution calculates the first coordinate array when the detection vehicle is at the initial position and the second coordinate array when the detection vehicle is moving forward, making the calculation results of the relative distance and direction angle between the detection vehicle and the highway guardrail more reliable during the forward movement of the detection vehicle.

[0011] In an example of the present invention, the pose detection method further includes uniformly resampling the first coordinate array to obtain a third coordinate array; Define the third coordinate array as , and the calculation formula for the third coordinate array is: , ; Wherein, y i is the scanning data belonging to the interval, k is the number of scanning data, p is the serial number of the scanning data, △ h is the scanning interval distance of the scanning data on the z-axis.

[0012] Compared with the prior art, the technical effect achieved by adopting this technical solution: This technical solution uniformly resamples the first coordinate array to ensure the uniformity of data acquisition during the detection of the lidar, thereby reducing the measurement error generated by the lidar during the detection process.

[0013] In an example of the present invention, the highway guardrail includes a corrugated guardrail. When the detected vehicle is at the initial position, the second mounting surface of the corrugated guardrail is orthogonal to the yoz plane. When the detected vehicle is moving forward, the second mounting surface is orthogonal to the y'oz' plane. The pose detection method further includes performing filtering processing on the third coordinate array and the second coordinate array respectively. When the detected vehicle is at the initial position, according to the third coordinate array after the filtering processing is completed, the first waveform height between the wave crest and the wave trough of the corrugated guardrail in the orthogonal line of the second mounting surface and the yoz plane is obtained. When the detected vehicle is moving forward, according to the second coordinate array after the filtering processing is completed, the second waveform height between the wave crest and the wave trough of the corrugated guardrail in the orthogonal line of the second mounting surface and the y'oz' plane is obtained. According to the first waveform height and the second waveform height, the relative distance and the direction angle are determined.

[0014] Compared with the prior art, the technical effects achieved by adopting this technical solution are as follows: According to the first waveform height and the second waveform height, this technical solution determines the relative distance and the direction angle. By utilizing the geometric characteristics of the corrugated guardrail and combining the filtering processing of the third coordinate array and the second coordinate array and the calculation of the coordinate array, the accuracy of the calculation results of the relative distance and the direction angle between the detected vehicle and the corrugated guardrail is improved.

[0015] In an example of the present invention, the pose detection method further includes performing a first filtering process on the third coordinate array to obtain a fourth coordinate array; calculating the first extreme value of the fourth coordinate array; determining the distance L between the lidar and the highway guardrail according to the first extreme value 0 and determining the first waveform height according to the distance L 0 and the first extreme value.

[0016] Compared with the prior art, the technical effects achieved by adopting this technical solution are as follows: By performing a first filtering process on the third coordinate array, this technical solution reduces the error caused by the noise and measurement accuracy of the lidar to the detection result and improves the accuracy of the detection result. By calculating the first extreme value of the fourth coordinate array after the filtering processing is completed, the distance L between the lidar and the highway guardrail is accurately calculated. 0 Furthermore, the first waveform height is determined according to the distance L 0 and the first extreme value, realizing the accurate calculation of the first waveform height.

[0017] In an example of the present invention, the corrugated guardrail is a single-wave corrugated guardrail. The first extreme value includes a first maximum value, a first minimum value, and a second minimum value. The fourth coordinate array is defined as The first maximum value is defined as The first minimum value is The second minimum value is Define the first waveform height as H 0 The pose detection method further includes: The calculation formula of the fourth coordinate array is: ; ; Determine the distance L between the lidar and the highway guardrail according to the first extreme value 0 The calculation formula is: ; According to the distance L 0 And the calculation formula for determining the first waveform height according to the first extreme value is: ; Wherein, Indicates The product of And Represents the average value of the first minimum value and the second minimum value.

[0018] Compared with the prior art, the technical effects achieved by adopting this technical solution: By calculating the first maximum value, the first minimum value and the second minimum value of the fourth coordinate array, and calculating the first waveform height according to the first maximum value, the first minimum value and the second minimum value, this technical solution further avoids the use of a high-computing-power dedicated processor in the pose detection process, reducing the calculation cost in the pose detection process.

[0019] In an example of the present invention, the pose detection method further includes performing a second filtering process on the second coordinate array to obtain a fifth coordinate array; calculating the second extreme value of the fifth coordinate array; and determining the second waveform height according to the second extreme value.

[0020] Compared with the prior art, the technical effects achieved by adopting this technical solution: By performing a second filtering process on the second coordinate array and calculating the second extreme value of the fifth coordinate array after the filtering process is completed, the second waveform height is accurately calculated, realizing the accurate calculation of the second waveform height.

[0021] In an example of the present invention, the corrugated guardrail includes a double corrugated guardrail, the second extreme value includes a second maximum value, a third minimum value and a fourth minimum value, define the fifth coordinate array as Define the second maximum value as The third minimum value is The fourth minimum value is Define the second waveform height as H, and the pose detection method further includes: The calculation formula of the fifth coordinate array is: , ; The calculation formula for determining the second waveform height according to the second extreme value is: ; wherein, represents the average value of the third minimum value and the fourth minimum value.

[0022] Compared with the prior art, the technical effects achieved by adopting this technical solution: This technical solution calculates the second maximum value, the third minimum value, and the fourth minimum value of the fifth coordinate array, and calculates the second waveform height according to the second maximum value, the third minimum value, and the fourth minimum value, thereby further avoiding the use of a high-computing-power dedicated processor during the pose detection process and reducing the computing cost during the pose detection process.

[0023] In an example of the present invention, determining the relative distance and the direction angle according to the first waveform height and the second waveform height includes determining the relative distance according to the first distance between the lidar and the highway guardrail; determining the direction angle according to the first angle between the yoz plane and the y´oz´ plane; The calculation formula for determining the relative distance according to the first distance between the lidar and the highway guardrail is: ; The calculation formula for determining the direction angle according to the first angle between the yoz plane and the y´oz´ plane is: ; wherein, L is the relative distance, L1 is the distance between the lidar and the highway guardrail, θ is the direction angle, and θ1 is the angle between the yoz plane and the y´oz´ plane.

[0024] Compared with the prior art, the technical effects achieved by adopting this technical solution: This technical solution determines the relative distance according to the first distance between the lidar and the highway guardrail to accurately calculate the relative distance between the detection vehicle and the highway guardrail during the forward movement, thereby improving the accuracy of the pose detection result of the detection vehicle. Further, the direction angle is determined according to the first angle between the yoz plane and the y´oz´ plane, and by analyzing the first angle between the yoz plane and the y´oz´ plane, the forward direction of the detection vehicle relative to the highway guardrail is accurately determined, thereby improving the reliability of the pose detection result of the detection vehicle.

[0025] After adopting the technical solution of the present invention, the following technical effects can be achieved: A method for detecting the pose of a detection vehicle based on a highway guardrail provided by the present invention uses the highway guardrail as a reference and detects the highway guardrail through a lidar installed on the top of the detection vehicle, without using high-precision and expensive sensing devices, thereby reducing the detection cost during the pose detection process. Further, by collecting the first guardrail data group and the second guardrail data group of the highway guardrail, and based on the first guardrail data group and the second guardrail data group, during the forward movement of the detection vehicle, the relative distance and the direction angle between the detection vehicle and the highway guardrail are calculated, avoiding the use of a high-computing-power dedicated processor during the pose detection process, reducing the computing cost during the pose detection process, and thus reducing the cost of highway safety assessment. BRIEF DESCRIPTION OF THE DRAWINGS

[0026] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the following will briefly introduce the drawings to be used in the description of the embodiments. Obviously, the following drawings are only some embodiments of the present invention. For those of ordinary skill in the art, without creative efforts, other drawings can be obtained based on these drawings. Figure 1 It is a flowchart of a method for detecting the pose of a detection vehicle based on a highway guardrail provided by an embodiment of the present invention. Figure 2 It is a schematic structural diagram of a lidar installed on the top of a detection vehicle provided by an embodiment of the present invention. Figure 3 It is a schematic diagram of the pose of a detection vehicle during forward movement provided by an embodiment of the present invention.

[0027] Description of the reference numerals: 100, lidar; 200, detection vehicle; 300, highway guardrail; 400, first mounting surface. DETAILED DESCRIPTION OF THE EMBODIMENTS

[0028] In order to make the above objects, features, and advantages of the present invention more obvious and understandable, the following will describe the specific embodiments of the present invention in detail with reference to the drawings.

[0029] As Figure 1 shown, the present invention provides a method for detecting the pose of a detection vehicle based on a highway guardrail. The pose detection method uses a lidar 100 for detection. The pose detection method includes: S100: Install the lidar 100 on the top of the detection vehicle 200, and the forward direction of the detection vehicle 200 is parallel to the highway guardrail 300. S200: When it is detected that the vehicle 200 is at the initial position, the lidar 100 collects the first guardrail data set of the highway guardrail 300; S300: When it is detected that the vehicle 200 is moving forward, the lidar 100 continuously collects the second guardrail data set of the highway guardrail 300; S400: According to the first guardrail data set and the second guardrail data set, determine the relative distance between the detection vehicle 200 and the highway guardrail 300 during the forward movement, and the direction angle between the forward direction and the highway guardrail 300; Among them, the first guardrail data set includes the first scanning angle and the first scanning length of the lidar 100 when the detection vehicle 200 is at the initial position, and the second guardrail data set includes the second scanning angle and the second scanning length of the lidar 100 when the detection vehicle 200 is in the forward movement process.

[0030] Specifically, in this technical solution, taking the highway guardrail 300 as a reference, the lidar 100 installed on the top of the detection vehicle 200 is used to detect the highway guardrail 300, without using high-precision and expensive sensing devices, thereby reducing the detection cost in the pose detection process. Further, by collecting the first guardrail data set and the second guardrail data set of the highway guardrail 300, and according to the first guardrail data set and the second guardrail data set, during the forward movement of the detection vehicle 200, calculate the relative distance and the direction angle between the detection vehicle 200 and the highway guardrail 300, avoiding the use of a high-computing-power dedicated processor in the pose detection process, reducing the calculation cost in the pose detection process, and thus reducing the cost of highway safety assessment.

[0031] In an embodiment provided by the present invention, the pose detection method further includes taking the position where the lidar 100 is located as the origin O to establish a three-dimensional rectangular coordinate system (x, y, z), where the positive direction of the x-axis is the forward direction of the detection vehicle 200, the positive direction of the y-axis is perpendicular to the left of the positive direction of the x-axis, and the positive direction of the z-axis is vertically upward; when the detection vehicle 200 is at the initial position, calculate the first coordinate system of each scanning point on the first installation surface 400 of the highway guardrail 300 in the three-dimensional rectangular coordinate system (x, y, z) according to the first guardrail data set; when the detection vehicle 200 is moving forward, calculate the second coordinate system of each scanning point on the first installation surface 400 in the three-dimensional rectangular coordinate system (x, y, z) according to the second guardrail data set; according to the first coordinate system and the second coordinate system, determine the relative distance and the direction angle.

[0032] Furthermore, as a mandatory safety facility with national standards, the highway guardrail 300 has good specification consistency and covers all sections of the highway guardrail 300. In this solution, by taking the highway guardrail 300 as a reference, the lidar 100 installed on the top of the inspection vehicle 200 is used to detect the highway guardrail 300, which improves the robustness of the pose detection method.

[0033] Specifically, in this technical solution, a three-dimensional rectangular coordinate array system (x, y, z) is established, and in the three-dimensional rectangular coordinate array system (x, y, z), the first coordinate array of each scanning point on the first installation surface 400 is calculated according to the first guardrail data group, and the second coordinate array of each scanning point on the first installation surface 400 is calculated according to the second guardrail data group, and the accurate position of the inspection vehicle 200 in the three-dimensional coordinate array system (x, y, z) during the forward movement is obtained in real time, thereby improving the accuracy of the calculation results of the relative distance and direction angle of the inspection vehicle 200 during the pose detection process, and further improving the accuracy of the highway safety assessment results.

[0034] In an embodiment provided by the present invention, when the inspection vehicle 200 is located at the initial position, the scanning plane of the lidar 100 coincides with the yoz plane in the three-dimensional rectangular coordinate array system (x, y, z), and when the inspection vehicle 200 is in the forward movement process, the scanning plane coincides with the y´oz´ plane in the three-dimensional rectangular coordinate array system (x, y, z); Define the first guardrail data group as and define the second guardrail data group as Define the first coordinate array as and define the second coordinate array as The pose detection method further includes: According to the first guardrail data group, the calculation formula for calculating the first coordinate array is: , ; According to the second guardrail data group, the calculation formula for calculating the second coordinate array is: , ; Wherein, α is the first scanning angle, l is the first scanning length, n is the first array serial number of the first guardrail data group, 1 ≤ n ≤ N , β is the second scanning angle, d is the second scanning length, m is the second array serial number of the second guardrail data group, and 1 ≤ m ≤ M, N and M are both the quantities of valid scan data.

[0035] Specifically, this technical solution calculates the first coordinate array when the detection vehicle 200 is at the initial position and the second coordinate array when the detection vehicle 200 is moving forward, making the calculation results of the relative distance and direction angle between the detection vehicle 200 and the highway guardrail 300 more reliable during the forward movement.

[0036] It should be noted that the valid scan data mentioned in this solution refers to the scan data that excludes the cases where the scan data is 0 or greater than the distance between the detection vehicle 200 and the highway guardrail 300 due to an obstacle being too close to or too far from the lidar 100.

[0037] In an embodiment provided by the present invention, the pose detection method further includes uniformly resampling the first coordinate array to obtain a third coordinate array; Define the third coordinate array as , and the calculation formula of the third coordinate array is: , ; where y i is the scan data belonging to the interval, k is the number of scan data, p is the serial number of the scan data, △ h is the scan interval distance of the scan data on the z-axis.

[0038] Specifically, this technical solution uniformly resamples the first coordinate array to ensure the uniformity of data acquisition by the lidar 100 during the detection process, thereby reducing the measurement error generated by the lidar 100 during the detection process.

[0039] Such as Figure 2 and Figure 3As shown, in an embodiment provided by the present invention, the highway guardrail 300 includes a corrugated guardrail. When the detection vehicle 200 is located at the initial position, the second mounting surface of the corrugated guardrail is orthogonal to the yoz plane. When the detection vehicle 200 is in the process of moving forward, the second mounting surface is orthogonal to the y'oz' plane. The pose detection method further includes performing filtering processing on the third coordinate array and the second coordinate array respectively. When the detection vehicle 200 is located at the initial position, according to the filtered third coordinate array, the first waveform height between the wave crest and the wave trough of the corrugated guardrail in the orthogonal line between the second mounting surface and the yoz plane is obtained. When the detection vehicle 200 is moving forward, according to the filtered second coordinate array, the second waveform height between the wave crest and the wave trough of the corrugated guardrail in the orthogonal line between the second mounting surface and the y'oz' plane is obtained. According to the first waveform height and the second waveform height, the relative distance and the direction angle are determined.

[0040] Specifically, in this technical solution, according to the first waveform height and the second waveform height, the relative distance and the direction angle are determined. By utilizing the geometric features of the corrugated guardrail and combining the filtering processing of the third coordinate array and the second coordinate array and the calculation of the coordinate arrays, the accuracy of the calculation results of the relative distance and the direction angle between the detection vehicle 200 and the corrugated guardrail is improved.

[0041] As Figure 2 shown, in an embodiment provided by the present invention, the pose detection method further includes performing a first filtering process on the third coordinate array to obtain a fourth coordinate array; calculating the first extreme value of the fourth coordinate array; determining the distance L between the lidar 100 and the highway guardrail 300 according to the first extreme value 0 , and determining the first waveform height according to the distance L 0 and the first extreme value.

[0042] Specifically, in this technical solution, by performing a first filtering process on the third coordinate array, the error caused by the noise and measurement accuracy of the lidar 100 to the detection result is reduced, and the accuracy of the detection result is improved. By calculating the first extreme value of the fourth coordinate array after the filtering process is completed, the distance L between the lidar 100 and the highway guardrail 300 is accurately calculated 0 . Further, the first waveform height is determined according to the distance L 0 and the first extreme value, realizing the accurate calculation of the first waveform height.

[0043] As Figure 2 shown, in an embodiment provided by the present invention, the corrugated guardrail is a single-wave corrugated guardrail, the first extreme value includes a first maximum value, a first minimum value and a second minimum value, and the fourth coordinate array is defined as , and the first maximum value is defined as , the first minimum value is , the second minimum value is , define the first waveform height as H 0 , the pose detection method further includes: The calculation formula of the fourth coordinate array is: ; ; Determine the distance L between the lidar 100 and the highway guardrail 300 according to the first extreme value 0 The calculation formula is: ; According to the distance L 0 and the calculation formula of the first waveform height determined by the first extreme value is: ; Among them, represents and the product of, represents the average value of the first minimum value and the second minimum value.

[0044] Specifically, in this technical solution, by calculating the first maximum value, the first minimum value, and the second minimum value of the fourth coordinate array, and calculating the first waveform height according to the first maximum value, the first minimum value, and the second minimum value, the use of a high-computing-power dedicated processor in the pose detection process is further avoided, and the calculation cost in the pose detection process is reduced.

[0045] As Figure 3 shown, in an embodiment provided by the present invention, the pose detection method further includes performing a second filtering process on the second coordinate array to obtain a fifth coordinate array; calculating the second extreme value of the fifth coordinate array; and determining the second waveform height according to the second extreme value.

[0046] Specifically, in this technical solution, by performing a second filtering process on the second coordinate array and calculating the second extreme value of the fifth coordinate array after the filtering process is completed, the second waveform height is accurately calculated, and the accurate calculation of the second waveform height is realized.

[0047] As Figure 3 shown, in an embodiment provided by the present invention, the corrugated guardrail includes a double-wave corrugated guardrail, the second extreme value includes a second maximum value, a third minimum value, and a fourth minimum value, define the fifth coordinate array as , define the second maximum value as , the third minimum value is , the fourth minimum value is , define the second waveform height as H, the pose detection method further includes: The calculation formula of the fifth coordinate array is: , ; The calculation formula for determining the second waveform height according to the second extreme value is: ; wherein, represents the average value of the third minimum value and the fourth minimum value.

[0048] Specifically, in this technical solution, by calculating the second maximum value, the third minimum value, and the fourth minimum value of the fifth coordinate array, and calculating the second waveform height according to the second maximum value, the third minimum value, and the fourth minimum value, the use of a high-computing-power dedicated processor in the pose detection process is further avoided, and the calculation cost in the pose detection process is reduced.

[0049] As Figure 3 shown, in an embodiment provided by the present invention, determining the relative distance and the direction angle according to the first waveform height and the second waveform height includes determining the relative distance according to the first distance between the lidar 100 and the highway guardrail 300; determining the direction angle according to the first angle between the yoz plane and the y´oz´ plane; The calculation formula for determining the relative distance according to the first distance between the lidar 100 and the highway guardrail 300 is: ; The calculation formula for determining the direction angle according to the first angle between the yoz plane and the y´oz´ plane is: ; wherein, L is the relative distance, L1 is the distance between the lidar 100 and the highway guardrail 300, θ is the direction angle, and θ1 is the angle between the yoz plane and the y´oz´ plane.

[0050] Specifically, this technical solution determines the relative distance according to the first distance between the lidar 100 and the highway guardrail 300 to accurately calculate the relative distance between the detection vehicle 200 and the highway guardrail 300 during the forward movement, thereby improving the accuracy of the pose detection result of the detection vehicle 200. Further, the direction angle is determined according to the first angle between the yoz plane and the y´oz´ plane. By analyzing the first angle between the yoz plane and the y´oz´ plane, the forward direction of the detection vehicle 200 relative to the highway guardrail 300 is accurately determined, thereby improving the reliability of the pose detection result of the detection vehicle 200.

[0051] Although the present invention is disclosed as above, the present invention is not limited thereto. Any person skilled in the art can make various changes and modifications without departing from the spirit and scope of the present invention. Therefore, the protection scope of the present invention shall be subject to the scope defined by the claims.

Claims

1. A method for detecting vehicle posture based on highway guardrails, characterized in that: The posture detection method adopts a laser radar (100) for detection, and the posture detection method comprises: The laser radar (100) is mounted on the top of the detection vehicle (200), and the forward direction of the detection vehicle (200) is parallel to the highway guardrail (300); When the detection vehicle (200) is located at an initial position, the laser radar (100) collects a first guardrail data group of the highway guardrail (300); During the process of the detection vehicle (200) moving forward, the laser radar (100) collects a second guardrail data group of the highway guardrail (300) in real time; Determining, based on the first guardrail data group and the second guardrail data group, a relative distance between the detection vehicle (200) and the highway guardrail (300) during the forward movement, and a directional angle between the forward direction and the highway guardrail (300); The first guardrail data group includes a first scanning angle and a first scanning length of the laser radar (100) when the detection vehicle (200) is located at the initial position, and the second guardrail data group includes a second scanning angle and a second scanning length of the laser radar (100) when the detection vehicle (200) is in the forward process.

2. The posture detection method according to claim 1, characterized in that: The posture detection method also includes: Taking the position of the laser radar (100) as the origin O, a three-dimensional rectangular coordinate array system (x, y, z) is established, wherein the positive direction of the x-axis is the forward direction of the detection vehicle (200), the positive direction of the y-axis is vertically to the left of the positive direction of the x-axis, and the positive direction of the z-axis is vertically upward; When the detection vehicle (200) is located at the initial position, calculating a first coordinate array of each scanning point on a first installation surface (400) of the highway guardrail (300) in the three-dimensional rectangular coordinate array system (x, y, z) according to the first guardrail data group; The detection vehicle (200) calculates, during the advancing process, a second coordinate array of each scanning point on the first installation surface (400) in the three-dimensional rectangular coordinate array system (x, y, z) according to the second guardrail data group; The relative distance and the direction angle are determined according to the first coordinate array and the second coordinate array.

3. The posture detection method according to claim 2, characterized in that: When the detection vehicle (200) is located at the initial position, the scanning plane of the laser radar (100) coincides with the yoz plane in the three-dimensional rectangular coordinate array system (x, y, z); when the detection vehicle (200) is in the forward process, the scanning plane coincides with the y´oz´ plane in the three-dimensional rectangular coordinate array system (x, y, z); Define the first guardrail data group as , define the second guardrail data group as , define the first coordinate array as , define the second coordinate array as , the posture detection method also includes: The calculation formula for calculating the first coordinate array according to the first guardrail data group is: , ; The calculation formula for calculating the second coordinate array according to the second guardrail data group is: , ; in, α is the first scanning angle, l is the first scanning length, n is the first array number of the first guardrail data group, 1≤ n ≤ N , β is the second scanning angle, d is the second scan length, m is the second array number of the second guardrail data group, and 1≤ m ≤ M , N , M The numbers are all valid scan data.

4. The posture detection method according to claim 3, characterized in that: The posture detection method also includes: uniformly resampling the first coordinate array to obtain a third coordinate array; Define the third coordinate array as , the calculation formula of the third coordinate array is: , ; in, y i For The scan data of the interval, k is the number of scanned data, p is the sequence number of the scan data, △ h is the scanning interval distance of the scanning data on the z-axis.

5. The posture detection method according to claim 4, characterized in that: The highway guardrail (300) comprises a corrugated guardrail, and when the detection vehicle (200) is located at the initial position, the second mounting surface of the corrugated guardrail is orthogonal to the yoz plane, and when the detection vehicle (200) is in the forward process, the second mounting surface is orthogonal to the y´oz´ plane, and the posture detection method further comprises: Performing filtering processing on the third coordinate array and the second coordinate array respectively; When the detection vehicle (200) is located at the initial position, obtaining, according to the third coordinate array after the filtering process, a first waveform height between a crest and a trough of the corrugated guardrail in a line orthogonal to the second installation surface and the yoz plane; During the forward movement of the detection vehicle (200), according to the second coordinate array after the filtering process, a second waveform height between a crest and a trough of the corrugated guardrail in a line orthogonal to the second installation surface and the y´oz´ plane is obtained; The relative distance and the direction angle are determined according to the first waveform height and the second waveform height.

6. The posture detection method according to claim 5, characterized in that: The posture detection method also includes: Performing a first filtering process on the third coordinate array to obtain a fourth coordinate array; Calculating a first extreme value of the fourth coordinate array; The distance L0 between the laser radar (100) and the highway guardrail (300) is determined according to the first extreme value, and the first waveform height is determined according to the distance L0 and the first extreme value.

7. The posture detection method according to claim 6, characterized in that: The waveform guardrail is a single waveform guardrail, the first extreme value includes a first maximum value, a first minimum value and a second minimum value, and the fourth coordinate array is defined as: , define the first maximum value as The first minimum value is The second minimum is , defining the first waveform height as H0, the posture detection method further includes: The calculation formula of the fourth coordinate array is: ; ; The calculation formula for determining the distance L0 between the laser radar (100) and the highway guardrail (300) according to the first extreme value is: ; The calculation formula for determining the first waveform height according to the distance L0 and the first extreme value is: ; in, express and The product of represents the average value of the first minimum value and the second minimum value.

8. The posture detection method according to claim 7, characterized in that: The posture detection method also includes: performing a second filtering process on the second coordinate array to obtain a fifth coordinate array; Calculating the second extreme value of the fifth coordinate array; The second waveform height is determined according to the second extreme value.

9. The posture detection method according to claim 8, characterized in that: The corrugated guardrail includes a double corrugated guardrail, the second extreme value includes a second maximum value, a third minimum value and a fourth minimum value, and the fifth coordinate array is defined as: , define the second maximum value as The third minimum value is The fourth minimum value is , defining the height of the second waveform as H, the posture detection method further includes: The calculation formula of the fifth coordinate array is: , ; The calculation formula for determining the height of the second waveform according to the second extreme value is: ; in, represents the average value of the third minimum value and the fourth minimum value.

10. The posture detection method according to claim 9, characterized in that: The determining the relative distance and the direction angle according to the first waveform height and the second waveform height includes: Determining the relative distance according to a first distance between the laser radar (100) and the highway guardrail (300); Determining the direction angle according to a first angle between the yoz plane and the y´oz´ plane; The calculation formula for determining the relative distance based on the first distance between the laser radar (100) and the highway guardrail (300) is: ; The calculation formula for determining the direction angle according to the first angle between the yoz plane and the y´oz´ plane is: ; Wherein, L is the relative distance, L1 is the distance between the laser radar (100) and the highway guardrail (300), θ is the direction angle, and θ1 is the angle between the yoz plane and the y´oz´ plane.

Citation Information

Cited By

  • Highway guardrail height detection method based on line knot light

    CN120778009A