CN110208784B - Auxiliary measuring method for hinge angle of unmanned articulated vehicle based on millimeter wave radar - Google Patents
Auxiliary measuring method for hinge angle of unmanned articulated vehicle based on millimeter wave radar Download PDFInfo
- Publication number
- CN110208784B CN110208784B CN201910556461.XA CN201910556461A CN110208784B CN 110208784 B CN110208784 B CN 110208784B CN 201910556461 A CN201910556461 A CN 201910556461A CN 110208784 B CN110208784 B CN 110208784B
- Authority
- CN
- China
- Prior art keywords
- rigid body
- millimeter wave
- relative
- wave radar
- angle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- 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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
- G01S13/06—Systems determining position data of a target
- G01S13/46—Indirect determination of position data
Abstract
The invention discloses an auxiliary measuring method for an articulation angle of an unmanned articulated vehicle based on a millimeter wave radar, which comprises the following steps: (1) respectively installing millimeter wave radars on the side surfaces of a front rigid body and a rear rigid body of the articulated vehicle, and enabling the articulated vehicle to run to a base surface to obtain the distance between each millimeter wave radar and the base surface; (2) calculating the relative included angle of the front rigid body and the relative included angle of the rear rigid body according to the relative distance of the millimeter wave radar on the front rigid body and the relative distance and distance of the millimeter wave radar on the rear rigid body; (3) calculating a relative hinge angle of the front rigid body and the rear rigid body at the hinge joint according to the relative included angle; (4) and calculating the absolute articulation angle in the control of the articulated vehicle according to the relative articulation angle. The distance between the front rigid body and the rear rigid body relative to the base surface is measured by taking the base surface as a reference surface for detection of the millimeter wave radar, and the angle of the hinge of the front rigid body and the rear rigid body is calculated by combining the installation distance of the millimeter wave radar, so that the complexity of the millimeter wave radar is reduced, and the practicability of measurement is improved.
Description
Technical Field
The invention belongs to the field of vehicle control, and particularly relates to an auxiliary measuring method for an articulation angle of an unmanned articulated vehicle based on a millimeter wave radar.
Background
An articulated vehicle is formed by connecting a plurality of rigid bodies by means of an articulation device, and the direction of movement of the vehicle is changed by means of mutual rotation of the articulation.
In recent years, the control technology of the unmanned articulated vehicle is gradually developed, the articulated vehicle is easy to generate instability and sideslip phenomena during steering and lateral adjustment compared with a single rigid body vehicle, and in the unmanned articulated vehicle control, the articulation angle of a plurality of rigid body articulation parts of the articulated vehicle directly influences the smoothness and stability of the vehicle during driving. Therefore, the measured degree of articulation angle is an important quantity for vehicle control, and the accuracy of its articulation angle is extremely important to the effectiveness of vehicle control.
At present, the hinge angle of the articulated vehicle is generally obtained by directly measuring by using an angle sensor, the measuring method has higher requirements on the measuring precision and the mounting precision of the sensor, and the adaptation degrees of the hinge parts of different articulated vehicles are different, so that the measuring precision of the hinge angle of the articulated vehicle is influenced, and the measuring practicability is poor. In addition, a laser range finder and a camera are arranged among the rigid bodies, and the mutual relation among the rigid bodies is measured to obtain the hinge angle in an auxiliary measurement mode.
Disclosure of Invention
The invention aims to provide the auxiliary measuring method for the articulation angle of the unmanned articulated vehicle based on the millimeter wave radar, which is simple to operate, high in measuring precision and has an auxiliary measuring effect.
The technical scheme of the invention is as follows:
an articulation angle auxiliary measurement method of an unmanned articulated vehicle based on a millimeter wave radar comprises the following steps:
(1) installing 2 millimeter wave radars on the side surface of the front rigid body of the articulated vehicle, installing 2 millimeter wave radars on the side surface of the rear rigid body, detecting the base surface by each millimeter wave radar, and sequentially obtaining the distance between each millimeter wave radar and the base surface as b2、a2、b1、a1；
(2) According to the relative distance S of the 2 millimeter wave radars on the front rigid body in the step (1)2Relative distance S of 2 millimeter wave radars on rear rigid body1And (2) calculating the relative included angle alpha of the front rigid body according to the distance between each millimeter wave radar and the base surface obtained by detection in the step (1)2Relative included angle alpha with rear rigid body1Calculated by the following formula:
(3) obtaining the relative included angle alpha of the front rigid body according to the step (2)2And rear rigid bodyRelative included angle alpha1And calculating a relative articulation angle alpha of the front rigid body and the rear rigid body of the articulated vehicle at the articulation position, wherein the relative articulation angle alpha is calculated by the following formula:
α＝α2-α1；
(4) calculating an absolute articulation angle α' in the control of the articulated vehicle from the relative articulation angle α obtained in the step (3), by the following formula:
α′＝90-α。
in the above technical solution, the absolute hinge angle degree obtained in the step (4) is defined to vary within 0-180 °, and the hinge angle degree is 90 ° when the front rigid body and the rear rigid body are opposite.
In the above technical solution, the base surface has rigidity and the surface of the base surface is flat.
Another object of the present invention is to provide an application of the method for auxiliary measurement of the hinge angle of the unmanned articulated vehicle based on millimeter wave radar in the tunnel construction environment, wherein the foundation surface is the side wall of the tunnel as the foundation surface, and the measurement of the relative hinge angle is realized through the above steps (1) - (4).
Another object of the present invention is to provide an application of the method for auxiliary measurement of the hinge angle of the unmanned articulated vehicle based on millimeter wave radar in the dam construction environment, wherein the foundation surface is the side wall of the dam, and the measurement of the relative hinge angle is realized through the above steps (1) - (4).
The invention has the advantages and positive effects that:
1. the unmanned articulated vehicle runs to the base surface to be used as a reference surface for detection of the millimeter wave radar, the position distance relation of the front rigid body and the rear rigid body of the articulated vehicle relative to the base surface is measured through the millimeter wave radar, the mounting distance between the millimeter wave radars mounted on the front rigid body and the rear rigid body of the articulated vehicle is combined to convert to obtain the angle of the hinge position of the front rigid body and the rear rigid body, the base surface is built in a vehicle running environment to assist the millimeter wave radar to measure, the complexity and the mounting cost of the millimeter wave radars are reduced, and the practicability and the feasibility of the measuring method are improved.
2. The measuring method has low requirements on the installation position and the cleanliness of the millimeter wave radar, and the hinge angle of the hinge joint is accurately measured by the aid of the base surface.
Drawings
Fig. 1 is a schematic view of the measurement principle of the present invention.
In the figure:
1. front rigid body 2 of articulated vehicle, rear rigid body 3 of articulated vehicle, first millimeter wave radar
4. A second millimeter wave radar 5, a base surface 6, and a third millimeter wave radar
7. Fourth millimeter wave radar 8, articulated vehicle articulation
Detailed Description
The present invention will be described in further detail with reference to specific examples. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the scope of the invention in any way.
Example 1
As shown in fig. 1, the method for auxiliary measurement of the articulation angle of the unmanned articulated vehicle based on the millimeter wave radar of the invention comprises the following steps:
(1) installing a first millimeter wave radar and a second millimeter wave radar on the side surface of a front rigid body of an articulated vehicle, installing a third millimeter wave radar and a fourth millimeter wave radar on the side surface of a rear rigid body, wherein a base surface exists in the running environment of the articulated vehicle, the base surface is arranged on the side surface of the running direction of the articulated vehicle, the base surface is used as a running area constraint surface of the unmanned articulated vehicle, the base surface is detected through each millimeter wave radar, and the distances between the first millimeter wave radar, the second millimeter wave radar and the fourth millimeter wave radar and the base surface are sequentially obtained as b2、a2、b1、a1；
(2) According to the relative distance S between the first millimeter wave radar and the second millimeter wave radar on the rigid body before the step (1)2And the relative distance S between the third millimeter wave radar and the fourth millimeter wave radar on the rear rigid body1And b detected in step (1)2、a2、b1、a1Meter for measuringCalculating the relative included angle alpha of the front rigid body1Relative included angle alpha with rear rigid body2Calculated by the following formula:
(3) obtaining the relative included angle alpha of the front rigid body according to the step (2)1Relative included angle alpha with rear rigid body2And calculating a relative articulation angle alpha of the front rigid body and the rear rigid body of the articulated vehicle at the articulation position, wherein the relative articulation angle alpha is calculated by the following formula:
α＝α2-α1；
(4) calculating an absolute articulation angle alpha' in the control of the articulated vehicle according to the relative articulation angle alpha obtained in the step (3), and calculating by the following formula:
α′＝90-α
wherein, the absolute hinge angle degree obtained by definition changes within 0-180 degrees, and the hinge angle degree is 90 degrees when the front rigid body and the rear rigid body are opposite.
Further, the base surface has rigidity and the surface of the base surface is flat.
Example 2
Based on embodiment 1, the method for auxiliary measurement of the articulation angle of the unmanned articulated vehicle based on the millimeter wave radar is applied to a tunnel construction environment, a tunnel exists in the operation environment of the articulated vehicle, and the relative articulation angle between the front rigid body and the rear rigid body of the articulated vehicle is calculated by using the inner side wall of the tunnel as a base surface through the steps (1) to (4) in embodiment 1.
Example 3
Based on embodiment 1, the method for auxiliary measurement of the articulation angle of the unmanned articulated vehicle based on the millimeter wave radar is applied to a dam construction environment, a dam exists in the operation environment of the articulated vehicle, and the relative articulation angle between the front rigid body and the rear rigid body of the articulated vehicle is calculated by using the side wall of the dam as a base surface through the steps (1) to (4) in embodiment 1.
Spatially relative terms, such as "upper," "lower," "left," "right," and the like, may be used in the embodiments for ease of description to describe one element or feature's relationship to another element or feature as illustrated in the figures. It will be understood that the spatial terms are intended to encompass different orientations of the device in use or operation in addition to the orientation depicted in the figures. For example, if the device in the figures is turned over, elements described as "below" other elements or features would then be oriented "above" the other elements or features. Thus, the exemplary term "lower" can encompass both an upper and a lower orientation. The device may be otherwise oriented (rotated 90 degrees or at other orientations) and the spatially relative descriptors used herein interpreted accordingly.
Moreover, relational terms such as "first" and "second," and the like, may be used solely to distinguish one element from another element having the same name, without necessarily requiring or implying any actual such relationship or order between such elements.
The invention has been described in an illustrative manner, and it is to be understood that any simple variations, modifications or other equivalent changes which can be made by one skilled in the art without departing from the spirit of the invention fall within the scope of the invention.
Claims (5)
1. An articulation angle auxiliary measurement method of an unmanned articulated vehicle based on a millimeter wave radar is characterized by comprising the following steps:
(1) installing 2 millimeter wave radars on the side surface of the front rigid body of the articulated vehicle, installing 2 millimeter wave radars on the side surface of the rear rigid body, detecting the base surface by each millimeter wave radar, and sequentially obtaining the distance between each millimeter wave radar and the base surface as b2、a2、b1、a1；
(2) According to the relative distance S of the 2 millimeter wave radars on the front rigid body in the step (1)2Rear rigid body2 relative distance S of the millimeter wave radar1And (2) calculating the relative included angle alpha of the front rigid body according to the distance between each millimeter wave radar and the base surface obtained by detection in the step (1)2Relative included angle alpha with rear rigid body1Calculated by the following formula:
(3) obtaining the relative included angle alpha of the front rigid body according to the step (2)2Relative included angle alpha with rear rigid body1And calculating a relative articulation angle alpha of the front rigid body and the rear rigid body of the articulated vehicle at the articulation position, wherein the relative articulation angle alpha is calculated by the following formula:
α＝α2-α1；
(4) calculating an absolute articulation angle α' in the control of the articulated vehicle from the relative articulation angle α obtained in the step (3), by the following formula:
α′＝90-α。
2. the articulation angle aided measurement method of claim 1, wherein: defining that the absolute hinge angle degree obtained in the step (4) changes within 0-180 degrees, and the hinge angle degree is 90 degrees when the front rigid body and the rear rigid body are opposite.
3. The articulation angle aided measurement method of claim 1, wherein: the base surface has rigidity and the surface of the base surface is flat.
4. Use of an articulation angle auxiliary measurement method according to claim 1 in a tunnel construction environment, characterized in that: the foundation surface is the side wall of the tunnel, and the measurement of the relative hinge angle is realized through the steps (1) to (4).
5. Use of the method of claim 1 in an environment of dam construction for aiding in the measurement of the angle of articulation, wherein: the foundation surface is the side wall of the dam, and the measurement of the relative hinge angle is realized through the steps (1) to (4).
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910556461.XA CN110208784B (en) | 2019-06-25 | 2019-06-25 | Auxiliary measuring method for hinge angle of unmanned articulated vehicle based on millimeter wave radar |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910556461.XA CN110208784B (en) | 2019-06-25 | 2019-06-25 | Auxiliary measuring method for hinge angle of unmanned articulated vehicle based on millimeter wave radar |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110208784A CN110208784A (en) | 2019-09-06 |
| CN110208784B true CN110208784B (en) | 2022-01-18 |
Family
ID=67794416
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910556461.XA Active CN110208784B (en) | 2019-06-25 | 2019-06-25 | Auxiliary measuring method for hinge angle of unmanned articulated vehicle based on millimeter wave radar |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110208784B (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111141293A (en) * | 2019-12-13 | 2020-05-12 | 苏州智加科技有限公司 | Vehicle positioning method, device, equipment and storage medium |
| EP4105676A1 (en) * | 2021-06-16 | 2022-12-21 | Robert Bosch GmbH | Driver assistance system and method for operating a driver assistance system |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4255901A (en) * | 1977-09-29 | 1981-03-17 | Stenberg Sven Eric | Window device |
| US5001639A (en) * | 1989-12-20 | 1991-03-19 | Eaton Corporation | Tractor trailer articulation control system and method |
| US5488862A (en) * | 1993-10-18 | 1996-02-06 | Armand P. Neukermans | Monolithic silicon rate-gyro with integrated sensors |
| US20060025894A1 (en) * | 2004-07-30 | 2006-02-02 | Integrinautics Corporation | Vehicle control system with user-guided calibration |
| CN101332836A (en) * | 2007-06-27 | 2008-12-31 | 通用汽车环球科技运作公司 | Trailer articulation angle estimation |
| US8487915B1 (en) * | 2003-09-11 | 2013-07-16 | Luidia Inc. | Mobile device incorporating projector and pen-location transcription system |
| US20150145713A1 (en) * | 2013-11-26 | 2015-05-28 | The Regents Of The University Of Michigan | Retro-reflective radar patch antenna target for articulated vehicle trailer sensing |
| WO2018162031A1 (en) * | 2017-03-06 | 2018-09-13 | Volvo Truck Corporation | Methods for assisting automatic uncoupling/coupling of a trailer |
| CN108535861A (en) * | 2017-03-06 | 2018-09-14 | 船井电机株式会社 | Reflection unit |
-
2019
- 2019-06-25 CN CN201910556461.XA patent/CN110208784B/en active Active
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4255901A (en) * | 1977-09-29 | 1981-03-17 | Stenberg Sven Eric | Window device |
| US5001639A (en) * | 1989-12-20 | 1991-03-19 | Eaton Corporation | Tractor trailer articulation control system and method |
| US5488862A (en) * | 1993-10-18 | 1996-02-06 | Armand P. Neukermans | Monolithic silicon rate-gyro with integrated sensors |
| US8487915B1 (en) * | 2003-09-11 | 2013-07-16 | Luidia Inc. | Mobile device incorporating projector and pen-location transcription system |
| US20060025894A1 (en) * | 2004-07-30 | 2006-02-02 | Integrinautics Corporation | Vehicle control system with user-guided calibration |
| CN101332836A (en) * | 2007-06-27 | 2008-12-31 | 通用汽车环球科技运作公司 | Trailer articulation angle estimation |
| US20150145713A1 (en) * | 2013-11-26 | 2015-05-28 | The Regents Of The University Of Michigan | Retro-reflective radar patch antenna target for articulated vehicle trailer sensing |
| WO2018162031A1 (en) * | 2017-03-06 | 2018-09-13 | Volvo Truck Corporation | Methods for assisting automatic uncoupling/coupling of a trailer |
| CN108535861A (en) * | 2017-03-06 | 2018-09-14 | 船井电机株式会社 | Reflection unit |
Non-Patent Citations (2)
| Title |
|---|
| 反应式导航在地下自主行驶铲运机中的应用;杨超 等;《煤炭学报》;20111115;第36卷(第11期);第1943-1948页 * |
| 基于参数自适应的电动汽车整车质量辨识算法;谢辉 等;《汽车安全与节能学报》;20190615;第10卷(第2期);第219-225页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110208784A (en) | 2019-09-06 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US11015925B2 (en) | Flexible display and method for measuring angle of the same | |
| CN110531357B (en) | Method for estimating speed of moving target in horizontal plane and radar detection system | |
| Rose et al. | An integrated vehicle navigation system utilizing lane-detection and lateral position estimation systems in difficult environments for GPS | |
| CN111380573B (en) | Method for calibrating the orientation of a moving object sensor | |
| CN110208784B (en) | Auxiliary measuring method for hinge angle of unmanned articulated vehicle based on millimeter wave radar | |
| US20100235129A1 (en) | Calibration of multi-sensor system | |
| US20210264171A1 (en) | Method and apparatus for estimating position | |
| US20180202812A1 (en) | Target recognition and localization methods using a laser sensor for wheeled mobile robots | |
| CN103487034A (en) | Method for measuring distance and height by vehicle-mounted monocular camera based on vertical type target | |
| CN108345021B (en) | Doppler radar assisted GPS/INS vehicle speed measurement method | |
| US20210223776A1 (en) | Autonomous vehicle with on-board navigation | |
| CN112710339A (en) | Method and apparatus for calibrating vehicle sensors | |
| WO2023050567A1 (en) | Dead correction method based on scenario recognition by millimeter-wave vehicle-mounted radar | |
| US11908206B2 (en) | Compensation for vertical road curvature in road geometry estimation | |
| CN112810664B (en) | Online real-time measurement system and method for track line curvature | |
| WO2017109978A1 (en) | Distance estimation device, distance estimation method, and program | |
| CN113074757A (en) | Calibration method for vehicle-mounted inertial navigation installation error angle | |
| CN105717500A (en) | Laser radar and data correcting method thereof | |
| EP3699630A1 (en) | System and method for compensating a motion of a vehicle component | |
| KR20190141628A (en) | Flexible display and method for measuring angle of the same | |
| CN103335618A (en) | Inner load attitude measurement device for onboard photoelectric platform | |
| JP6707627B2 (en) | Measuring device, measuring method, and program | |
| CN102829764B (en) | Measurement method for absolute swaying quantity of unstable platform in follow-up mode | |
| KR101255024B1 (en) | Relative localization system and method using ultrasonic sensor | |
| WO2017168588A1 (en) | Measurement device, measurement method, and program |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |