AN EXTENSION ADAPTIVE LANE-KEEPING CONTROL METHOD WITH VARIABLE VEHICLE SPEED

Information

  • Patent Application
  • 20210276548
  • Publication Number
    20210276548
  • Date Filed
    February 20, 2019
    5 years ago
  • Date Published
    September 09, 2021
    3 years ago
Abstract
This invention is an extension adaptive lane keeping control method with variable vehicle speed, which is composed of the following steps: S1, establishing a three-degree-of-freedom dynamic model and a preview deviation expression; S2, performing the lane line fitting equation; S3, designing the upper layer ISTE extension controller; including: S3.1, establishing the control index (ISTE) extension sets; S3.2, dividing the control index (ISTE) domain boundaries; S3.3, calculating the control index (ISTE) association function; S3.4, establishing the upper layer extension controller decision; S4, designing the lower layer speed extension controller; S5, designing the lower layer deviation tracking extension controller; including: S5.1, extracting the lower layer deviation tracking extension feature quantity and dividing domain boundaries; S5.2, designing the lower layer extension controller correlation function; S5.3, performing the lower layer measurement mode identification; S5.4, When the front wheel angle of lower layer controller outputs is calculated according to the measurement mode. This invention realizes the adaptive variation of the control coefficient of the extension controller and the boundary range of the constraint domain according to the tracking deviation precision, the speed variation, and the expert knowledge base.
Description
TECHNICAL FIELD

This invention belongs to the technical field of intelligent vehicle control and particularly relates to an extension lane-keeping control method with the variable vehicle speed of an intelligent vehicle.


BACKGROUND

Intelligent vehicles have become an important carrier and meeting the requirements of safe, efficient, and intelligent transportation development have become the main targets for their development and research. Specifically, electric intelligent vehicles have a great effect on environmental pollution, energy efficiency, and traffic congestion. Among them, the lane-keeping technology of intelligent vehicles has gradually become one of the hot topics of research in the road driving process, especially curve keeping and high-speed lane-keeping performance.


To achieve self-awareness, independent decision-making, and autonomous execution to ensure safe driving, lane-keeping control of intelligent vehicles is based on the common vehicle platform, architecture computer, vision sensor, automatic control actuator, and signal communication equipment. Most common vehicles are front-wheel drive, and fire lateral control accuracy of the vehicle and the safety stability of the vehicle are ensured by adjusting the front wheel angle. The lane-keeping is based on a visual sensor, such as a camera. The lane line information is extracted through lane line detection, the position of the vehicle in the lane is acquired, and the front wheel angle to be executed at the next moment is determined based on the lane line and vehicle position information. There are two main methods of control: the pie-shooting reference system and the non-pre-attack reference system. The pre-shooting reference system mainly takes as input the road curvature at the front of the vehicle according to the lateral error or heading error between the vehicle and the desired path. To meet the control target, a feedback control system robust for the vehicle dynamic parameters is designed through various feedback control methods, such as a reference system based on a vision sensor like radar or a camera. The non-pre-attack reference system calculates a physical quantity describing the vehicle motion, such as the vehicle yaw rate, based on the desired path near the vehicle, and then designs a feedback control system for tracking. This invention is based on the pre-shooting control method. A plurality of the desired vehicle states at the front point completes the design of the extension lane-keeping control method for multi-state feedback.


SUMMARY

From the current main research contents, the control precision and stability of intelligent vehicles lane-keeping control under large curves and high speed are hot topics of research. This invention is aimed at the control accuracy of intelligent vehicles lane-keeping in variable speeds, and an extension adaptive lane-keeping control method with variable vehicle speeds is proposed.


This invention applies the extension control method to the intelligent vehicle lane-keeping control method to ensure that the vehicle always moves within the lane range during the movement of the vehicle. The control objective of the lane-keeping is to ensure that the distance between the left lane line and the right lane line of the vehicle is equal and the heading error is zero. The upper layer extension controller of the invention adaptively adjusts the lower layer control coefficients according to the current integral square of error with time index (ISTE) of the lane-keeping. The lower layer extension controller consists of two parts, the speed extension controller and the deviation tracking extension controller, and changes the constraint domain boundary range according to the vehicle speed change, which realizes the lane-keeping control function of the intelligent vehicle with a variable speed.


The beneficial effects of this invention can be summarized as follows:

    • (1) Innovatively, the extension control method is applied to the lane-keeping control of intelligent vehicles during variable speed motion.
    • (2) The lower layer error tacking extension controller can change the control coefficient and the constraint domain boundary range adaptively according to the tracking error accuracy, speed variation, and the expert knowledge base.





BRIEF DESCRIPTION OF THE DRAWINGS


FIG. 1 is a block diagram of the extension adaptive lane-keeping control method with variable speed;



FIG. 2 is the three-degree-of-freedom vehicle dynamic model:



FIG. 3 is the path tracking preview model;



FIG. 4 is the ISTE extension set division;



FIG. 5 is the lower layer speed extension set division;



FIG. 6 is the lower layer error tracking extension sets division.





DETAILED DESCRIPTION

The invention is further described below with reference to the figures.


As shown in FIG. 1, the control principle and method of the invention includes the following steps:


Step 1: Establish a Three-Degree-of-Freedom Dynamic Model


The invention adopts a three-degree-of-freedom vehicle dynamics model, including longitudinal motion, lateral motion, and yaw motion. FIG. 2 shows a schematic diagram of a vehicle three-degree-of-freedom dynamic model. According to Newton's second law theorem, the equilibrium equations along the x-axis, y-axis, and z-axis can be obtained as follows:









{






m


(


x
¨

-


y
.



φ
.



)


=


Σ






F
x


=


2


F
lf






cos






δ
f


=


2


F
cf






sin






δ
f


+

2


F
lr






,








m


(


y
¨

+


x
.



φ
.



)


=


Σ






F
y


=


2


F
lf






sin






ϵ
f


-

2


F
cf






cos






ϵ
f


+

2


F
cr





,








I
z



φ
¨


=


Σ






M
z


=


2


(



F
lf






sin






δ
f


+


F
cf






cos






δ
f



)


-

2


bF
cr












(
1
)







where m is the vehicle mass; x is the longitudinal displacement; φ is the yaw angle; δf is the front wheel angle: {dot over (φ)} is the yaw rate: y is the lateral displacement; Iz is the yaw moment of inertia around Z-axis; Fx is the longitudinal force of vehicle; Fy is the lateral force of vehicle; Mz is the yaw moment; Fcf and Fcr is the lateral force of front tires and rear tires, respectively, related to the lateral force, corner stiffness, and slope angle of tries; Flf and Flr is the longitudinal force of front and rear tires, respectively, related to the longitudinal stiffness and slip ratio of tires; Fxf and Fxr is the front and rear force of x-axis, respectively; Fy and Fyr is the front and rear force of the y-axis; a is the distance of the front wheel axle from the center of gravity; and b is the distance of rear-wheel axle from center of gravity.


The preview error during the path tracking process of the vehicle includes the heading error and the lateral position error at the pre-shooting point. As shown in FIG. 3, yL is the lateral position error at the pre-shooting point, φh is the heading error, and L is the pre-shooting distance.


According to the geometric relationship in the figure:






{dot over (y)}
L
={dot over (x)}φ
h
−{dot over (y)}−{dot over (φ)}L  (2)





{dot over (φ)}h={dot over (x)}ρ−{dot over (φ)}  (3)


Step 2: Lane Line Fitting Calculation


Lane line fitting functions use a quadratic polynomial equation based on the road curvature ρ and the distance of the vehicle from the left line and right line DL, Dr, respectively. The lane line equation for the curve can be obtained as follows:









{





y
1

=


ρ






x
2


+


φ
p


x

+

D
L










y
2

=


ρ






x
2


+


φ
p


x

+

D
r



,








(
7
)







where ρ is the road curvature; DL, Dr is the distance of the vehicle from the left line and right line, respectively; φρ is the heading angle of lane line: y1 is left line fitting function; and y2 is right line fitting function.


Considering that the heading error angle of the vehicle ranges from −1 rad to 1 rad, the lane line curvature setting range is set between −0.12/m and 0.12/m.


Step 3: Upper Layer ISTE Controller Design


1) Control Index (ISTE) Extension Set


The control index (ISTE) reflects the control effect, and the control target of lane-keeping ensures that the intelligent vehicle moves in the range of the lane line. In addition, it should make the lateral error yL and heading error φh equal to zero. Therefore, in this event, the control index should consider the errors mentioned above. The calculation method of the extension control index adopts the principle of integrating the time multiplied by the square of the error. The specific expression is as follows:






ISTE
y=∫0TstyL2dt


where ISTEy is the control index of the lateral position error, and Ts is the adjustment time;






ISTE
φ=∫0Tsh2dt


where ISTEφ is the control index of heading error, and Ts is the adjustment time.


The upper layer ISTE extension controller selects the control indexes ISTEy and ISTEφ as the feature quantities and builds the extension set SISTE(ISTEy, ISTEφ).


2) Control Index (ISTE) Domain Boundary


The extension control index ISTE is the integral form of the error multiplied by time, and the result varies within the range of [0, +∞). Therefore, the classical domain boundary of the control effect is expressed as follows:







R
op

=

[




ISTE
y




[

0
,

a
op


]






ISTE
φ




[

0
,

b
op


]




]





aop and bop are the classical domain constraint boundaries of the control index extension set, the values can be expressed as follows:






a
op=∫0Tst·ryop2dt






b
op=∫0Tst·rφop2dt,


where ryop is the classical domain constraint range for the lateral positional error, rφop is classical domain constraint range for heading error, and the two values are related to the values of the lower layer extension controller, which can adaptively adjust along with the vehicle speed.


The extension domain boundary of control index is as follows:







R
p

=

[




ISTE
y




[

0
,

a
p


]






ISTE
φ




[

0
,

b
p


]




]





ap and bp are the extension domain constraint boundaries of the control index extension set, the values can be expressed as follows:






a
p=∫0Tst·ryp2dt






b
p=∫0Tst·rφp2dt,


where ryp is the classical domain constraint range for lateral positional error, rφp is extension domain constraint range for heading error, and the two values are related to the values of lower layer extension controller, which can adaptively adjust with the vehicle speed.


3) Calculation of Correlation Function for the Control Index (ISTE)


In this event, to calculate the value, the correlation function of the control index (ISTE) adopts a dimensionality reduction method. FIG. 4 shows the extension set boundaries. The point P(∫0TstyL2dt, ∫0Tsh2dt)custom-character is the current position point in the extension set of the control indexes when the vehicle moves in the lane. The optimal state of the vehicle motion is a zero error state, that is, the origin point O (0,0). In this event, connecting the point P and the origin point, the line intersects the classical domain boundary and extension domain boundary at points P1 and P2, respectively. It can consider the correlation function of one-dimension extension distance based oil the points Px and P2.


The extension distance of point P and the classical domain custom-characterO, P1custom-character and the extension domain custom-characterP1, P2custom-character are expressed as custom-character[P, custom-characterO, P1custom-character] and custom-character[P, custom-characterP1, P2custom-character], respectively. Those values can be obtained as follows:










[

P
,



O
,

P
1





]


=

{







-


OP



,

P


[

0
,


P
1

/
2


]









-



PP
1




,

P


[



P
1

/
2

,

P
1


]











PP
1



,

P


[


P
1

,

+



]















[

P
,




P
1

,

P
2





]



=

{







PP
1



,

P


[

0
,

P
1


]









-



PP
1




,

P


[


P
1

,


(


P
1

+

P
2


)

/
2


]









-



PP
2




,





P


(



(


P
1

+

P
2


)

/
2

,

P
2


]











PP
2



,

P


(


P
2

,

+



)













Then, the correlation function KISTE(P) of the control index can be expressed as follows:









K
ISTE



(
P
)


=





[

P
,




P
1

,

P
2





]



𝒟


[

P
,




P
1

,

P
2




,



O
,

P
1





]




,




where






custom-character[P,custom-characterP1,P2custom-character,custom-characterO,P1custom-character]=custom-character[P,custom-characterP1,P2custom-character]−custom-character[P,custom-characterO,P1custom-character]


4) Upper Layer Extension Controller Decision


An expert knowledge base is used in the upper layer extension controller decision, including five expert pieces of knowledge as follows:


a. When KISTE(P)≥0, the control satisfies the control requirements and maintains the original control coefficient.


b. When −1≤KISTE(P)<0, the control needs further improvement, and it is necessary to continue changing the control coefficient in the lower controller.


c. When KISTE(P)<−1, there is control failure.


d. When the lower characteristic state stays for a long time in the second measurement mode (i.e., the critical steady-state), it indicates that the control quantity changes little, and the control coefficient in the measurement mode should be appropriately increased to accelerate the development of the characteristic state to the steady state.


e. When the current control effect is worse than the last control effect, the coefficient in the measurement mode is returned to the previous control coefficient, and the control coefficient is appropriately reduced.


The decision result is set to:


When KISTE(P)≥0, select expert knowledge a;


When −1≤KISTE(P)<0, select three expert pieces of knowledge b, d, or e;


When KISTE(P)<−1, select expert knowledge c.


Step 4: Lower Speed Extension Controller Design


The lower layer speed extension controller feature quantity selects the deviation evx of the vehicle longitudinal speed vx and the desired longitudinal speed vxdis and they constitute the speed extension controller feature set Svx(evxvx) while the optimal state is S0(0,0).


The velocity feature quantity classical domain boundary is expressed as follows:








R

osv
x


=

[




e

v
x





[


-

e


ν
x


om



,

e


v
x


om



]






e

v
x

.




[


-


e
.



v
x


om



,


e
.



v
x


om



]




]


,




where evxom and ėVxom are the classical domain boundaries of the feature set Svx(evx, ėvx).


The velocity feature quantity extension domain boundary is expressed as follows:








R

sv
x


=

[




e

v
x





[


-

e


ν
x


m



,

e


v
x


m



]






e

v
x

.




[


-


e
.



v
x


m



,


e
.



v
x


m



]




]


,




where evxm and evxm are the extension domain boundaries of the feature set Svx(evx, ėvx).


Then, the non-domain can be defined as the remaining domains except for the classical domain and extension domain.


The extension set domain boundary of the speed extension controller is shown in FIG. 5.


The speed extension association function Kvx(S) of the lower layer speed extension controller (S) is calculated as follows:


The classic domain extension distance is:






M
v

x

0=√{square root over (evxom2vxom2)};


the extension domain extension distance is:






M
v

x
=√{square root over (evxom2vxom2)};


Moreover, the extension distance of the real-time feature state and the best state can be expressed as follows:





|SvxS0|=√{square root over (evx2vx2)};


When Svx(evx,evx)ϵRosvx;






K
v

x
(S)=1−|SvxS0|/|Mvx0|;





else,






K
v

x
(S)=(Mvx0−|SvxS0|)/(Mvx−Mvx0)


Therefore, the velocity feature quantity correlation function is as follows:








K

v
x




(
S
)


=

{






1
-





S

v
x




S
0




/



M


v
x


0






,



S

v
x




(


e

v
x


,


e
.


v
x



)




R

osv
x











(


M


v
x


0


-




S

v
x




S
0





)

/

(


M

v
x


-

M


v
x


0



)


,



S

v
x




(


e

v
x


,


e
.


v
x



)




R

osv
x







.






The output calculation of speed extension controller is:


When Kvx(S)≥0, the real-time speed feature quantity Svx(evxvx) is in the classical domain, and the state is marked as measurement inode M1. Under this state, the speed control is easy, the control process is very stable, and it is a fully controllable state.


The output longitudinal tire force Fx of the controller is as follows:






F
x
=−K
v
e
v

x
,


where Kv is state feedback gain coefficient.


When −1≤Kvx(S)<0, the real-time speed feature quantity Svx(evxvx) is in the extension domain and the state is marked as measurement inode M2. When the speed control difficulty is increasing, the error of actual vehicle speed and the target vehicle speed are larger, the control quantity change speed needs to be increased, and the control process is a critical steady state.

    • The output longitudinal force Fx of the controller is as follows:






F
x
=−K
v
e
v

x

+K
vc
·K
v

x
(Ssgn(evx),


where Kvc is an additional output term gain coefficient, and sgn(evx) is a symbolic function that satisfies the following function:







sgn


(

e

v
x


)


=

{





1
,


e

v
x


>
0







0
,


e

v
x


=
0








-
1

,


e

v
x


<
0





.






When Kvx(S)<−1, the real-time speed feature quantity Svx(evxvx) is in a non-domain and the state is marked as measurement mode M3. This state is a very unstable control state. The error of actual vehicle speed and the desired vehicle speed is much larger at this time. The longitudinal force of the tire must reach a maximum value to reach the desired vehicle speed as quickly as possible, that is, Fx(t)=Fxmax.


Therefore, the output longitudinal force Fx of controller is as follows:







F
x

=

{






-

K
v




e

v
x



,



K

v
x




(
S
)



0










-

K
v




e

v
x



+


K
vc

·


K

v
x




(
S
)


·

sgn


(

e

v
x


)




,


-
1




K

v
x




(
S
)


<
0








F
xmax

,



K

v
x




(
S
)


<

-
1











Step 5: Lower Layer Error Tracking Extension Controller Design


1) Error Tracking Extension Feature Quantities Extraction and Domain Bounding


The lower layer error tracking extension controller selects the preview lateral position error yL and heading error φh as the extension feature quantities, which form a two-dimensional feature state set denoted as S(yL, φh). The control target should ensure the lateral error and heading error is zero when tracking the desired path for the lateral control of intelligent vehicles. The feature quantities extension set division of the lower layer controller is shown in FIG. 6.


According to Extenics theory, the classical domain and extension domain for the feature quantities are ensured. Moreover, they can be expressed as follows:


For the classic domain,











R

low

_

os


=

[




y
L




[


-

y
Lom


,

y
Lom


]






φ
h




[


-

φ
hom


,

φ
hom


]




]


,




(
20
)







where yLom and φhom are the classical domain boundaries of the feature set S(yL, φh).


For the extension domain,











R

low

_

s


=

[




y
L




[


-

y
Lm


,

y
Lm


]






φ
h




[


-

φ
hm


,

φ
hm


]




]


,




(
21
)







where yLm and φhm are the classical domain boundaries of the feature set S(yL, φh).


Then, the non-domain can be defined as the remaining domains except for the classical domain and extension domain of the feature set S(yL, φh).


2) Correlation Function of Lower Layer Extension Controller


For the lateral control of intelligent vehicles, the control target should ensure that the lateral error and heading error are zero when tracking the desired path. The optimal state is Slow0=(0,0).


In the process of vehicle motion, the real-time feature quantities are marked as S(yL, φh), and then the extension distance of the real-time state quantities and the optimal point is as follows:





|SSlow0|=√{square root over (k1yL2+k2φh2)},  (22)


where k1 and k2 are the real-time state quantities and optimal state point extension weighting coefficients; the coefficients are usually 1.


The extension distance of the classic domain is as follows:






M
eo=√{square root over (yLom2hom2)}.  (23)


The extension distance of extension domain is as follows:






M
e=√{square root over (yLm2hm2)}.  (24)


If the real-time feature state quantity S(yL, φh) is located in the classic domain Rlow_os, then the correlation function is as follows:






K
low(S)=1−|SSlow0|/Meo  (25)





Else,






K
low(S)=(Meo−|SSlow0|)/(Me−Meo).  (26)


In summary, the correlation function is as follows:











K
low



(
S
)


=

{





1
-




SS

low





0




/

M
eo



,

S


R

low

_

os











(


M
eo

-



SS

low





0





)

/

(


M
e

-

M
eo


)


,

S


R

low

_

os












(
27
)







3) Measure Mode Recognition of the Lower-Layer Controller


The measurement mode recognition of the system characteristic quantity S(yL, φh) is determined according to the above the value of correlation function Klow (S). The measurement mode recognition rules are described below.


IF Klow(S)≥0, THEN the measurement mode of the real-time feature state quantity S(yL, φh) is in the classical domain and the measurement mode state is marked as Mlow_1. Under this state, the error tracking control is easy, and the control process is very stable, and it is a fully controllable state;


IF −1≤Klow(S)<0, THEN the measurement mode of the real-time feature state quantity S(yL, φh) is in the extension domain and the measurement mode state is marked as Mlow_2. When the error tracking control difficulty is increasing, the error of the lateral position error and the heading error are larger, the control quantity and the control quantity change speed need to be increased, and the control process is a critical steady state; ELSE, the real-time feature state quantity S(yL, φh) is in the non-domain and the measurement mode state is marked as Mlow_3. The error of the lane-keeping control is much larger and the vehicle even skids off the lane. The control process is an extremely unstable state.


4) Output Front-Wheel Angle of the Lower Layer Controller


When the state is in mode Mlow_1, the state is in the stable state, and the output front-wheel steeling angle is as follows:





δf=−KlowCM1S  (28)


where KlowCM1 is the state feedback coefficient of the measurement mode Mlow_1 related to the characteristic quantity S, and KlowCM1=[Klow_c1 Klow_c1]T, where Klow_c1 and Klow_c1 are the state feedback coefficients related to the feature quantity yL and feature quantity φh. The invention adopts a pole placement method to select the state feedback coefficients and S is [yL φh]T.


When the state is in mode Mlow_2, the state is in a critical instability state and in the controllable range. The controller can re-adjust the system to a steady-state by controlling the additional output. The output steering angle is as follows:





δf=−KlowCM1{S+KlowC·Klow(S)·[sgn(S)]}.  (29)


KlowC is an additional output term gain coefficient in the measurement mode Mlow_2. To ensure that additional outputs enable the system to return to a relatively steady state, the coefficient is manually adjusted based on measurement mode Mlow_1.


Here,










sgn


(
S
)


=

{




1
,

S
>
0







0
,

S
=
0








-
1

,

S
<
0










(
30
)







KlowC·Klow(S)·[sgn(S)] is the additional output additional output term. This term combines the value of the correlation function of the lower layer controller that embodies the adjustment difficulty of the vehicle moving along the centerline of the lane during lane-keeping control. Therefore, the value of the additional output of the controller is changed in real time according to the control difficulty by changing the correlation function value.

    • When the state is in measurement mode Mlow_3, it cannot be adjusted to a stable state in time because the vehicle has a large error from the centerline of the lane. To ensure the safety of the vehicle, the output steering angle of the front wheel is as follows:





δf=0  (31)


When the state is in measurement mode Mlow_3, the error from the lane during the lane-keeping process is very large, and the lane-keeping control fails. If the vehicle wants to return to the original lane, then the front wheel corner output value is instantly large. In the case of a first vehicle speed, vehicle movement has great safety hazards under the large front wheel angle input, which should be avoided as much as possible in the control process. This situation rarely exists due to the current Chinese road planning size.


In summary, the output front wheel steering angle of lower layer deviation tracking extension controller based on characteristic quantity S is as follows:










δ
f

=

{







-

K

lowCM





1




S

,


S


(


y
L

,

φ
h


)




M


low

_


1











-

K

lowCM





1





{

S
+


K
lowC

·


K
low



(
S
)


·

[

sgn


(
S
)


]



}


,


S


(


y
L

,

φ
h


)




M


low

_


2









0
,


S


(


y
L

,

φ
h


)




M


low

_


3







.






(
32
)







The output of the above controller is fed back to the vehicle model, and the relevant parameters in the model are adjusted in real time so that the vehicle can adjust the lane tracking status in teal time.


The series of detailed descriptions set forth above are merely illustrative of the possible embodiments of the present invention, and they are not intended to limit the scope of the present invention. Changes are intended to be included within the scope of the invention.

Claims
  • 1. An extension adaptive lane keeping control method with variable vehicle speed, comprising the following steps: S1. establishing a three-degree-of-freedom dynamics model and a preview deviation equation;S2, performing the lane line fitting calculation;S3, designing the upper ISTE extension controller; including:S3.1, establishing a control index ISTE extension set;S3.2, dividing the control index of the ISTE domain boundary;S3.3, calculating the control index ISTE correlation function;S3.4, establishing an upper layer extension controller decision;S4, designing a lower layer speed extension controller;S5, designing a lower layer deviation tracking extension controller; including:S5.1, the extraction of the lower layer deviation tracking extension feature quantity and dividing domain boundary;S5.2, designing a lower layer extension controller correlation function;S5.3, performing lower layer measurement mode recognition;S5.4, the lower controller calculates the front-Wheel angle according to the measurement mode.
  • 2. The extension adaptive lane keeping control method with variable vehicle speed according to claim 1, wherein, in Step 1 the three-degree-of-freedom dynamic model is as follows:
  • 3. The extension adaptive lane keeping control method with variable vehicle speed according to claim 1, wherein, the lane line fitting in Step 2 adopts a quadratic polynomial fitting, according to the road curvature value ρ and the distance between the vehicle camera and the left and right lane lines DL and Dr, the lane line fitting equation when the curve is obtained as follows:
  • 4. The extension adaptive lane keeping control method with variable vehicle speed according to claim 1, Wherein, when the control index ISTE extension set is established in Step 3.1, the extension control index calculation method adopts the integral of time multiplied by the square of the error, and the expression is as follows: ISTEy=∫0TstyL2dt, where ISTEy is the control index of the lateral position error, and Ts is the adjustment time; ISTEφ=∫0Tstφh2dt, where ISTEφ is the control index of the heading angle error, and Ts is the adjustment time; the upper layer ISTE extension controller selects the control index ISTEy and ISTEφ as the feature quantities and establishes the extension set SISTE(ISTEy, ISTEφ) related to the control index;in Step 3.2, the expression of the classic domain boundary of the control index is
  • 5. The extension adaptive lane keeping control method with variable vehicle speed according to claim 4, wherein, in Step 3.3 the calculation of the control index ISTE correlation function is performed by using a dimensionality reduction method, and P(∫0TstyL2dt, ∫0Tsφh2dt) is the position of the current control index value point in the extension set of the control index when the vehicle is moving in the lane line: the optimal state point is that there is no deviation state, that is, the point O (0, 0), the connection origin, and the P point, and the classic domain boundary and extension domain boundary intersect at points P1 and P2, respectively, then, the extension distances from point P to classical domain O, P1 and extension domain P1, P2 are [P, O, P1] and [P, P1, P2], respectively; they are:
  • 6. The extension adaptive lane keeping control method with variable vehicle speed according to claim 5, wherein, in Step 3.4 an expert knowledge base is used in the upper layer extension controller decision, including five expert pieces of know ledge, respectively: a. when KISTE(P)≥0, the control satisfies the control requirements and maintains the original control coefficient;b. when −1≤KISTE(P)<0, the control needs further improvement, and it is necessary to continue to change the control coefficient in the lower controller;c. when KIETE(P)<−1, there is control failure;d. when the lower characteristic state stays for a long time in the second measurement mode (i.e., the critical steady-state), it indicates that the control quantity changes little, and the control coefficient in the measurement mode should be appropriately increased to accelerate the development of the characteristic state to the steady-state;e. when the current control effect is worse than the last control effect, the coefficient in the measurement mode is returned to the previous control coefficient, and the control coefficient is appropriately reduced;the decision result is set as follows:when KISTE(P)≥0, select expert knowledge a;when −1≤KISTE(P)<0, select three pieces of expert knowledge b, d or e;when KISTE(P)<−1, select expert knowledge c.
  • 7. The extension adaptive lane keeping control method with variable vehicle speed according to claim 5, the implementation of Step 4 is composed of: S4.1, The lower layer speed extension controller feature quantity selects the deviation evx of the vehicle longitudinal speed vx and the desired longitudinal speed vxdis, and constitutes the speed-extension controller feature set Svx(evx, ėvx), and the optimal state is S0(0,0);the velocity feature quantity classical domain boundary is expressed as follows:
  • 8. The extension adaptive lane keeping control method with variable vehicle speed according to claim 1, the preview lateral position error yL and heading error φh in Step 5.1 are selected during the feature quantity extraction, which forms a two-dimensional feature state set, denoted as S(yL, φh); the mentioned domain boundary division includes:the classic domain,
  • 9. The extension adaptive Lane-keeping control method with variable vehicle speed according to claim 8, when the lower layer measurement mode is recognized in Step 5.3, the measurement mode recognition of system characteristic quantity S(yL, φh) is determined by the correlation function value Klow(S′) the measurement mode recognition rules are as follows: if Klow(S)≥0, THEN the measurement mode of real-time feature state quantity S(yL, φh) is Mlow_1;if −1≤Klow(S)<0, THEN the measurement mode of real-time feature state quantity S(yL, φh) is Mlow_2;else it is Mlow_3.
  • 10. The extension adaptive lane keeping control method with variable vehicle speed according to claim 9, in Step 5.4, the outputs the front-wheel angle of lower-layer controller includes following conditions: when the state is in mode Mlow_1, the state is in the stable state, and the output front-wheel steering angle is as follows: Sf=−KlowCM1S,
Priority Claims (1)
Number Date Country Kind
201811373199.7 Nov 2018 CN national
PCT Information
Filing Document Filing Date Country Kind
PCT/CN2019/075504 2/20/2019 WO 00