WO2020103354A1 - 一种挂车夹角的测量方法、装置及车辆 - Google Patents
一种挂车夹角的测量方法、装置及车辆Info
- Publication number
- WO2020103354A1 WO2020103354A1 PCT/CN2019/077074 CN2019077074W WO2020103354A1 WO 2020103354 A1 WO2020103354 A1 WO 2020103354A1 CN 2019077074 W CN2019077074 W CN 2019077074W WO 2020103354 A1 WO2020103354 A1 WO 2020103354A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- trailer
- lidar
- angle
- laser
- tractor
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 49
- 238000005259 measurement Methods 0.000 claims abstract description 12
- 238000004590 computer program Methods 0.000 claims description 20
- 238000012545 processing Methods 0.000 claims description 15
- 238000001914 filtration Methods 0.000 claims description 14
- 230000008569 process Effects 0.000 claims description 9
- 238000003860 storage Methods 0.000 claims description 9
- 238000004891 communication Methods 0.000 claims description 5
- 238000005070 sampling Methods 0.000 claims description 5
- 230000000717 retained effect Effects 0.000 claims description 3
- 238000012216 screening Methods 0.000 claims 2
- 238000007781 pre-processing Methods 0.000 claims 1
- 238000000691 measurement method Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 18
- 230000006870 function Effects 0.000 description 5
- 238000012986 modification Methods 0.000 description 5
- 230000004048 modification Effects 0.000 description 5
- 230000008901 benefit Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 3
- 238000009826 distribution Methods 0.000 description 3
- 238000011161 development Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 229910000831 Steel Inorganic materials 0.000 description 1
- 230000002159 abnormal effect Effects 0.000 description 1
- 238000013480 data collection Methods 0.000 description 1
- 230000001934 delay Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 239000010959 steel Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/26—Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/87—Combinations of systems using electromagnetic waves other than radio waves
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4808—Evaluating distance, position or velocity data
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D53/00—Tractor-trailer combinations; Road trains
Definitions
- the present application relates to the technical field of vehicles, and in particular to a method, device and vehicle for measuring the angle of a trailer.
- semi-trailers vehicles with tractors and trailers
- container trucks are increasingly used.
- semi-trailer can improve the comprehensive economic benefits of road transportation compared with a single truck.
- the angle of the trailer (the semi-trailer shown in Figure 1) From the top view of the trailer, the angle between the trailer refers to the angle ⁇ between the central axis of the tractor 11 and the central axis of the trailer 12) as the basis of automatic driving planning and control points has become the focus of research.
- the current method of measuring the trailer angle can only be measured when the trailer angle is relatively small. For scenes with a large trailer angle (for example, the trailer angle is greater than ⁇ 40 °), it is difficult to obtain an accurate trailer angle angle. Therefore, how to realize a method for measuring the angle of the trailer with a simple structure and a fast and accurate method is called a problem to be solved urgently.
- the embodiments of the present application provide a method, a device, and a vehicle for measuring the angle of a trailer, so as to realize a method for measuring the angle of a trailer with a simple structure, quickly and accurately.
- a method for measuring the angle of a trailer, applied to a semi-trailer, the semi-trailer includes a tractor and a trailer; at least two laser radars are provided on both sides of the rear of the tractor; at the front of the trailer A reflection plate having a reflection surface is fixedly arranged, and the reflection surface faces the lidar;
- the method for measuring the angle of the trailer includes:
- a measuring device for the angle of a trailer which is applied to a semi-trailer.
- the semi-trailer includes a tractor and a trailer; at least two laser radars are provided on both sides of the tail of the tractor;
- the front part is fixedly provided with a reflecting plate with a reflecting surface, the reflecting surface faces the lidar;
- the device is in communication with the lidar;
- the device includes a memory, a processor, and is stored on the memory and can be on the processor
- a computer program that is running, and when the processor executes the computer program, the above-described trailer angle measurement process is implemented.
- the process includes: controlling the laser radars respectively provided on both sides of the tail of the tractor to emit laser light, so that the reflection
- the board reflects the laser light emitted by the lidar through the reflecting surface; controls each lidar to receive the corresponding laser point cloud reflected by the reflecting plate; calculates the trailer clip according to the corresponding laser point cloud received by each lidar angle.
- a vehicle includes the above-mentioned measuring device for the angle of the trailer, as well as a tractor and a trailer; at least one laser radar is respectively provided on both sides of the tail of the tractor; a reflection surface is fixedly arranged on the front of the trailer Of the reflector, the reflecting surface faces the lidar; the measuring device for the angle of the trailer is in communication with the lidar; the measuring device for the angle of the trailer includes a memory, a processor and stored on the memory and can A computer program running on a processor, which implements the measurement process of the angle of the trailer when the processor executes the computer program.
- the reflecting plate reflects the laser light emitted by the lidar through the reflecting surface; controls each lidar to respectively receive the corresponding laser point cloud reflected by the reflecting plate; and calculates according to the corresponding laser point cloud received by each lidar Trailer angle.
- the method, device and vehicle for measuring the angle of the trailer provided by the embodiments of the present application adopt at least one lidar on each side of the rear of the tractor, so that in the scene where the angle of the trailer is large, the reflector moves to When the side of the tractor is towed, the laser light emitted by the lidar on at least one side can still hit the reflecting surface of the reflecting plate, so that it can be used to measure the angle of the trailer.
- the present application uses the corresponding laser point clouds received by each laser radar to calculate the angle of the trailer. The accuracy of the results is greatly improved.
- Figure 1 is a schematic diagram of the angle of the trailer
- FIG. 2 is a flowchart 1 of a method for measuring a trailer included angle provided by an embodiment of the present application
- FIG. 3 is a bottom view of the semi-trailer structure in the embodiment of the present application.
- FIG. 4 is a schematic diagram of a working scene when only one lidar is provided at the rear of the tractor in the embodiment of the present application;
- FIG. 5 is a schematic diagram of a working scene when a lidar is provided on both sides of the tail of the tractor in the embodiment of the present application;
- FIG. 6 is a schematic diagram 1 of the distribution of lidars provided on both sides of the tail of the tractor in the embodiment of the present application;
- FIG. 7 is a second schematic diagram of the distribution of lidars provided on both sides of the tail of the tractor in the embodiment of the present application.
- FIG. 8 is a flowchart 2 of a method for measuring a trailer included angle provided by an embodiment of the present application
- FIG. 9 is a schematic diagram of the movement range of the reflective plate surrounding the tractor along with the trailer in the embodiment of the present application.
- FIG. 10 is a schematic diagram of a lidar coordinate system established in an embodiment of this application.
- 11 is a schematic diagram of the longest straight line segment in the lidar coordinate system established in the embodiment of the present application.
- FIG. 12 is a schematic diagram of curves of angle data to be processed in an embodiment of the present application.
- FIG. 13 is a schematic structural diagram of a vehicle in an embodiment of this application.
- FIG. 14 is a schematic structural diagram of a rear region of a tractor in an embodiment of the present application.
- Point cloud In reverse engineering, the point data collection of the appearance surface of an object obtained by a measuring instrument is called a point cloud.
- AOI Area of Interest Filter, an area of interest filter, that is, when filtering point cloud data, only point cloud data of a specific area of interest is retained.
- RANSAC Random Sample Consensus, a random sampling consistency algorithm, is an algorithm that calculates the mathematical model parameters of data based on a set of sample data sets containing abnormal data and obtains effective sample data.
- an embodiment of the present application provides a method for measuring the angle of a trailer, which is applied to a semi-trailer 20 shown in FIG. 3 (FIG. 3 is a lower view of the semi-trailer 20).
- the semi-trailer 20 includes traction
- the vehicle 201 and the trailer 202, the tractor 201 and the trailer 202 are connected by a rotating shaft 205, so that the trailer 202 can rotate relative to the tractor 201;
- at least one lidar 203 is provided on both sides of the rear of the tractor 201 (such as left and right sides) (For example, one lidar, two lidars, or more lidars may be installed on the left and right sides.
- the front of the is fixedly provided with a reflecting plate 204 having a reflecting surface facing the lidar 203.
- the method for measuring the angle of the trailer includes:
- Step 301 Control the laser radars provided on both sides of the rear of the tractor to emit laser light, so that the reflection plate reflects the laser light emitted by the laser radar through the reflection surface.
- Step 302 Control each lidar to respectively receive the corresponding laser point cloud reflected by the reflection plate.
- Step 303 Calculate the trailer angle based on the corresponding laser point clouds received by each lidar.
- the lidar considering that only one lidar 203 is provided at the rear of the tractor 201 (generally located in the middle of the tail of the tractor, the lidar generally uses a single-line lidar) or the reflector 204
- the reflecting surface emits laser light, and the angle of the trailer can also be generally measured through the one lidar 203.
- the reflecting plate 204 may have moved to the side of the tractor 201, and the laser light emitted by the single lidar 203 can no longer hit the reflecting surface of the reflecting plate 204. Causes the measurement of the trailer angle to fail.
- the present application adopts at least one lidar 203 (for example, one lidar, two lidars or There are many lidars. Due to the limitation of FIG. 5, only the lidars on the left and right sides are shown.)
- the reflecting plate 204 moves to the side of the tractor 201, at least one of the lidars
- the emitted laser light can still hit the reflecting surface of the reflecting plate 204, so that it can be used to measure the angle of the trailer.
- the present application uses the corresponding laser point clouds received by each laser radar to calculate the angle of the trailer. The accuracy of the results is greatly improved.
- the distribution of the lidar in the tail of the tractor 201 may be one lidar on each side 203 (FIG. 6), or two lidars 203 (FIG. 7) each, but not limited to this, without considering cost, even more lidars can be installed on the left and right sides.
- the embodiment of the present application provides a method for measuring the angle of the trailer, which is applied to the above shown in FIG. 3
- the semi-trailer 20 has been described above and will not be repeated here.
- the method includes:
- Step 401 Control the laser radars provided on both sides of the rear of the tractor to emit laser light, so that the reflection plate reflects the laser light emitted by the laser radar through the reflection surface.
- the reflection plate can be selected from steel plates, but it is not limited to this.
- lidar involved in the embodiments of the present application may generally use single-line lidar, but it is not limited to this, for example, multi-line lidar may also be used, such as 4-line, 8-line, 16-line, 32-line, and 64-line lasers. Radar, etc.
- Step 402 Control each lidar to respectively receive the corresponding laser point cloud reflected by the reflecting plate.
- the sampling frequency of each lidar can be 10 Hz, but it is not limited to this.
- the lidar has its own corresponding logo when it emits laser light outwards, so that it can ensure that the lidar only receives the corresponding laser point cloud when receiving the laser point cloud reflected by the reflection plate, and does not receive other lidars. Corresponding laser point cloud.
- the collection time of each lidar is preferably different to avoid two or more at the same collection time The initial trailer angles are together and are difficult to distinguish.
- Step 403 Perform a region-of-interest filtering on each corresponding laser point cloud received by each lidar to obtain a laser point cloud within a preset area.
- the preset area range is determined according to the movement range of the reflecting plate with the trailer around the tractor. For example, the following methods can be used:
- a first distance L1 and a second distance L2 are preset according to the movement range of the reflector around the tractor along with the trailer; wherein, the second distance L2 is greater than the first distance L1.
- the reason for this setting is that the reflector is generally in an annular area as the trailer moves around the tractor, so the first distance L1 and the second distance L2 are set in advance, with the rotation axis O as the center, to The first distance L1 and the second distance L2 are radii, and the preset area range S can be obtained.
- Step 404 Perform noise filtering on the laser point cloud within the preset area to obtain a noise-filtered laser point cloud corresponding to each lidar.
- noise filtering can be used to filter outliers, thereby obtaining a more accurate laser point cloud.
- Step 405 Use the random sampling consistency algorithm to filter the laser point clouds corresponding to each laser radar to obtain a straight line segment formed by one or more laser point clouds corresponding to each laser radar, and form a straight line formed by one or more laser point clouds The longest straight line segment corresponding to each lidar is determined in the segment.
- the noise-filtered laser point cloud corresponding to each lidar does not necessarily contain only the laser point cloud reflected by the reflector, it may also contain laser points reflected from other positions (such as the protrusions on the left and right sides of the reflector) Cloud, so you need to obtain a straight line segment formed by one or more laser point clouds corresponding to each lidar through a random sampling consistency algorithm, and determine the longest straight line segment corresponding to each lidar from the straight line segments formed by one or more laser point clouds .
- Step 406 Under the lidar coordinate system, determine the straight line equation of each longest straight line segment and the number of points of the laser point cloud constituting each longest straight line segment.
- Step 407 Calculate the initial trailer angle corresponding to each lidar according to the straight line equation of each longest straight line segment.
- the lidar coordinate system is established, and the position information of the laser point cloud of the lidar is based on the lidar coordinate system.
- the lidar coordinate system shown in FIG. 10 can be established. However, it is not limited to this. In the establishment of the lidar coordinate system, other directions can be selected as the x-axis, and a direction perpendicular to the x-axis in the horizontal plane is the y-axis, which will not be listed here.
- step 406 under the lidar coordinate system, the straight line equations of each longest straight line segment and the number of points of the laser point cloud constituting each longest straight line segment are determined, and in step 407, according to each longest The straight line equation of the straight line segment is calculated to obtain the initial trailer angle corresponding to each lidar, which can be achieved by the following methods: fitting the straight line segment according to the received laser point cloud, and fitting the longest straight segment according to the longest straight segment The straight line equation of the segment; an inverse trigonometric function (generally arc tangent or inverse cotangent) is calculated for the slope of the straight line equation to obtain the initial angle of the box, as shown in Figure 11.
- an inverse trigonometric function generally arc tangent or inverse cotangent
- Step 408 Screen the initial trailer angle corresponding to each lidar according to the preset judgment conditions.
- this step 408 can be implemented in the following two ways, and of course, it can also be implemented by combining the two ways:
- the initial trailer angle corresponding to the lidar with the laser point cloud of the longest straight line segment with a number of points less than the preset point threshold value is eliminated, and the laser point cloud with the longest straight line segment with a number of points greater than or equal to the preset point threshold value corresponds to the lidar Initial trailer angle.
- the point number of the laser point cloud of the longest straight line segment is less than the preset point threshold, it means that the longest straight line segment is fitted from fewer laser point clouds. If the longest straight line segment is obtained, the initial trailer included angle is very inaccurate and should be eliminated.
- the initial period corresponding to the current period of the lidar is eliminated.
- the deviation angle between the initial trailer angle corresponding to the current period of lidar and the trailer period included in the previous period obtained by Kalman filtering is less than or equal to the preset deviation angle threshold, then the current period corresponding to the lidar angle The initial trailer angle is retained.
- the change of the trailer angle will not be too large, so if the initial trailer angle corresponding to The deviation angle value of the trailer angle in the previous cycle obtained by the Kalman filtering process is greater than the preset deviation angle threshold, then the initial trailer angle corresponding to the lidar of the current cycle is determined to be invalid data and should be eliminated.
- Step 409 Arrange the initial trailer angles corresponding to the selected lidars at the collection time in the current cycle to form angle data to be processed.
- the lidar measurement period is 0.1s.
- the abscissa is the time corresponding to the initial trailer angle.
- the coordinate is the angle of the initial trailer angle, and the entire ordinate data constitutes the angle data to be processed.
- Step 410 Perform Kalman filter processing according to the angle data to be processed to obtain the trailer angle of the current cycle.
- the reason for the Kalman filter processing here is that due to the manufacturing error of the reflective plate, the reflective plate itself cannot be guaranteed to be absolutely flat, and the lidar itself also has observation errors, so that there is a certain error in the calculated initial trailer angle.
- the phenomenon is that when the vehicle is stationary, the angle will also jump from plus or minus 1 ° to 2 °.
- the Kalman filter processing can perform noise reduction processing on the initial trailer angle arranged with the acquisition time in the angle data to be processed, and the initial trailer angle and the simplified kinematic model of the angle change are merged to obtain a smooth
- the output results can not only ensure that the error of the measurement data of the trailer angle under static conditions is within ⁇ 0.5 °, but also ensure that the measurement data can change in real time when the trailer angle changes rapidly, avoiding obvious delays.
- step 410 it may return to step 401 to measure the angle of the trailer in the next cycle.
- an embodiment of the present application provides a measuring device for a trailer included angle, which includes a memory, a processor, and a computer program stored on the memory and executable on the processor.
- the processor implements the computer program to implement the above diagram 2 or the method corresponding to Figure 8.
- embodiments of the present application also provide a computer-readable storage medium on which a computer program is stored, and when the program is executed by a processor, the method corresponding to FIG. 2 or FIG. 8 described above is implemented.
- an embodiment of the present application further provides a vehicle 50 including the above-described trailer angle measuring device 501, and a tractor 201 and a trailer 202 (the trailer 202 involved in the present application may carry a container , Or not carrying a container); at least one lidar 203 is provided on both sides of the rear of the tractor 201; a reflective plate 204 with a reflective surface is fixedly provided on the front of the trailer 202, and the reflective surface 204 Facing the lidar 203; the measuring device 501 of the trailer included angle is in communication with the lidar 203.
- both sides of the rear portion of the tractor 201 are fixedly connected to each lidar 203 through a first fastener.
- the first fastener may be a first support beam 206 fixed to the beam at the rear of the tractor 201, and the lidar 203 is fixed to the side of the first support beam facing away from the tractor 201 and facing
- the reflection plate 204 emits laser light.
- the method, device and vehicle for measuring the angle of the trailer provided by the embodiments of the present application adopt at least one lidar on each side of the rear of the tractor, so that in the scene where the angle of the trailer is large, the reflector moves to When the side of the tractor is towed, the laser light emitted by the lidar on at least one side can still hit the reflecting surface of the reflecting plate, so that it can be used to measure the angle of the trailer.
- the present application uses the corresponding laser point clouds received by each laser radar to calculate the angle of the trailer. The accuracy of the results is greatly improved.
- each functional unit in each embodiment of the present application may be integrated into one processing module, or each unit may exist alone physically, or two or more units may be integrated into one module.
- the above integrated modules may be implemented in the form of hardware or software function modules. If the integrated module is implemented in the form of a software functional module and sold or used as an independent product, it may also be stored in a computer-readable storage medium.
- the embodiments of the present application may be provided as methods, systems, or computer program products. Therefore, the present application may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware. Moreover, the present application may take the form of a computer program product implemented on one or more computer usable storage media (including but not limited to disk storage and optical storage, etc.) containing computer usable program code.
- a computer usable storage media including but not limited to disk storage and optical storage, etc.
- These computer program instructions can be provided to the processor of a general-purpose computer, special-purpose computer, embedded processing machine, or other programmable data processing device to produce a machine that enables the generation of instructions executed by the processor of the computer or other programmable data processing device
- These computer program instructions may also be stored in a computer-readable memory that can guide a computer or other programmable data processing device to work in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture including an instruction device, the instructions The device implements the functions specified in one block or multiple blocks of the flowchart one flow or multiple flows and / or block diagrams.
- These computer program instructions can also be loaded onto a computer or other programmable data processing device, so that a series of operating steps are performed on the computer or other programmable device to produce computer-implemented processing, which is executed on the computer or other programmable device
- the instructions provide steps for implementing the functions specified in one block or multiple blocks of the flowchart one flow or multiple flows and / or block diagrams.
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
Description
Claims (12)
- 一种挂车夹角的测量方法,其特征在于,应用于一种半挂车,所述半挂车包括牵引车和挂车;在所述牵引车的尾部两侧分别设置有至少一个激光雷达;在所述挂车的前部固定设置有具有反射面的反射板,所述反射面朝向所述激光雷达;所述挂车夹角的测量方法,包括:控制所述牵引车的尾部两侧分别设置的激光雷达发射激光,使得所述反射板通过所述反射面反射所述激光雷达发射的激光;控制各激光雷达分别接收反射板反射的各自对应的激光点云;根据各激光雷达接收到的各自对应的激光点云进行计算得到挂车夹角。
- 根据权利要求1所述的方法,其特征在于,在控制各激光雷达分别接收反射板反射的各自对应的激光点云之后,包括:对各激光雷达分别接收到的各自对应的激光点云进行预处理,得到各激光雷达各自对应的初始挂车夹角;根据预先设置的判断条件对各激光雷达各自对应的初始挂车夹角进行筛选。
- 根据权利要求2所述的方法,其特征在于,所述根据各激光雷达接收到的各自对应的激光点云进行计算得到挂车夹角,包括:将进行筛选后的各激光雷达各自对应的初始挂车夹角以当前周期中的采集时刻进行排列,形成待处理角度数据;根据所述待处理角度数据进行卡尔曼滤波处理,得到当前周期的挂车夹角。
- 根据权利要求3所述的方法,其特征在于,所述对各激光雷达分别接收到的各自对应的激光点云进行预处理,得到各激光雷达各自对应的初始挂车夹角,包括:对各激光雷达分别接收到的各自对应的激光点云进行感兴趣区域滤波,得到预设区域范围内的激光点云;所述预设区域范围是根据反射板随着挂车围绕牵引车的活动范围确定的;对所述预设区域范围内的激光点云进行噪点滤波,得到各激光雷达对应的噪点滤波后的激光点云;对各激光雷达对应的所述噪点滤波后的激光点云采用随机抽样一致性算法得到各激光雷达对应的一至多条激光点云形成的直线段,并从所述一至多条激光点云形成的直线段中确定各激光雷达对应的最长直线段;在激光雷达坐标系下,确定各最长直线段的直线方程和构成各最长直线段的激光点云的点数;根据各最长直线段的直线方程计算得到各激光雷达对应的初始挂车夹角。
- 根据权利要求4所述的方法,其特征在于,还包括:根据反射板随着挂车围绕牵引车的活动范围预先设置一个第一距离和第二距离;其中,所述第二距离大于所述第一距离;以用于连接牵引车和挂车的转轴为圆心,以所述第一距离和第二距离为半径,在激光扫描平面上得到第一圆区域和第二圆区域;将所述第一圆区域之外和第二圆区域之内的区域范围确定为所述预设区域范围。
- 根据权利要求4所述的方法,其特征在于,所述根据预先设置的判断条件对各激光雷达各自对应的初始挂车夹角进行筛选,包括:判断各最长直线段的激光点云的点数是否小于预先设置的点数阈值;将最长直线段的激光点云的点数小于所述预先设置的点数阈值的激光雷达对应的初始挂车夹角剔除,保留最长直线段的激光点云的点数大于等于所述预先设置的点数阈值的激光雷达对应的初始挂车夹角。
- 根据权利要求4所述的方法,其特征在于,所述根据预先设置的判断条件对各激光雷达各自对应的初始挂车夹角进行筛选,包括:在当前周期非第一周期时,判断当前周期的各激光雷达各自对应的初始挂车夹角与进行卡尔曼滤波处理得到的上一周期的挂车夹角的偏差角度值是否大于预先设置的偏差角度阈值;若当前周期的激光雷达对应的初始挂车夹角与进行卡尔曼滤波处理得到的上一周期的挂车夹角的偏差角度值大于预先设置的偏差角度阈值,则将当前周期的该激光雷达对应的初始挂车夹角剔除;若当前周期的激光雷达对应的初始挂车夹角与进行卡尔曼滤波处理得到的上一周期的挂车夹角的偏差角度值小于等于预先设置的偏差角度阈值,则将当前周期的该激光雷达对应的初始挂车夹角保留。
- 一种挂车夹角的测量装置,其特征在于,该装置应用于一种半挂车,所述半挂车包括牵引车和挂车;在所述牵引车的尾部两侧分别设置有至少一个激光雷达;在所述挂车的前部固定设置有具有反射面的反射板,所述反射面朝向所述激光雷达;该装置与所述激光雷达通信连接;该装置包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现挂车夹角的测量处理,该处理包括:控制所述牵引车的尾部两侧分别设置的激光雷达发射激光,使得所述反射板通过所述反射面反射所述激光雷达发射的激光;控制各激光雷达分别接收反射板反射的各自对应的激光点云;根据各激光雷达接收到的各自对应的激光点云进行计算得到挂车夹角。
- 一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现挂车夹角的测量处理,该处理应用于一种半挂车,所述半挂车包括牵引车和挂车; 在所述牵引车的尾部两侧分别设置有至少一个激光雷达;在所述挂车的前部固定设置有具有反射面的反射板,所述反射面朝向所述激光雷达;该处理包括:控制所述牵引车的尾部两侧分别设置的激光雷达发射激光,使得所述反射板通过所述反射面反射所述激光雷达发射的激光;控制各激光雷达分别接收反射板反射的各自对应的激光点云;根据各激光雷达接收到的各自对应的激光点云进行计算得到挂车夹角。
- 一种车辆,其特征在于,包括挂车夹角的测量装置,以及牵引车和挂车;在所述牵引车的尾部两侧分别设置有至少一个激光雷达;在所述挂车的前部固定设置有具有反射面的反射板,所述反射面朝向所述激光雷达;所述挂车夹角的测量装置与所述激光雷达通信连接;所述挂车夹角的测量装置包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现挂车夹角的测量处理,该处理包括:控制所述牵引车的尾部两侧分别设置的激光雷达发射激光,使得所述反射板通过所述反射面反射所述激光雷达发射的激光;控制各激光雷达分别接收反射板反射的各自对应的激光点云;根据各激光雷达接收到的各自对应的激光点云进行计算得到挂车夹角。
- 根据权利要求10所述的车辆,其特征在于,所述牵引车的尾部两侧通过第一紧固件与各激光雷达固定连接。
- 根据权利要求11所述的车辆,其特征在于,所述第一紧固件为第一支撑梁,所述第一支撑梁固定于所述牵引车尾部的横梁,所述激光雷达固定于所述第一支撑梁背离所述牵引车的一侧、且朝向所述反射板发射激光。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
AU2019382367A AU2019382367A1 (en) | 2018-11-20 | 2019-03-06 | Method and device for measuring trailer included angle, and vehicle |
EP19887255.8A EP3885796B1 (en) | 2018-11-20 | 2019-03-06 | Method and means for measuring a trailer angle, and corresponding vehicle |
US17/325,151 US12044523B2 (en) | 2018-11-20 | 2021-05-19 | Method and device for measuring trailer included angle, and vehicle |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811381350.1 | 2018-11-20 | ||
CN201811381350.1A CN111288930A (zh) | 2018-11-20 | 2018-11-20 | 一种挂车夹角的测量方法、装置及车辆 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US17/325,151 Continuation US12044523B2 (en) | 2018-11-20 | 2021-05-19 | Method and device for measuring trailer included angle, and vehicle |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2020103354A1 true WO2020103354A1 (zh) | 2020-05-28 |
Family
ID=70773483
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2019/077074 WO2020103354A1 (zh) | 2018-11-20 | 2019-03-06 | 一种挂车夹角的测量方法、装置及车辆 |
Country Status (5)
Country | Link |
---|---|
US (1) | US12044523B2 (zh) |
EP (1) | EP3885796B1 (zh) |
CN (2) | CN111288930A (zh) |
AU (1) | AU2019382367A1 (zh) |
WO (1) | WO2020103354A1 (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111928795A (zh) * | 2020-09-04 | 2020-11-13 | 浙江省计量科学研究院 | 一种牵引车、挂车外廓尺寸参数一并式测量方法 |
EP4098490A1 (en) * | 2021-06-02 | 2022-12-07 | Beijing Tusen Zhitu Technology Co., Ltd. | Sensor bracket and vehicle |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116184417A (zh) * | 2018-12-10 | 2023-05-30 | 北京图森智途科技有限公司 | 一种挂车夹角的测量方法、装置及车辆 |
CN111115300B (zh) * | 2020-03-31 | 2020-06-30 | 上海驭矩信息科技有限公司 | 一种自动化集装箱装卸装置及方法 |
CN112082484A (zh) * | 2020-09-11 | 2020-12-15 | 武汉理工大学 | 一种基于单线激光雷达检测工程车车身偏移的装置及方法 |
CN111830526B (zh) * | 2020-09-17 | 2020-12-29 | 上海驭矩信息科技有限公司 | 一种基于多线激光数据融合的集装箱定位方法及装置 |
CN112362055B (zh) * | 2020-12-01 | 2022-12-30 | 苏州挚途科技有限公司 | 姿态估计方法、装置和电子设备 |
CN113063396B (zh) * | 2021-03-19 | 2022-09-27 | 北京斯年智驾科技有限公司 | 一种半挂车夹角的检测方法、装置、设备及存储介质 |
CN113251993B (zh) * | 2021-04-08 | 2022-11-08 | 杭州飞步科技有限公司 | 偏转角的检测方法、装置、计算机设备和可读存储介质 |
CN113917479B (zh) * | 2021-09-30 | 2024-06-25 | 广州文远知行科技有限公司 | 一种车辆夹角的计算方法、装置、计算机设备和存储介质 |
CN114115030B (zh) * | 2021-11-19 | 2024-02-09 | 杭州豪盛电动车辆有限公司 | 车辆协同运输方法、设备、系统及计算机可读存储介质 |
FI130077B (en) * | 2021-12-07 | 2023-01-31 | Cargotec Finland Oy | EVALUATION OF THE ATTACHMENT ANGLE FOR THE DRIVE UNIT-TRAILER COMBINATION |
CN114279452B (zh) * | 2021-12-29 | 2024-04-12 | 北京斯年智驾科技有限公司 | 无人集卡挂车姿态检测方法及检测系统 |
CN116499420B (zh) * | 2023-05-23 | 2023-10-17 | 清华大学 | 一种半挂车与牵引车之间的夹角的测量方法及系统 |
CN117657295B (zh) * | 2024-02-02 | 2024-05-28 | 盛视科技股份有限公司 | 拖挂车转向角检测方法及检测系统 |
CN118330668B (zh) * | 2024-06-17 | 2024-08-13 | 四川凉山水洛河电力开发有限公司 | 一种崩塌落石空间运动轨迹提取方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002053082A (ja) * | 2000-05-30 | 2002-02-19 | Isuzu Motors Ltd | トレーラ連結角検出装置 |
US20080186204A1 (en) * | 2007-02-02 | 2008-08-07 | Buckley Stephen J | Trailer detection system |
CN107804226A (zh) * | 2016-09-08 | 2018-03-16 | 德尔福技术有限公司 | 拖车车道偏离警告和摇摆警报 |
CN107976194A (zh) * | 2017-11-24 | 2018-05-01 | 北京奇虎科技有限公司 | 环境地图的调整方法及装置 |
CN108278981A (zh) * | 2018-02-11 | 2018-07-13 | 北京主线科技有限公司 | 检测无人驾驶挂车轴偏角的装置及其检测方法 |
CN108761481A (zh) * | 2018-04-09 | 2018-11-06 | 北京图森未来科技有限公司 | 一种挂箱夹角测量系统及测量方法、半挂车 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001334966A (ja) * | 2000-03-24 | 2001-12-04 | Isuzu Motors Ltd | トレーラ連結角検出装置 |
CN105488498B (zh) * | 2016-01-15 | 2019-07-30 | 武汉中海庭数据技术有限公司 | 一种基于激光点云的车道边线自动提取方法及系统 |
US10710585B2 (en) * | 2017-09-01 | 2020-07-14 | Ford Global Technologies, Llc | Trailer backup assist system with predictive hitch angle functionality |
US10871780B2 (en) * | 2018-01-30 | 2020-12-22 | Uatc, Llc | Intermediate mounting component and sensor system for a Mansfield bar of a cargo trailer |
US11200430B2 (en) * | 2018-11-05 | 2021-12-14 | Tusimple, Inc. | Systems and methods for detecting trailer angle |
-
2018
- 2018-11-20 CN CN201811381350.1A patent/CN111288930A/zh active Pending
- 2018-11-20 CN CN202311480644.0A patent/CN117470134A/zh active Pending
-
2019
- 2019-03-06 WO PCT/CN2019/077074 patent/WO2020103354A1/zh unknown
- 2019-03-06 EP EP19887255.8A patent/EP3885796B1/en active Active
- 2019-03-06 AU AU2019382367A patent/AU2019382367A1/en active Pending
-
2021
- 2021-05-19 US US17/325,151 patent/US12044523B2/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002053082A (ja) * | 2000-05-30 | 2002-02-19 | Isuzu Motors Ltd | トレーラ連結角検出装置 |
US20080186204A1 (en) * | 2007-02-02 | 2008-08-07 | Buckley Stephen J | Trailer detection system |
CN107804226A (zh) * | 2016-09-08 | 2018-03-16 | 德尔福技术有限公司 | 拖车车道偏离警告和摇摆警报 |
CN107976194A (zh) * | 2017-11-24 | 2018-05-01 | 北京奇虎科技有限公司 | 环境地图的调整方法及装置 |
CN108278981A (zh) * | 2018-02-11 | 2018-07-13 | 北京主线科技有限公司 | 检测无人驾驶挂车轴偏角的装置及其检测方法 |
CN108761481A (zh) * | 2018-04-09 | 2018-11-06 | 北京图森未来科技有限公司 | 一种挂箱夹角测量系统及测量方法、半挂车 |
Non-Patent Citations (1)
Title |
---|
See also references of EP3885796A4 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111928795A (zh) * | 2020-09-04 | 2020-11-13 | 浙江省计量科学研究院 | 一种牵引车、挂车外廓尺寸参数一并式测量方法 |
CN111928795B (zh) * | 2020-09-04 | 2021-10-01 | 浙江省计量科学研究院 | 一种牵引车、挂车外廓尺寸参数一并式测量方法 |
EP4098490A1 (en) * | 2021-06-02 | 2022-12-07 | Beijing Tusen Zhitu Technology Co., Ltd. | Sensor bracket and vehicle |
Also Published As
Publication number | Publication date |
---|---|
CN117470134A (zh) | 2024-01-30 |
AU2019382367A1 (en) | 2021-07-08 |
EP3885796B1 (en) | 2024-07-10 |
EP3885796A4 (en) | 2022-08-10 |
EP3885796A1 (en) | 2021-09-29 |
CN111288930A (zh) | 2020-06-16 |
US20210356261A1 (en) | 2021-11-18 |
US12044523B2 (en) | 2024-07-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2020103354A1 (zh) | 一种挂车夹角的测量方法、装置及车辆 | |
JP7553668B2 (ja) | トレーラ挟角の測定方法、装置及び車両 | |
US11982747B2 (en) | Systems and methods for generating synthetic sensor data | |
CN113432553B (zh) | 一种挂车夹角的测量方法、装置及车辆 | |
JP7045816B2 (ja) | 検査ステーションに配置された車両の最外寸法を測定するための方法及びシステム | |
CN111366901B (zh) | 标定车载毫米波雷达方位角度安装偏差的方法及装置 | |
JP2018194562A (ja) | 道路境界検出方法及び装置 | |
CN109085829B (zh) | 一种动静态目标识别方法 | |
US20200158840A1 (en) | Multi-mode multi-sensor calibration | |
WO2020191978A1 (zh) | Sar成像方法及其成像系统 | |
US11677931B2 (en) | Automated real-time calibration | |
CN112513679A (zh) | 一种目标识别的方法和装置 | |
CN111580066A (zh) | 转向角度检测方法、装置及系统 | |
CN118050719A (zh) | 半挂车的挂车角度测量方法、装置、电子设备及车辆 | |
CN113771839A (zh) | 一种自动泊车决策规划方法及系统 | |
WO2022267711A1 (zh) | 地面点云分割方法和装置及自动驾驶车辆 | |
CN114399399B (zh) | 矿区车辆的卸载停靠方法、装置、计算机设备及存储介质 | |
WO2022217819A1 (zh) | 目标速度估计方法、装置以及存储介质 | |
US11887272B2 (en) | Method and system for determining a spatial transformation employing partial dimension iterative closest point | |
CN118665471A (zh) | 车辆的控制方法、装置、设备及存储介质 | |
CN114185026A (zh) | 一种车载多激光雷达的外参标定方法、装置及电子设备 | |
CN115128620A (zh) | 一种确定对象位置的方法、装置及设备 | |
CN114995268A (zh) | 一种调整挂车位姿的方法、装置、电子设备及存储介质 | |
JPS60127410A (ja) | 車両用障害物検出装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 19887255 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2019887255 Country of ref document: EP Effective date: 20210621 |
|
ENP | Entry into the national phase |
Ref document number: 2019382367 Country of ref document: AU Date of ref document: 20190306 Kind code of ref document: A |