CN114407877B - Automatic parking positioning method based on wheel speed pulse and IMU (inertial measurement Unit) - Google Patents
Automatic parking positioning method based on wheel speed pulse and IMU (inertial measurement Unit) Download PDFInfo
- Publication number
- CN114407877B CN114407877B CN202210182638.6A CN202210182638A CN114407877B CN 114407877 B CN114407877 B CN 114407877B CN 202210182638 A CN202210182638 A CN 202210182638A CN 114407877 B CN114407877 B CN 114407877B
- Authority
- CN
- China
- Prior art keywords
- wheel
- wheel speed
- vehicle
- speed pulse
- imu
- 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
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000005259 measurement Methods 0.000 title claims description 9
- 238000009499 grossing Methods 0.000 claims abstract description 13
- 238000001914 filtration Methods 0.000 claims abstract description 11
- 239000011159 matrix material Substances 0.000 claims description 13
- 238000005096 rolling process Methods 0.000 claims description 5
- 230000005540 biological transmission Effects 0.000 claims description 3
- 230000004927 fusion Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/06—Automatic manoeuvring for parking
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/112—Roll movement
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
- B60W2050/0052—Filtering, filters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2510/00—Input parameters relating to a particular sub-units
- B60W2510/20—Steering systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/28—Wheel speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2540/00—Input parameters relating to occupants
- B60W2540/18—Steering angle
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Human Computer Interaction (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention belongs to the technical field of automatic driving, and particularly relates to a real-time positioning method of an automatic driving parking system. An automatic parking positioning method based on wheel speed pulse and IMU comprises the following steps: s1, performing speed smooth compensation on a wheel speed pulse signal of a vehicle; s2, calculating the turning radius ratio of the inner wheel and the outer wheel; s3, further smoothing the wheel speed pulse signal after smoothing in the S1; s4, calculating the yaw angular velocity of the vehicle based on the wheel speed pulse signal after compensation and smoothing; s5, fusing the vehicle yaw velocity value obtained in the S4 and the yaw velocity value measured in real time by the IMU by using Kalman filtering; and S6, carrying out track calculation based on the fused yaw angular velocity. The invention effectively solves the problems of high time delay, high cost and insufficient course precision in the turning process of the existing automatic parking positioning method.
Description
Technical Field
The invention belongs to the technical field of automatic driving, and particularly relates to a real-time positioning method of an automatic driving parking system.
Background
At present, traffic congestion in cities is increasing day by day, and particularly, the cities are crowded in residential areas, entertainment places, tourist attractions and other places, and available parking spaces are less and less. And with the continuous improvement of living standard of people, new drivers of driving increase year by year, and due to the lack of experience, the new drivers are easy to have various accidents in the process of parking. The automatic parking system is gradually becoming the key point of the next automobile consumption demand of people. In the passenger car parking system, the real-time positioning algorithm is definitely the most important one.
In the environment with serious signal shielding, such as dense building areas, large shopping malls and the like, the GPS positioning accuracy is rapidly reduced or even the positioning cannot be carried out due to the deterioration of the signal quality. The technology commonly used in automatic parking systems in mass-produced automobiles either does not involve a fusion algorithm or does not process data accurately enough, and the following problems generally exist: 1. the system latency is too high. 2. The heading accuracy under the vehicle turning condition is insufficient. 3. The problems of high cost of positioning by adopting a visual or ultrasonic radar, insufficient precision under special working conditions and the like. Therefore, an environmentally adaptable and low-cost vehicle positioning solution is particularly important for an automatic parking system.
Disclosure of Invention
The purpose of the invention is: aiming at the defects of the existing automatic parking positioning method, the automatic parking positioning method based on wheel speed pulse and IMU is provided.
The technical scheme of the invention is as follows: an automatic parking positioning method based on wheel speed pulses and an IMU (inertial measurement Unit) comprises the following steps:
s1, aiming at wheel speed pulse signals of vehiclesThe wheel speed pulse is collected, due to the limitation of the number of teeth, updating is unsmooth, if the pose of the vehicle body is updated by the wheel speed pulse only, the course shaking is severe, and meanwhile, the pose is also shaken seriously, so that the wheel speed pulse collected by a real vehicle needs to be processed, namely, the wheel speed pulse is subjected to smoothing processing by a speed compensation method to obtain the position/velocity ratio>
Wherein i is the number of frames,the original pulse signal measured for the ith frame, <' >>For a set initial pulse compensation value of width 10, <' > based on the pulse width>The pulse signal difference measured for two consecutive frames;
because the turning radiuses of the left and right rear wheels are not consistent in the turning process of the vehicle, the actual increased values of the wheel speed pulses of the left and right rear wheels in the turning process of the vehicle are not consistent and have a corresponding relation with the turning radiuses, namely the ratio of the turning radiuses of the left and right wheels is actually equal to the ratio of the increased values of the wheel speed pulses, and the wheel speed pulses are further compensated by utilizing the characteristic so as to be smoother;
s2, obtaining a front wheel steering angle signal delta (i) based on the steering wheel steering angle signal and the transmission ratio of the steering system, calculating the ratio r (i) of the turning radius of the inner wheel and the turning radius of the outer wheel,
wherein L is A For vehicle wheel base, L W The wheel base of the rear axle of the vehicle;
s3, further smoothing the wheel speed pulse signals smoothed in the S1 based on the inner and outer wheel turning radius ratio r (i) obtained in the S2 to obtain wheel speed pulse signalsAnd &>
Wherein:is the ith frame rotating angular speed of the right rear wheel, is greater than or equal to>Rotating the angular velocity for the ith frame of the left rear wheel;
s4, calculating the yaw angular velocity of the vehicle based on the wheel speed pulse signal after compensation smoothing
Wherein r is R Is the rolling radius of the wheel, and theta is the wheel deflection angle;
s5, the vehicle yaw velocity value obtained in the S4 is subjected toYaw angular velocity value measured in real time with IMUAs the input of the Kalman filtering state value, the fused state value is used for outputting a new yaw angular velocity->Kalman filtering involves a prediction and update process:
and (3) prediction process:
and (3) updating:
wherein Z (i) = [ omega ] M (i)ω IMU (i)]A is testThe quantity matrix is here [1 ]]Q is the measurement error, H is the state input matrix, here [1,1 ]]R is state input noise, and P is a covariance matrix;
s6, obtaining a new yaw velocity based on the S5And carrying out dead reckoning to obtain the update of the vehicle position in the transverse direction and the longitudinal direction.
Has the advantages that: the invention utilizes various signals collected by the existing real vehicle and Kalman filtering fusion and other methods with IMU output data to calculate the pose of the vehicle body in real time, processes the vehicle body state information transmitted in real time and ensures the real-time property; only IMU (inertial measurement unit) arranged on the vehicle body and signals acquired by a real vehicle are utilized, and visual information or information of an ultrasonic radar is not utilized, so that the cost is greatly reduced; the wheel speed pulse is compensated by the ratio of the turning radius calculated by utilizing the steering wheel information, so that the accuracy of the vehicle in the turning process is ensured. The invention effectively solves the problems of high time delay, high cost and insufficient course precision in the turning process of the existing automatic parking positioning method.
Drawings
FIG. 1 is a flow chart of the present invention.
Detailed Description
Embodiment 1, referring to fig. 1, an automatic parking position determining method based on wheel speed pulses and IMU includes the following steps:
s1, aiming at wheel speed pulse signals of vehiclesThe wheel speed pulse is collected, due to the limitation of the number of teeth, updating is unsmooth, if the pose of the vehicle body is updated by the wheel speed pulse only, the course shaking is severe, and meanwhile, the pose is also shaken seriously, so that the wheel speed pulse collected by a real vehicle needs to be processed, namely, the wheel speed pulse is subjected to smoothing processing by a speed compensation method to obtain the position/velocity ratio>
Wherein i is the number of frames,the original pulse signal measured for the ith frame, <' >>For a set initial pulse compensation value of width 10>The pulse signal difference measured for two consecutive frames;
because the turning radiuses of the left and right rear wheels are not consistent in the turning process of the vehicle, the actual increased values of the wheel speed pulses of the left and right rear wheels in the turning process of the vehicle are not consistent and have a corresponding relation with the turning radiuses, namely the ratio of the turning radiuses of the left and right wheels is actually equal to the ratio of the increased values of the wheel speed pulses, and the wheel speed pulses are further compensated by utilizing the characteristic so as to be smoother;
s2, obtaining a front wheel steering angle signal delta (i) based on the steering wheel steering angle signal and the transmission ratio of the steering system, calculating the ratio r (i) of the turning radius of the inner wheel and the turning radius of the outer wheel,
wherein L is A For vehicle wheel base, L W The wheel base of the rear axle of the vehicle;
s3, further smoothing the wheel speed pulse signals smoothed in the S1 based on the inner and outer wheel turning radius ratio r (i) obtained in the S2 to obtain wheel speed pulse signalsAnd &>
Wherein:is the ith frame rotation angular speed of the right rear wheel>Rotating the angular velocity for the ith frame of the left rear wheel;
s4, calculating the yaw angular velocity of the vehicle based on the wheel speed pulse signals after compensation smoothing
Wherein r is R Is the rolling radius of the wheel, and theta is the wheel deflection angle;
s5, the vehicle yaw velocity value obtained in the S4 is subjected toYaw angular velocity value measured in real time with IMUAs the input of the Kalman filtering state value, the fused state value is used for outputting a new yaw angular velocity->Kalman filtering involves a prediction and update process:
and (3) prediction process:
and (3) updating:
wherein Z (i) = [ omega ] M (i)ω IMU (i)]A is a measurement matrix here [1 ]]Q is the measurement error, H is the state input matrix, here [1,1 ]]R is state input noise, and P is a covariance matrix;
s6, obtaining a new yaw velocity based on the S5Carrying out dead reckoning to obtain the update of the vehicle position in the transverse direction and the longitudinal direction;
wherein x '(i), y' (i) are respectively the updated values of the current real-time horizontal and vertical coordinates of the vehicle, R is the rolling radius of the wheel, and beta is the yaw angle of the vehicle body.
Although the invention has been described in detail above with reference to a general description and specific examples, it will be apparent to one skilled in the art that modifications or improvements may be made thereto based on the invention. Accordingly, such modifications and improvements are intended to be within the scope of the invention as claimed.
Claims (2)
1. An automatic parking positioning method based on wheel speed pulse and IMU is characterized by comprising the following steps:
s1, aiming at wheel speed pulse signals of vehiclesCollecting, and smoothing with speed compensation method
Wherein i is the number of frames,the raw pulse signal measured for the ith frame,for the initial pulse compensation value of 10 width set,the pulse signal difference measured for two consecutive frames;
s2, obtaining a front wheel steering angle signal delta (i) based on the steering wheel steering angle signal and the transmission ratio of the steering system, calculating the ratio r (i) of the turning radius of the inner wheel and the turning radius of the outer wheel,
wherein L is A Is the vehicle wheel base, L W The wheel base of the rear axle of the vehicle;
s3, further smoothing the wheel speed pulse signals smoothed in the S1 based on the inner and outer wheel turning radius ratio r (i) obtained in the S2 to obtain wheel speed pulse signals
Wherein:the i-th frame rotational angular velocity of the right rear wheel,the i-th frame rotation angular velocity for the left rear wheel,respectively obtaining left and right wheel speed pulse signals after speed compensation smoothing processing;
s4, calculating the yaw angular velocity of the vehicle based on the wheel speed pulse signal after compensation smoothing
Wherein r is R Is the rolling radius of the wheel, theta is the wheel deflection angle;
s5, the vehicle yaw velocity value obtained in the S4 is subjected toYaw angular velocity value measured in real time with IMUAs Kalman filtering state value input, obtaining new yaw velocity output after fusionKalman filtering involves a prediction and update process:
and (3) prediction process:
and (3) updating:
wherein Z (i) = [ omega ] M (i) ω IMU (i)],ω M (i) And omega IMU (i) Respectively a vehicle yaw angular velocity value after Kalman filtering and an IMU yaw angular velocity value after Kalman filtering, A is a measurement matrix and is [1 ]]Q is the measurement error, H is the state input matrix, here [1,1 ]]R is state input noise; p is a covariance matrix, wherein,in order to predict the covariance matrix of the process,updating the covariance matrix of the process, wherein the covariance matrix and the covariance matrix are both intermediate variables of Kalman filtering;
2. The automatic parking positioning method based on wheel speed pulse and IMU as claimed in claim 1, wherein in S6, the dead reckoning method is:
wherein x '(i), y' (i) are respectively the updated values of the current real-time horizontal and vertical coordinates of the vehicle, R is the rolling radius of the wheel, and beta is the yaw angle of the vehicle body.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210182638.6A CN114407877B (en) | 2022-02-25 | 2022-02-25 | Automatic parking positioning method based on wheel speed pulse and IMU (inertial measurement Unit) |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210182638.6A CN114407877B (en) | 2022-02-25 | 2022-02-25 | Automatic parking positioning method based on wheel speed pulse and IMU (inertial measurement Unit) |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114407877A CN114407877A (en) | 2022-04-29 |
CN114407877B true CN114407877B (en) | 2023-03-24 |
Family
ID=81261430
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210182638.6A Active CN114407877B (en) | 2022-02-25 | 2022-02-25 | Automatic parking positioning method based on wheel speed pulse and IMU (inertial measurement Unit) |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114407877B (en) |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101940726B1 (en) * | 2012-05-04 | 2019-01-22 | 현대모비스 주식회사 | Smart Parking Assist System and the method for Wheel Radius Correction thereof |
CN105835721B (en) * | 2016-03-31 | 2017-10-31 | 电子科技大学 | A kind of four-wheel wheel hub electric automobile method for controlling driving speed |
EP3470947B1 (en) * | 2017-10-12 | 2021-07-28 | Volvo Car Corporation | Method and system for guiding an autonomous vehicle |
CN109405837B (en) * | 2018-11-14 | 2021-06-08 | 蔚来(安徽)控股有限公司 | Object positioning method, application and vehicle |
CN109945858B (en) * | 2019-03-20 | 2021-04-13 | 浙江零跑科技有限公司 | Multi-sensing fusion positioning method for low-speed parking driving scene |
CN110077392B (en) * | 2019-03-28 | 2020-08-25 | 惠州市德赛西威汽车电子股份有限公司 | Dead reckoning method of automatic parking positioning system |
CN111780756A (en) * | 2020-07-20 | 2020-10-16 | 北京百度网讯科技有限公司 | Vehicle dead reckoning method, device, equipment and storage medium |
CN113276862B (en) * | 2021-06-21 | 2022-12-06 | 智新控制系统有限公司 | Vehicle driving state estimation method |
CN113561969B (en) * | 2021-08-31 | 2023-07-28 | 岚图汽车科技有限公司 | Reversing auxiliary method and device |
-
2022
- 2022-02-25 CN CN202210182638.6A patent/CN114407877B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN114407877A (en) | 2022-04-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7149244B2 (en) | Traffic signal response for autonomous vehicles | |
US11648946B2 (en) | Intelligent vehicle platoon lane change performance evaluation method | |
CN103661599B (en) | A kind of turn inside diameter trajectory predictions system and method | |
KR101901024B1 (en) | Map update determination system | |
US11604071B2 (en) | Motion graph construction and lane level route planning | |
CN111907516B (en) | Full-automatic parking method and system | |
WO2020141423A1 (en) | Steering angle calibration | |
CN109275121B (en) | Vehicle trajectory tracking method based on adaptive extended Kalman filtering | |
EP3744616A1 (en) | A device and a method for reversing an articulated vehicle combination | |
CN114999228B (en) | Anti-collision method for automatic driving vehicle in severe weather | |
CN112046487A (en) | Road surface gradient estimation method and system based on vehicle running state | |
CN107664504A (en) | A kind of path planning apparatus | |
CN211956223U (en) | Lane change track planning system | |
CN113051765B (en) | Intelligent driving vehicle road ring-in testing method based on virtual scene transformation | |
CN112937557A (en) | Curvature control-based passenger-riding parking path planning method and system | |
CN111413990A (en) | Lane change track planning system | |
CN111703424B (en) | Intelligent networking automobile multi-sensor fusion auxiliary lane changing method and system | |
CN112433531A (en) | Trajectory tracking method and device for automatic driving vehicle and computer equipment | |
CN114912061B (en) | Accurate assessment method for lane keeping auxiliary system of commercial vehicle | |
CN101310164A (en) | Method for determining the tyre diameter of a motor vehicle | |
CN114516327A (en) | Self-learning vehicle following system and method based on driver behavior learning and surrounding environment | |
CN114407877B (en) | Automatic parking positioning method based on wheel speed pulse and IMU (inertial measurement Unit) | |
Choi et al. | Position estimation in urban u-turn section for autonomous vehicles using multiple vehicle model and interacting multiple model filter | |
CN113532435A (en) | Car machine underground parking lot AR navigation method | |
CN112069559B (en) | Method for determining inner wheel difference area range of right turn at intersection of large vehicles and application of method |
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 |