CN104881030B - Unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle - Google Patents

Unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle Download PDF

Info

Publication number
CN104881030B
CN104881030B CN201510278571.6A CN201510278571A CN104881030B CN 104881030 B CN104881030 B CN 104881030B CN 201510278571 A CN201510278571 A CN 201510278571A CN 104881030 B CN104881030 B CN 104881030B
Authority
CN
China
Prior art keywords
vehicle
centerdot
epsiv
force
unmanned 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.)
Active
Application number
CN201510278571.6A
Other languages
Chinese (zh)
Other versions
CN104881030A (en
Inventor
杨静
荣海军
陈鹏鹏
杜少毅
薛建儒
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zaozhuang new era network engineering Co.,Ltd.
Original Assignee
Xian Jiaotong University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Xian Jiaotong University filed Critical Xian Jiaotong University
Priority to CN201510278571.6A priority Critical patent/CN104881030B/en
Publication of CN104881030A publication Critical patent/CN104881030A/en
Application granted granted Critical
Publication of CN104881030B publication Critical patent/CN104881030B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

The invention provides a kind of unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle, including:1) input and output parameter of selection unmanned vehicle side Longitudinal data tracking control unit;2) tracing control error and its state equation are defined;3) fast terminal sliding formwork is set up as state variable with tracing control error;4) fast terminal tendency rate is used as the sliding formwork tendency rate of tracing control;5) coupled relation between desired driving force or brake force and desired side force is derived from according to vehicle dynamic model and the above;6) expectation front wheel angle is calculated;7) according to the positive and negative of the inverse longitudinal force model output tried to achieve, judgement should currently calculate desired throttle opening or desired braking moment;8) desired throttle opening or braking moment are calculated.Be can see from simulation result, the present invention not only improves the error precision of Position Tracking Control, it may have the error precision of good speed tracking control.

Description

Unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle
【Technical field】
The present invention relates to pilotless automobile autonomous driving and sliding formwork control technical field, more particularly to one kind realizes nobody The tracking and controlling method of car side Longitudinal data.
【Background technology】
The motion control of automatic driving vehicle is the key technology of manipulation key-course in Navigation Control architecture, motion control Algorithm processed is the core research contents of this layer.Here motion control is the tracing control based on planned trajectory.Autonomous driving car Tracing control include longitudinal tracing control and lateral tracing control.Longitudinal tracing control is to control the travel speed of vehicle same Planning speed is consistent, and keeps certain operating range with front truck, and lateral tracing control is then the travel direction for controlling vehicle It is travelled along path planning, and meet basic performance requirement, including tracking accuracy, to vehicle parameter and environmental change Adaptability is robustness, and riding comfort etc..
When automatic driving vehicle performs the small curvature planning such as track holding to be acted, the lateral movement and lengthwise movement of vehicle Coupling can often ignore, carry out side longitudinal direction uneoupled control, separately design longitudinal tracking control unit and lateral tracing control Device.The research of longitudinal tracking control algorithm is devoted to solving being indulged with big under the influence of longitudinal direction of car dynamic system strong nonlinearity To the problem that longitudinally controlled precision is improved under the influence of disturbed condition.The method for being used has PID control, optimum control, self adaptation The Based Intelligent Controls such as control, sliding formwork control, fuzzy control and artificial neural-network control.Automatic cruising based on above-mentioned algorithm development System has been applied in some quality merchandise vehicles.Because lateral tracing control is to solve tracking problem based on two-dimensional space, Along with the change of vehicle and road parameters, and lateral movement unintentional nonlinearity characteristic so that the design of controller is often It is a problem for complexity, the control algolithm with self-correcting real-time learning ability is the emphasis of research.On the other hand, vehicle is worked as When the planning maneuvers of some complexity such as lane-change, intersection turning are carried out in the environment for exist moving obstacle, it is desirable to same When tracking planned position sequence and planning velocity series, due to vehicle lateral movement and lengthwise movement now have stronger coupling Conjunction property, if still using side longitudinal direction Uncoupling Control Based, it will produce larger tracking error.
Coupling effect of some researchers based on vehicle side lengthwise movement has carried out the research of side Longitudinal data control strategy, But the coupling control strategy of current side lengthwise movement is mainly for vehicle platoon control, motor-driven for single autonomous land vehicle Property the higher row control that is, such as vehicle carries out lane-change, intersection in the environment for exist moving obstacle and turns etc. that some are answered Miscellaneous planning maneuver, the less or control accuracy of research is relatively low.
The pertinent literature of retrieval given below:
[1] Wu Qing, He Zhiwei, the first elegant people, ancestor into column of traffic traveling control key technology in strong intelligent vehicle highway systems with Progress [J] traffic and computer, 2008,26 (4):154-157.
[2]Rajamani R.Vehicle Dynamics and Control.New York:Springer,2006.
[3]Zhou QZ,Wang FY and Li L.Robust Sliding Mode Control of 4WS Vehicles for Automatic Path Tracking[C].Proceedings of IEEE Intelligent Vehicles Symposium,Piscataway,USA,2005:819-826.
[4] Yongping, Hu Yujin, Li Chenggang, research [J] vapour of lateral deviation relaxed length characteristic under the big side drift angles of Guo Konghui are waited Turner journey, 2001 (2):78-81.
[5]Edward H,Lim M and Hedrick JK.Lateral and Longitudinal Vehicle Control Coupling for Automated Vehicle Operation[C].Proceedings of the American Control Conference San Diego,California,Jun.1999:3676-3680.
[6]Rajamani R,Tan HS,Law BK,et al.Demonstration of Integrated Longitudinal and Lateral Control for the Operation of Automated Vehicles in Platoons[J].IEEE Transactions on Control Systems Technology,2000,8(4):695- 708.
The such as [7] Li Yinong, willow, Zheng Ling are based on vehicle longitudinal and lateral coupling control [J] China mechanics of sliding formwork control Journey, 2007,18 (7):866-870.
[8]Yu X,Man Z,Wu Y.Terminal Sliding Modes with Fast Transient Performance[C].Proceedings of the 36th IEEE International Conference on Control&Decision,San Diego,1997:962-963.
[9] in double and, low buffeting fast robust sliding-mode control research [D] Harbin Institute of Technology thesis for the doctorate, 2000.
【The content of the invention】
It is an object of the invention to provide a kind of unmanned vehicle side Longitudinal data tracking control based on fast terminal sliding formwork principle Method processed, to solve above-mentioned existing theoretical and defect or deficiency present on design;The control method is for lifting controller Tracking performance, coupling is directly compensated by the controller design stage, unmanned vehicle is done more physical exercises obstacle in execution Lane-change in substance environment, intersection turn etc. some complicated, mobility planning behavior higher when, be capable of the high-precision of robust Tracking planning behavior, including tracking planned position state and speed state.
In order to realize above-mentioned purpose, the present invention is adopted the following technical scheme that:
Unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle, comprises the following steps:
Step one:The input and output parameter of selection unmanned vehicle side Longitudinal data tracking control unit;
Step 2:Define tracing control error and its state equation:
ε1=X-Xd+Y-Yd
Wherein (X, Y,) position coordinates that is respectively on controlled vehicle two dimensional surface and velocity yaw angle, (Xd,Yd,) be respectively in trajectory planning algorithm institute planned trajectory and plan the position coordinates and velocity yaw angle of vehicle at point;
Step 3:Use tracing control error ε1、ε2As state variable, set up first order nonlinear switching function and design soon Fast terminal sliding mode face S1And S2
Wherein pα1> 0, pβ1> 0, pα2> 0 and pβ2> 0 is sliding-mode surface single order and index term coefficient, and value is during emulation pα1=pα2=pβ1=pβ2=2;pq1, pp1, pq2, pp2Odd number is, is power exponent parameter, and meet pq1< pp1< 2pq1, pq2< pp2< 2pq2, value is p during emulationq1=pq2=5, pp1=pp2=7;
Step 4:Using fast terminal tendency rate formula as tracking control unit sliding formwork tendency rate:
Wherein fα1> 0, fβ1> 0, fα2> 0 and fβ2> 0 is fast terminal tendency rate single order and index term coefficient, emulation When value be fα1=fα2=80, fβ1=fβ2=2;fq1, fp1, fq2, fp2Odd number is, is power exponent parameter, and meet fq1< fp1 < 2fq1, fq2< fp2< 2fq2, value is f during emulationq1=fq2=5, fp1=fp2=7;
Step 5:According to vehicle dynamic model and above-mentioned steps 1 to step 4 content be derived from desired driving force or Brake force FtrbrdWith desired side force FldBetween coupled relation:
Step 6:Calculate to obtain and expect front wheel angle:
Wherein CfIt is the cornering stiffness of front tyre, lfDistance of the front axle of vehicle to barycenter;υ is the linear velocity of vehicle;β is The side slip angle of vehicle;R is the angular speed of vehicle, and ψ is the course angle of vehicle,
Step 7:Ask for expecting driving force or desired braking power F for longitudinal direction of car power modeltrbrdInverse for input is indulged To power model;If FtrbrdResult of calculation for just, then be desired driving force Ftrd, then calculate desired throttle opening αthb;, whereas if FtrbrdResult of calculation be negative, then be desired brake force Fbrd, then calculate desired braking moment Pbrd
Step 8:Desired throttle opening αthbComputational methods be:The elastic deformation of tire and power train is not considered, According to longitudinal direction of car power model, desired engine torque TedWith current engine speed ωe, can using inverse engine mockup In the hope of desired throttle opening αthb
αthb=fieng(Tede)
Wherein fieng(Tede) represent inverse engine torque characteristics function;
Or, desired braking moment PbrdComputing formula be:Pbrd=Fbrd/Kbr, KbrIt is desired brake force and system The proportionality coefficient of linear relationship between kinetic moment.
Unmanned vehicle centroid position changing coordinates are chosen in step one with a planning point position coordinates error X-X in planned trajectoryd、 Y-YdAnd unmanned vehicle velocity yaw angle is with planning point driftage angle errorIt is the |input paramete of tracking control unit;Section Valve opening αthOr braking moment Fbr, front wheel angle δfIt is tracking control unit output parameter.
The cornering stiffness C of front tyrefNumerical value take the twice of single tire cornering stiffness.
Compared with prior art, advantage of the invention is as follows:When automatic driving vehicle autonomous driving completion mobility is stronger Driving behavior when, if current vehicle condition frequently occurs larger tracking error with expectation state, based on the inventive method reality Existing controller can promptly cut down tracking error, unmanned vehicle is quickly tracked expectation state, and in whole control process In not only there is stronger robustness to the uncertain factor of system, and satisfied dynamic quality can be obtained, same to time control System is simple, it is easy to accomplish.The present invention not only improves the error precision of Position Tracking Control, it may have good speed tracing control The error precision of system.
Step 5 of the present invention is to deriving in step 7 using vehicle side Longitudinal data kinetic model, in vehicle mobility There is more preferable model accuracy in stronger behavior.
Tracing control error ε is used in step 3 of the present invention1、ε2As state variable, built using first order nonlinear switching function Vertical fast terminal sliding formwork S1、S2, vehicle tracking control system tracking error is quickly converged to after sliding formwork surface state is reached The same desired locations of the current centroid position of zero, i.e. unmanned vehicle, current velocity vector course angle overlap with expectation course angle.
Fast terminal sliding formwork S is based in step 4 of the present invention1、S2Fast terminal tendency rate is set up as tracking control unit Sliding formwork tendency rate, can make the tracking error of vehicle tracking control system when sliding-mode surface is not at, in finite time compared with Weak shake or non-jitter from any state quickly reach sliding-mode surface, and more conventional method has stronger robustness.
【Brief description of the drawings】
Fig. 1 is unmanned vehicle tracking control system schematic diagram;
Fig. 2 is the unmanned vehicle side Longitudinal data tracking and controlling method flow chart based on fast terminal sliding formwork principle;
Fig. 3 is inverse engine torque characteristics function schematic diagram;
Fig. 4 is the pursuit path under target trajectory, coupling control and the pursuit path schematic diagram under uneoupled control;
Fig. 5 is comparing figure of the tracking error under coupling control with the tracking error under uneoupled control;Wherein, Fig. 5 (a) is The comparing figure of X-direction position tracking error, Fig. 5 (b) is the comparing figure of Y-direction position tracking error, and Fig. 5 (c) is X-direction speed The comparing figure of tracking error, Fig. 5 (d) is the comparing figure of Y-direction speed tracing error, and Fig. 5 (e) is that yaw angle (direction) tracks mistake Poor comparing figure;
Fig. 6 is the controlled quentity controlled variable schematic diagram of side Longitudinal data control algolithm;Fig. 6 (a) is the accelerator open degree of longitudinal tracing control Schematic diagram, unit is %, and Fig. 6 (b) is the brake-pedal load schematic diagram of longitudinal tracing control, and unit is N, and Fig. 6 (c) is lateral The front wheel angle schematic diagram of tracing control, unit is rad, and the controlled quentity controlled variable shown in figure meets the physical characteristic constraint of actuator.
【Specific embodiment】
The design is described in further detail according to the principle that side Longitudinal data is controlled.
Referring to Fig. 1, the design of tracking control unit when the present invention tracks planned trajectory for unmanned vehicle.
Referring to Fig. 2, unmanned vehicle side Longitudinal data tracking and controlling method of the present invention based on fast terminal sliding formwork principle is divided into Nine steps below, each step is specific as follows:
1) input and output parameter of unmanned vehicle side Longitudinal data tracking control unit is selected according to planned trajectory:
(1a) |input paramete:Unmanned vehicle centroid position changing coordinates are with a planning point position coordinates error X- in planned trajectory Xd、Y-Yd;Unmanned vehicle velocity yaw angle is with planning point driftage angle errorWherein (X, Y,) it is respectively controlled car Position coordinates and velocity yaw angle on two dimensional surface, (Xd,Yd,) it is respectively trajectory planning algorithm institute planned trajectory The position coordinates and velocity yaw angle of vehicle at upper planning point.
(1b) output parameter:Throttle opening αth(or braking moment Fbr);Front wheel angle δf
2) it is tracing control error according to fast terminal sliding formwork principle definition status variable, and provides its state equation:
(2a) state variable:
ε1=X-Xd+Y-Yd
The state equation of (2b) state variable:
The kinematical equation of vehicle is:
Wherein υ is the linear velocity of vehicle, and r is the angular speed of vehicle, and ψ is the course angle of vehicle, and β is the barycenter lateral deviation of vehicle Angle and
Kinematical equation according to vehicle can derive that the state equation of state variable is:
The further derivation of state equation to state variable:
3) fast terminal sliding-mode surface is designed based on vehicle kinematics equation:
(3a) uses tracing control error ε1、ε2As state variable, set up first order nonlinear switching function and design quick whole Hold sliding-mode surface S1And S2
Wherein pα1> 0, pβ1> 0, pα2> 0 and pβ2> 0 is sliding-mode surface single order and index term coefficient, and value is during emulation pα1=pα2=pβ1=pβ2=2;pq1, pp1, pq2, pp2Odd number is, is power exponent parameter, and meet pq1< pp1< 2pq1, pq2< pp2< 2pq2, value is p during emulationq1=pq2=5, pp1=pp2=7.
(3b) is to fast terminal sliding-mode surface S1And S2Derivation is simultaneously brought vehicle kinematics equation into and is had:
4) fast terminal tendency rate formula is used as the sliding formwork tendency rate of tracking control unit:
Wherein fα1> 0, fβ1> 0, fα2> 0 and fβ2> 0 is fast terminal tendency rate single order and index term coefficient, emulation When value be fα1=fα2=80, fβ1=fβ2=2;fq1, fp1, fq2, fp2Odd number is, is power exponent parameter, and meet fq1< fp1 < 2fq1, fq2< fp2< 2fq2, value is f during emulationq1=fq2=5, fp1=fp2=7.
5) tracking control unit is obtained according to fast terminal sliding-mode surface, sliding formwork Reaching Law and dynamics of vehicle coupled wave equation to expect The coupled relation of controlled quentity controlled variable.
(5a) dynamics of vehicle coupled wave equation:
Wherein FlAnd RlIt is respectively side force that front and rear tire is acted on chassis.FfAnd FrIt is respectively to act on antero posterior axis On longitudinal force, produced by power assembly and brakes.FadFor before vehicle to air drag.δfIt is front wheel angle, lfAnd lrIt is Distance of the front axle and rear axle of vehicle to barycenter.L is the distance between vehicle antero posterior axis lf+lr μ is the conventional road surface coefficient of viscosity, μ=1 in the case of usual dry pavement, and has μ=0.5 under the surface conditions of water, and m is vehicle Quality, IψIt is the rotary inertia of vehicle.
Derivation, 4 of (5b) according to fast terminal sliding-mode surface in (3b)) in dynamics of vehicle coupling in sliding formwork tendency rate and (5a) Equation is closed, tracking control unit desired control amount F can be derivedtrbrdAnd FldCoupled relation:
Wherein FtrbrdIt is desired driving force or brake force, FldIt is desired side force,FrrFor Trailing wheel frictional ground force,q3=cos (ψ+β)+ Sin (ψ+β), q4=cos (ψ+β)-sin (ψ+β).
6) according to the relation between linear tire model and front-wheel synthesis side drift angle and front wheel angle, calculating is expected Front wheel angle:
(6a) linear tire model:
Fl=Cfδ1
Wherein CfIt is the cornering stiffness of front tyre, its numerical value takes the twice of single tire cornering stiffness, δ here1It is front-wheel synthesis Side drift angle.
Relation between (6b) front-wheel synthesis side drift angle and front wheel angle:
(6c) is according to desired side force F in (5b)ldObtain course changing control amount and expect front wheel angle:
7) to seek longitudinally controlled amount throttle opening αthOr braking moment Pbr, it is necessary to be directed to longitudinal direction of car power model ask for To expect driving force or desired braking power FtbrdIt is the inverse longitudinal force model of input.If FtrbrdResult of calculation for just, then for Desired driving force Ftrd, then desired throttle opening α need to be calculatedthb., whereas if FtrbrdResult of calculation be it is negative, then It is desired brake force Fbrd, then need to calculate desired braking moment Pbrd
8) F is assumedtrbrdIt is desired driving force Ftrd, calculate desired throttle opening αthb
(8a) according to it is foregoing set up longitudinal direction of car power model it is assumed that not considering the elastic deformation of tire and power train, root According to model, desired driving force is represented by:
FtrdDTedτTte)fgearth,υ)i0/ht
Wherein ηDIt is vehicle transmission system power conveying system number, TedIt is desired engine output torque, τTRepresent torque ratio Coefficient, its independent variable is ωte, it is fluid coupling secondary speed ωtWith current engine speed ωeRatio, fgearth, υ) and it is automatic transmission transmission ratio function, it is throttle opening αth(fully closed is 0, and standard-sized sheet is 100%) non-with speed υ Linear function;i0It is the gearratio of main reducing gear;htIt is the effective radius of wheel.
(8b) is by desired engine torque TedWith current engine speed ωe, can be in the hope of using inverse engine mockup Obtain desired throttle opening αthb, it is expressed as follows against engine mockup:
αthb=fieng(Tede)
Wherein fieng(Tede) represent inverse engine torque characteristics function.Using engine torque characteristics function fengeth) and data are provided, can be in the hope of seeking the inverse engine of throttle opening by engine output torque and engine speed Torque characteristics function fieng(Tede), reference picture 3.
Or, it is assumed that FtrbrdIt is desired braking moment Pbrd.Relational expression according to brake force and braking moment can be in the hope of It is against braking system model:
Pbrd=Fbrd/Kbr
Wherein, KbrIt is the proportionality coefficient of linear relationship between desired brake force and braking moment.
A kind of unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle is given in the present invention, And simulating, verifying has been carried out to the control method using MATLAB.Be can see from the simulation result of Fig. 4-Fig. 6, when nobody drives When sailing vehicle autonomous driving and completing the stronger driving behavior of mobility, if current vehicle condition with expectation state frequently occur compared with Big tracking error, the controller realized based on the inventive method can promptly be cut down tracking error, unmanned vehicle is quickly tracked Expectation state.The present invention not only improves the error precision of Position Tracking Control, it may have the mistake of good speed tracking control Difference precision, and controlled quentity controlled variable is smooth and meets the constraint of the physical characteristic of actuator.

Claims (3)

1. the unmanned vehicle side Longitudinal data tracking and controlling method of fast terminal sliding formwork principle is based on, it is characterised in that including following Step:
Step one:The input and output parameter of selection unmanned vehicle side Longitudinal data tracking control unit;
Step 2:Define tracing control error and its state equation:
ε1=X-Xd+Y-Yd
ϵ · 1 = X · - X · d + Y · - Y · d
WhereinPosition coordinates and velocity yaw angle on vehicle two dimensional surface are respectively controlled,Point It is not the position coordinates and velocity yaw angle of vehicle at planning point in trajectory planning algorithm institute planned trajectory;
Step 3:Use tracing control error ε1、ε2As state variable, set up first order nonlinear switching function and design quick whole Hold sliding-mode surface S1And S2
S 1 = ϵ · 1 + p α 1 ϵ 1 + p β 1 ϵ 1 p q 1 / p p 1
S 2 = ϵ · 2 + p α 2 ϵ 2 + p β 2 ϵ 2 p q 2 / p p 2
Wherein pα1>0, pβ1>0, pα2>0 and pβ2>0 is sliding-mode surface single order and index term coefficient, and value is p during emulationα1=pα2= pβ1=pβ2=2;pq1, pp1, pq2, pp2Odd number is, is power exponent parameter, and meet pq1<pp1<2pq1, pq2<pp2<2pq2, emulation When value be pq1=pq2=5, pp1=pp2=7;
Step 4:Using fast terminal tendency rate formula as tracking control unit sliding formwork tendency rate:
S &CenterDot; 1 = - f &alpha; 1 &beta; 1 - f &beta; 1 S 1 f q 1 / f p 1
S &CenterDot; 2 = - f &alpha; 2 S 2 - f &beta; 2 S 2 f q 2 / f p 2
Wherein fα1>0, fβ1>0, fα2>0 and fβ2>0 is fast terminal tendency rate single order and index term coefficient, and value is during emulation fα1=fα2=80, fβ1=fβ2=2;fq1, fp1, fq2, fp2Odd number is, is power exponent parameter, and meet fq1<fp1<2fq1, fq2< fp2<2fq2, value is f during emulationq1=fq2=5, fp1=fp2=7;
Step 5:Desired driving force or braking are derived to step 4 content according to vehicle dynamic model and above-mentioned steps 1 Power FtrbrdWith desired side force FldBetween coupled relation:
F t r b r d = - ( q 3 f 1 + q 4 f 2 - ( X &CenterDot;&CenterDot; d + Y &CenterDot;&CenterDot; d ) + p &alpha; 1 &epsiv; &CenterDot; 1 + ( p &beta; 1 p q 1 / p p 1 ) &epsiv; 1 ( p q 1 - p p 1 ) / p p 1 &epsiv; &CenterDot; 1 + f &alpha; 1 S 1 + f &beta; 1 S 1 f q 1 / f p 1 ) / q 1 q 3 + F l d ( q 3 &delta; f - q 4 ) / q 3
Wherein,FrrIt is trailing wheel frictional ground force, q3=cos (ψ+β)+sin (ψ+β), q4=cos (ψ+β)-sin (ψ+β), δfIt is front wheel angle, Rl It is side force that rear tyre is acted on chassis;FfIt is to act on the longitudinal force on front axle, is produced by power assembly and brakes It is raw;lfAnd lrIt is the front axle and rear axle of vehicle to the distance of barycenter;L is the distance between vehicle antero posterior axis lf+lr μ is the conventional road surface coefficient of viscosity, and m is the quality of vehicle, IψIt is the rotary inertia of vehicle;
Step 6:Calculate to obtain and expect front wheel angle:
&delta; f d = F l d / C f + ( &beta; + l f r &upsi; )
Wherein CfIt is the cornering stiffness of front tyre, lfDistance of the front axle of vehicle to barycenter;υ is the linear velocity of vehicle;β is vehicle Side slip angle;R is the angular speed of vehicle, and ψ is the course angle of vehicle,
Step 7:Ask for expecting driving force or desired braking power F for longitudinal direction of car power modeltrbrdIt is the inverse longitudinal force of input Model;If FtrbrdResult of calculation for just, then be desired driving force Ftrd, then calculate desired throttle opening αthb; , whereas if FtrbrdResult of calculation be negative, then be desired brake force Fbrd, then calculate desired braking moment Pbrd
Step 8:Desired throttle opening αthbComputational methods be:The elastic deformation of tire and power train is not considered, according to Longitudinal direction of car power model, desired engine torque TedWith current engine speed ωe, can be in the hope of using inverse engine mockup Obtain desired throttle opening αthb
αthb=fieng(Tede)
Wherein fieng(Tede) represent inverse engine torque characteristics function;
Or, desired braking moment PbrdComputing formula be:Pbrd=Fbrd/Kbr, KbrIt is desired brake force and braking moment Between linear relationship proportionality coefficient.
2. the unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle according to claim 1, It is characterized in that:Unmanned vehicle centroid position changing coordinates are chosen in step one with a planning point position coordinates error X- in planned trajectory Xd、Y-YdAnd unmanned vehicle velocity yaw angle is with planning point driftage angle errorIt is the |input paramete of tracking control unit; Throttle opening αthOr braking moment Fbr, front wheel angle δfIt is tracking control unit output parameter.
3. the unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle according to claim 1, It is characterized in that:The cornering stiffness C of front tyrefNumerical value take the twice of single tire cornering stiffness.
CN201510278571.6A 2015-05-27 2015-05-27 Unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle Active CN104881030B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510278571.6A CN104881030B (en) 2015-05-27 2015-05-27 Unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510278571.6A CN104881030B (en) 2015-05-27 2015-05-27 Unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle

Publications (2)

Publication Number Publication Date
CN104881030A CN104881030A (en) 2015-09-02
CN104881030B true CN104881030B (en) 2017-06-27

Family

ID=53948560

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510278571.6A Active CN104881030B (en) 2015-05-27 2015-05-27 Unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle

Country Status (1)

Country Link
CN (1) CN104881030B (en)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105676643B (en) * 2016-03-02 2018-06-26 厦门大学 A kind of intelligent automobile turns to and braking self-adaptive wavelet base method
CN105676674B (en) * 2016-04-20 2017-08-25 北京航空航天大学 Unmanned plane front-wheel steer control method based on instruction wave filter
WO2018023201A1 (en) * 2016-08-03 2018-02-08 孟强 Adaptive terminal sliding mode control method
CN107792071A (en) * 2016-08-26 2018-03-13 法乐第(北京)网络科技有限公司 A kind of running method and device of unmanned equipment
CN107315411B (en) * 2017-07-04 2020-04-21 合肥工业大学 Lane changing track planning method for unmanned vehicle based on vehicle-vehicle cooperation
CN108227491B (en) * 2017-12-28 2021-11-16 重庆邮电大学 Intelligent vehicle track tracking control method based on sliding mode neural network
CN108549400B (en) * 2018-05-28 2021-08-03 浙江工业大学 Self-adaptive control method of four-rotor aircraft based on logarithm enhanced double-power approach law and fast terminal sliding mode surface
CN109765888B (en) * 2018-12-27 2021-12-31 东软睿驰汽车技术(沈阳)有限公司 Vehicle control method, device and system
CN110457326A (en) * 2019-08-13 2019-11-15 长沙智能驾驶研究院有限公司 Engine torque MAP table look-up method, device, computer equipment and storage medium
CN110703754B (en) * 2019-10-17 2021-07-09 南京航空航天大学 Path and speed highly-coupled trajectory planning method for automatic driving vehicle
CN112255915A (en) * 2020-09-30 2021-01-22 南京航空航天大学 Construction and parameter setting method of automobile chassis decoupling sliding mode controller
CN112224214A (en) * 2020-10-15 2021-01-15 北京航天发射技术研究所 Vehicle speed control method, device, equipment and computer readable storage medium
CN112562371B (en) * 2020-11-02 2022-03-04 河海大学 Lightweight scheduling method based on automatic driving motorcade at signal lamp-free intersection
CN113009829B (en) * 2021-02-25 2022-04-26 清华大学 Longitudinal and transverse coupling control method for intelligent internet motorcade
CN114721274B (en) * 2022-04-24 2022-11-01 广东工业大学 Sliding mode controller design method and system based on improved fal function

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6958850B2 (en) * 2002-03-12 2005-10-25 Corning Incorporated Pointing angle control of electrostatic micro mirrors with modified sliding mode control algorithm for precision control
CN103538068A (en) * 2013-10-12 2014-01-29 江南大学 Fuzzy sliding mode trajectory tracking control method for SCARA robot
CN103616818A (en) * 2013-11-14 2014-03-05 河海大学常州校区 Self-adaptive fuzzy neural global rapid terminal sliding-mode control method for micro gyroscope

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6958850B2 (en) * 2002-03-12 2005-10-25 Corning Incorporated Pointing angle control of electrostatic micro mirrors with modified sliding mode control algorithm for precision control
CN103538068A (en) * 2013-10-12 2014-01-29 江南大学 Fuzzy sliding mode trajectory tracking control method for SCARA robot
CN103616818A (en) * 2013-11-14 2014-03-05 河海大学常州校区 Self-adaptive fuzzy neural global rapid terminal sliding-mode control method for micro gyroscope

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Fast termainl sliding-mode control design for nonlinear dynamical system;Yu Xinghou,Man Zhihong;《IEEE Transactions on Circuits and Systems I:Fundamental Theory and Applications》;20021231;第49卷(第2期);第261-265页 *
移动机器人的快速终端滑模轨迹跟踪控制;吴青云,等;《系统工程与电子技术》;20071231;第29卷(第12期);第2127-2130页 *
赵鹏,等.非奇异快速终端滑模液位跟踪控制.《西安交通大学学报》.2011,第45卷(第12期), *

Also Published As

Publication number Publication date
CN104881030A (en) 2015-09-02

Similar Documents

Publication Publication Date Title
CN104881030B (en) Unmanned vehicle side Longitudinal data tracking and controlling method based on fast terminal sliding formwork principle
Li et al. Development of a new integrated local trajectory planning and tracking control framework for autonomous ground vehicles
CN111845774B (en) Automatic driving automobile dynamic trajectory planning and tracking method based on transverse and longitudinal coordination
CN110187639B (en) Trajectory planning control method based on parameter decision framework
Ji et al. Path planning and tracking for vehicle collision avoidance based on model predictive control with multiconstraints
CN109318905A (en) A kind of intelligent automobile path trace mixing control method
CN103121451B (en) A kind of detour changes the tracking and controlling method of track
CN102167039B (en) Unpiloted independently-driven and steered vehicle dynamics control quantity obtaining method
CN108717268A (en) Automatic Pilot minimum time maneuver control system and its control method based on optimum control and safe distance
CN108860149B (en) Motion trajectory design method for shortest free lane change of intelligent vehicle
Wang et al. Path planning and path tracking for collision avoidance of autonomous ground vehicles
CN111679667B (en) Path and vehicle speed collaborative planning method for unmanned racing vehicle
Sun et al. Ribbon model based path tracking method for autonomous land vehicle
WO2023155231A1 (en) Highly humanoid safe-driving decision-making method for autonomous commercial vehicle
CN115303289A (en) Vehicle dynamics model based on depth Gaussian, training method, intelligent vehicle trajectory tracking control method and terminal equipment
CN113553726B (en) Master-slave game type man-machine cooperative steering control method in ice and snow environment
Yue et al. Automated hazard escaping trajectory planning/tracking control framework for vehicles subject to tire blowout on expressway
Kone Lateral and longitudinal control of an autonomous racing vehicle.
Nan et al. MPC-based path tracking control with forward compensation for autonomous driving
Shen et al. Stability and Maneuverability Guaranteed Torque Distribution Strategy of ddev in handling limit: a novel lstm-lmi approach
Liu et al. Path tracking control for inverse vehicle handling dynamics
Chen et al. An overtaking obstacle algorithm for autonomous driving based on dynamic trajectory planning
Fors et al. Yaw-moment control at-the-limit of friction using individual front-wheel steering and four-wheel braking
Zhao et al. Integrated longitudinal and lateral control system design and case study on an electric vehicle
Chen et al. Ribbon model based path tracking method for autonomous ground vehicles

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
EXSB Decision made by sipo to initiate substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20220609

Address after: 277000 room 539, Tengzhou big data Industrial Park, No. 199, Shangtong Road, Tengzhou City, Zaozhuang City, Shandong Province

Patentee after: Zaozhuang new era network engineering Co.,Ltd.

Address before: 710049 No. 28 West Xianning Road, Shaanxi, Xi'an

Patentee before: XI'AN JIAOTONG University