CN108045435B - Pavement self-adaptive intelligent vehicle transverse hybrid control method - Google Patents
Pavement self-adaptive intelligent vehicle transverse hybrid control method Download PDFInfo
- Publication number
- CN108045435B CN108045435B CN201711223046.XA CN201711223046A CN108045435B CN 108045435 B CN108045435 B CN 108045435B CN 201711223046 A CN201711223046 A CN 201711223046A CN 108045435 B CN108045435 B CN 108045435B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- curvature
- error
- signal
- intelligent vehicle
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 44
- 230000008859 change Effects 0.000 claims abstract description 22
- 230000008569 process Effects 0.000 claims description 8
- 230000007246 mechanism Effects 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 2
- 238000006073 displacement reaction Methods 0.000 claims description 2
- 238000011217 control strategy Methods 0.000 abstract description 4
- 230000007547 defect Effects 0.000 abstract description 3
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses a pavement self-adaptive intelligent vehicle transverse hybrid control method, and belongs to the field of intelligent driving of automobiles. Aiming at the defect that the position deviation control commonly used by the intelligent vehicle cannot meet the large curvature path tracking, the invention introduces another transverse control strategy for tracking the expected state quantity of the vehicle, and designs a fuzzy controller to ensure that the intelligent vehicle is switched between the two control strategies in real time by taking the curvature of the target road monitored in real time and the curvature change rate thereof as switching conditions so as to realize high-precision path tracking suitable for different road surfaces. The invention can effectively reduce the steady-state error of intelligent vehicle tracking and make the steering control more accurate and stable.
Description
Technical Field
The invention relates to a pavement self-adaptive intelligent vehicle transverse hybrid control method, and belongs to the field of intelligent driving of automobiles.
Background
At present, a position deviation control method (such as a pure tracking control method) is widely adopted in the intelligent automobile transverse control to realize the path tracking performance of the vehicle, namely when a target path is a linear lane or a lane with small curvature, the transverse deviation and the azimuth deviation difference between a pre-aiming point and the closest point of the target lane relative to the vehicle are small, and the accurate lane tracking performance can be basically realized by controlling the position and the azimuth deviation between the vehicle and the pre-aiming point to be minimum. However, the target road condition of the actual vehicle is relatively complex, various conditions of mutual fusion of a straight lane, a curve with small curvature, a curve with large curvature and the like exist, and the common position deviation control method obviously cannot meet the lane following performance of the curve with large curvature. Therefore, an expert scholars provides a vehicle transverse control method for tracking the expected yaw velocity aiming at the problem of low control precision of a position deviation control method, and simulation experiments show that the control method can realize accurate tracking of each curvature, particularly large-curvature paths. However, this control method is poor in robustness, and there is a case where the yaw rate fluctuation is large in the process where the vehicle has not completely stably tracked the desired path, which directly affects the ride comfort of the vehicle. Therefore, how to control the vehicle to stably track the target path under various curvatures is an urgent problem to be solved.
Disclosure of Invention
In order to overcome the technical defects, the invention provides a pavement self-adaptive intelligent vehicle transverse hybrid control method, which comprises the following steps:
step 1) from the intelligent vehicleThe position information and the posture information of the vehicle measured by the sensor equipment are input into a lane recognition system, the target lane information and the input of the pre-aiming distance are integrated, the pre-aiming target point of the current vehicle and the closest point of the target lane relative to the vehicle are determined, and the transverse distance error Y between the vehicle and the pre-aiming target point is detectedeAnd the azimuth error phieAnd the curvature ρ of the target lane with respect to the closest point of the vehicle and its curvature change rateAnd compares it with a reference curvature threshold p0Making a difference between the curvature error signal e and the curvature error change rate signalInputting a fuzzy controller;
step 2), the fuzzy controller outputs an intelligent vehicle transverse control mode according to the input error signal and the change rate thereof, namely, gamma is 1 (a position deviation control method) and gamma is 0 (a tracking expected transverse angular velocity control method);
step 3) when gamma is 1;
at the moment, the intelligent vehicle transverse hybrid controller is switched to a position deviation control method, and the PID controller outputs a vehicle aiming point relative transverse distance error Y according to the lane recognition systemeAnd the azimuth error phieAnd calculating and outputting a proper front wheel steering angle signal delta, and controlling the intelligent vehicle to steer by the steering executing mechanism according to the steering angle signal to finish the path tracking process.
Step 4) when gamma is equal to 0;
at the moment, the intelligent vehicle transverse hybrid controller is switched to a control method for tracking the expected yaw angular velocity, and the upper-layer expected yaw angular velocity generator outputs the relative transverse distance error Y of the vehicle aiming point according to the lane recognition systemeAnd the azimuth error phieOutputting the vehicle body sensor signal to generate the expected yaw angular velocity omegadAnd as a reference input to the underlying desired yaw rate tracking controller. The lower layer expected yaw rate tracking controller outputs proper front wheel rotation angle information through analysis and calculationAnd the steering executing mechanism controls the intelligent vehicle to steer according to the corner signal to finish the path tracking process.
Further, the position and posture information of the vehicle comprises information of coordinates, displacement, speed, acceleration, yaw rate, front wheel turning angle and the like of the automobile relative to a geodetic coordinate system XY in the running process, and the information is acquired in real time by a GPS (global positioning system), a Hall speed sensor, a gyroscope, a turning angle sensor and other equipment loaded on the intelligent vehicle.
Further, the road curvature is the road curvature and the curvature change rate thereof obtained by recognizing lane markings of the target road based on a lane recognition system, performing curve fitting on the recognized markings and calculating.
Further, the fuzzy controller of the second step is designed as follows:
selecting a road curvature error signal e and a curvature error change rate signalThe output signal is the transverse control mode as the input signal of the fuzzy controller. Inputting error signal e and curvature error change rate signalThe fuzzy sets are divided into 5 fuzzy sets: NB (negative large), NS (negative small), ZO (zero), PS (positive small), PB (positive large). The output γ is divided into two fuzzy sets: 0 (intelligent vehicle lateral control is switched to a tracking desired yaw rate control method), and 1 (intelligent vehicle lateral control is switched to a position deviation control method). The argument field of the road curvature error signal e of the controller is [ -0.04, 0.04 [ -0.04 [ ]]Rate of change of curvature error signalThe discourse domain is set to [ -0.04, 0.04]The universe of γ is set to {0, 1 }. For input quantity curvature error signal e and curvature error change rate signalAll using membership functions of the Gaussian type for the output quantity gammaTriangular membership functions are used. The fuzzy rule control table is shown as table one.
Further, the implementation of the PID controller can be expressed by the following equation:
wherein k isp、kdAnd kiAs a transverse distance error YeProportional, differential and integral coefficients of k'p、k′dAnd k'iAs an azimuthal error phieProportional, derivative and integral coefficients. By adjusting the transverse distance error YeAnd the azimuth error phieOutputs the front wheel steering angle signal delta at the current time.
Further, the desired yaw rate generator is based on the pre-aiming distance, the lateral distance error YeAnd the azimuth error phieInputting a signal, constructing a virtual driving path between the vehicle and the aiming point, and calculating the expected yaw angular speed omega of the vehicle approaching the target road along the virtual path at the current moment based on the virtual pathdThen the lower expected yaw angular velocity tracking controller controls the vehicle turning angle delta in real time to achieve the aim of accurately tracking the expected yaw angular velocity omegadThe purpose of (1).
The invention has the beneficial effects that: according to the invention, through real-time monitoring of the curvature and the change rate of the target road, the vehicle tracking surface can be freely switched between a position deviation control method and an expected tracking yaw rate control method when facing different curvature paths, so that the vehicle tracking performance with higher precision and better robustness can be obtained.
Drawings
FIG. 1 is a control scheme diagram of an embodiment of a road adaptive intelligent vehicle lateral hybrid control method according to the invention.
Detailed Description
The invention is further described with reference to the following drawings and specific embodiments. Vehicle measured by various sensor devices on intelligent vehicle during drivingThe current position and the attitude information thereof are input into a lane recognition system and a transverse hybrid controller, then the lane recognition system calculates according to the target lane information, the pre-aiming distance information and the vehicle position and attitude information to determine the pre-aiming target point of the current vehicle and the closest point of the target lane relative to the vehicle, and detects the transverse distance error Y between the vehicle and the pre-aiming target pointeAnd the azimuth error phieAnd the curvature ρ of the target lane with respect to the closest point of the vehicle and its curvature change rateAnd compares it with a reference curvature threshold p0Making a difference between the curvature error signal e and the curvature error change rate signalInputting into a fuzzy controller while simultaneously correcting the transverse distance error YeAnd the azimuth error phieInputting the data into a transverse mixing controller;
TABLE 1 fuzzy rule control table of fuzzy controller
The fuzzy controller outputs an intelligent vehicle transverse control mode according to the input error signal and the change rate thereof, namely, the gamma is 1 (a position deviation control method) and the gamma is 0 (a tracking expected yaw rate control method);
if γ is 1, it indicates that the curvature of the lane segment tracked by the vehicle is small at this time, and the lateral hybrid controller tracks the desired path by using a position deviation control method. According to the error Y of the relative transverse distance of the vehicle aiming point output by the lane recognition systemeAnd the azimuth error phieThe PID controller is according to the following equation:
wherein k isp、kdAnd kiAs a lateral distance errorYeProportional, differential and integral coefficients of k'p、k′dAnd k'iAs an azimuthal error phieProportional, derivative and integral coefficients.
Adjusting the corresponding transverse distance error YeAnd the azimuth error phieThe proportional, integral and differential coefficients are calculated to output a proper front wheel steering angle signal delta, and the steering executing mechanism controls the intelligent vehicle to steer according to the steering angle signal to complete the path tracking process.
If gamma is 0, it indicates that the curvature of the lane section tracked by the vehicle is large at the moment, the transverse hybrid controller is switched to a control method for tracking the expected yaw rate, and the upper-layer expected yaw rate generator outputs the error Y of the relative transverse distance of the vehicle aiming point according to the lane recognition systemeAnd the azimuth error phieConstructing a virtual driving path between the vehicle and the pre-aiming point, and calculating the expected yaw angular speed omega of the vehicle approaching the target road along the virtual path at the current moment based on the virtual pathdAnd as a reference input to the underlying desired yaw rate tracking controller. The lower expected yaw rate tracking controller outputs a proper front wheel steering angle signal delta through analysis and calculation, and the steering executing mechanism controls the intelligent vehicle to steer according to the steering angle signal to complete the path tracking process.
In conclusion, the invention provides a road self-adaptive intelligent vehicle transverse hybrid control method, and belongs to the field of intelligent driving of automobiles. Aiming at the defect that the position deviation control commonly used by the intelligent vehicle cannot meet the large curvature path tracking, the invention introduces another transverse control strategy for tracking the expected state quantity of the vehicle, and designs a fuzzy controller to ensure that the intelligent vehicle is switched between the two control strategies in real time by taking the curvature of the target road monitored in real time and the curvature change rate thereof as switching conditions so as to realize high-precision path tracking suitable for different road surfaces. The invention can effectively reduce the steady-state error of intelligent vehicle tracking and make the steering control more accurate and stable.
In the description herein, references to the description of the term "one embodiment," "some embodiments," "an illustrative embodiment," "an example," "a specific example," or "some examples" or the like mean that a particular feature, structure, material, or characteristic described in connection with the embodiment or example is included in at least one embodiment or example of the invention. In this specification, the schematic representations of the terms used above do not necessarily refer to the same embodiment or example. Furthermore, the particular features, structures, materials, or characteristics described may be combined in any suitable manner in any one or more embodiments or examples.
While embodiments of the invention have been shown and described, it will be understood by those of ordinary skill in the art that: various changes, modifications, substitutions and alterations can be made to the embodiments without departing from the principles and spirit of the invention, the scope of which is defined by the claims and their equivalents.
Claims (6)
1. A road surface self-adaptive intelligent vehicle transverse hybrid control method is characterized by comprising the following steps:
step 1) inputting vehicle position information and posture information measured by sensor equipment on an intelligent vehicle into a lane recognition system, integrating the target lane information and the input of a pre-aiming distance, determining a pre-aiming target point of the current vehicle and the closest point of a target lane relative to the vehicle, and detecting a transverse distance error Y between the vehicle and the pre-aiming target pointeAnd the azimuth error phieAnd road curvature ρ of the target lane with respect to the closest point of the vehicle and its rate of change of curvatureAnd compares it with a reference curvature threshold p0Subtracting the curvature error signal e from the curvature error change rate signalInputting a fuzzy controller;
and 2) outputting an intelligent vehicle transverse control mode by the fuzzy controller according to the input error signal and the change rate thereof, and dividing output gamma into two fuzzy sets: changing the intelligent vehicle lateral control into the tracking expected yaw rate control method when the value of gamma is 0, and changing the intelligent vehicle lateral control into the position deviation control method when the value of gamma is 1;
the fuzzy controller of the step 2) is designed as follows:
selecting a road curvature error signal e and a curvature error change rate signalThe output signal is used as input signal of the fuzzy controller, the input error signal e and curvature error change rate signal are used as transverse control modeThe fuzzy sets are divided into 5 fuzzy sets: NB negative is large, NS negative is small, ZO is zero, PS is small, and PB is large; for input quantity curvature error signal e and curvature error change rate signalAdopting Gaussian membership functions, and adopting triangular membership functions for the output quantity gamma;
step 3) when gamma is 1;
at the moment, the intelligent vehicle transverse hybrid controller is switched to a position deviation control method, and the PID controller outputs a vehicle aiming point relative transverse distance error Y according to the lane recognition systemeAnd the azimuth error phieCalculating and outputting a proper front wheel steering angle signal delta, and controlling the intelligent vehicle to steer by the steering executing mechanism according to the steering angle signal to finish the path tracking process;
step 4) when gamma is equal to 0;
at the moment, the intelligent vehicle transverse hybrid controller is switched to a control method for tracking the expected yaw angular velocity, and the upper-layer expected yaw angular velocity generator outputs the relative transverse distance error Y of the vehicle aiming point according to the lane recognition systemeAnd the azimuth error phieOutputting the vehicle body sensor signal to generate the expected yaw angular velocity omegadAnd as a reference input to a lower desired yaw-rate tracking controller that passes throughAnalyzing and calculating, outputting a proper front wheel steering angle signal delta, and controlling the intelligent vehicle to steer by the steering executing mechanism according to the steering angle signal to finish the path tracking process;
the upper layer expected yaw velocity generator generates the expected yaw velocity according to the pre-aiming distance and the transverse distance error YeAnd the azimuth error phieInputting a signal, constructing a virtual driving path between the vehicle and the aiming point, and calculating the expected yaw angular speed omega of the vehicle approaching the target road along the virtual path at the current moment based on the virtual pathdThen the lower expected yaw angular velocity tracking controller controls the vehicle turning angle delta in real time to achieve the aim of accurately tracking the expected yaw angular velocity omegadThe purpose of (1).
2. The method as claimed in claim 1, wherein the vehicle position information and its attitude information include coordinates, displacement, velocity, acceleration, yaw rate, and front wheel rotation angle information of the vehicle relative to the earth coordinate system XY during driving, which are collected in real time by a GPS positioning system, a hall velocity sensor, a gyroscope, and a rotation angle sensor device mounted on the intelligent vehicle.
3. The method as claimed in claim 1, wherein the road curvature is calculated by recognizing lane markings of the target road based on a lane recognition system, curve fitting the recognized markings, and calculating the road curvature and its curvature change rate.
4. The method of claim 1, wherein the PID controller is implemented in a manner expressed by the following equation:
wherein k isp、kdAnd kiAs a transverse distance error YeProportional, differential and integral coefficients of k'p、k′dAnd k'iAs an azimuthal error phieBy adjusting the transverse distance error YeAnd the azimuth error phieOutputs the front wheel steering angle signal delta at the current time.
5. The method of claim 1, wherein the reference curvature threshold p is a p0The value was set to 0.04.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711223046.XA CN108045435B (en) | 2017-11-29 | 2017-11-29 | Pavement self-adaptive intelligent vehicle transverse hybrid control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711223046.XA CN108045435B (en) | 2017-11-29 | 2017-11-29 | Pavement self-adaptive intelligent vehicle transverse hybrid control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108045435A CN108045435A (en) | 2018-05-18 |
CN108045435B true CN108045435B (en) | 2020-06-26 |
Family
ID=62120935
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711223046.XA Expired - Fee Related CN108045435B (en) | 2017-11-29 | 2017-11-29 | Pavement self-adaptive intelligent vehicle transverse hybrid control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108045435B (en) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110673593B (en) * | 2018-07-03 | 2022-11-15 | 杭州海康威视数字技术股份有限公司 | Vehicle control method and device |
CN110968082B (en) * | 2018-09-28 | 2023-08-08 | 广州汽车集团股份有限公司 | Automatic driving vehicle path tracking method and device |
CN109886215B (en) * | 2019-02-26 | 2021-10-19 | 常熟理工学院 | Low-speed park unmanned vehicle cruise and emergency braking system based on machine vision |
CN110160806A (en) * | 2019-06-17 | 2019-08-23 | 北京艾尔动力科技有限公司 | Automated driving system and test method for automobile durable test |
CN111158397B (en) * | 2020-01-14 | 2023-08-22 | 一飞智控(天津)科技有限公司 | Unmanned aerial vehicle cluster flight path following control system and method and unmanned aerial vehicle |
CN111158377B (en) * | 2020-01-15 | 2021-04-27 | 浙江吉利汽车研究院有限公司 | Transverse control method and system for vehicle and vehicle |
CN111796521B (en) * | 2020-07-08 | 2022-06-10 | 中国第一汽车股份有限公司 | Foresight distance determining method, device, equipment and storage medium |
CN114253241B (en) * | 2021-12-21 | 2023-12-22 | 昆山星际舟智能科技有限公司 | Path tracking method for industrial intelligent trolley |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004318345A (en) * | 2003-04-14 | 2004-11-11 | Fuji Heavy Ind Ltd | Information display system and information display method |
KR20120088923A (en) * | 2011-02-01 | 2012-08-09 | 주식회사 만도 | Apparatus and method of controlling vehicle |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103439884B (en) * | 2013-07-19 | 2015-12-23 | 大连理工大学 | A kind of intelligent automobile crosswise joint method based on fuzzy sliding mode |
CN104626914B (en) * | 2014-12-31 | 2016-08-31 | 广西科技大学 | The fuzzy control method of Vehicle Nonlinear active suspension system |
CN107097785B (en) * | 2017-05-25 | 2019-08-27 | 江苏大学 | A kind of intelligent vehicle crosswise joint method that preview distance is adaptive |
CN107024866A (en) * | 2017-05-26 | 2017-08-08 | 江苏大学 | A kind of multi-model landscape blur control method based on speed subregion |
CN107253453B (en) * | 2017-07-05 | 2019-08-27 | 厦门大学 | A kind of distributed electric automobile lateral stability adaptive control system and method |
-
2017
- 2017-11-29 CN CN201711223046.XA patent/CN108045435B/en not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004318345A (en) * | 2003-04-14 | 2004-11-11 | Fuji Heavy Ind Ltd | Information display system and information display method |
KR20120088923A (en) * | 2011-02-01 | 2012-08-09 | 주식회사 만도 | Apparatus and method of controlling vehicle |
Also Published As
Publication number | Publication date |
---|---|
CN108045435A (en) | 2018-05-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108045435B (en) | Pavement self-adaptive intelligent vehicle transverse hybrid control method | |
CN112733270B (en) | System and method for predicting vehicle running track and evaluating risk degree of track deviation | |
CN110001637B (en) | Unmanned vehicle path tracking control device and control method based on multipoint tracking | |
Tang et al. | An improved kinematic model predictive control for high-speed path tracking of autonomous vehicles | |
CN107161207B (en) | Intelligent automobile track tracking control system and control method based on active safety | |
Ni et al. | Envelope control for four-wheel independently actuated autonomous ground vehicle through AFS/DYC integrated control | |
CN110502009A (en) | The automatic driving vehicle path tracking control method estimated based on course | |
CN106476883B (en) | The travel controlling system of vehicle | |
US9499197B2 (en) | System and method for vehicle steering control | |
CN108732921B (en) | Transverse extension preview switching control method for automatic driving automobile | |
CN110361013B (en) | Path planning system and method for vehicle model | |
CN103121451B (en) | A kind of detour changes the tracking and controlling method of track | |
CN109131325B (en) | Lane keeping control method for three-dimensional extension preview switching of intelligent driving automobile | |
CN110109451B (en) | Novel geometric path tracking algorithm considering path curvature | |
CN109946732A (en) | A kind of unmanned vehicle localization method based on Fusion | |
CN109358621B (en) | Autonomous driving vehicle Trajectory Tracking Control method | |
CN110286672A (en) | Robot and its navigation control method, Navigation Control Unit and storage medium | |
CN111923908A (en) | Stability-fused intelligent automobile path tracking control method | |
CN110307850A (en) | Reckoning localization method and automated parking system | |
CN110006419A (en) | Vehicle track tracking point determination method based on preview | |
CN107585163A (en) | Mobile Route Generation device and mobile route generation method | |
CN105667592A (en) | Vehicle steering apparatus and method for lane keeping | |
CN109388140A (en) | A kind of improved pure tracing control method for surface car path trace | |
CN110641465A (en) | Lane keeping system and method based on vehicle speed | |
CN113291323B (en) | Automatic driving path tracking control method and system for rhombic vehicle and vehicle |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200626 |