# US 2021/0276548 A1 · An extension adaptive lane-keeping control method with variable vehicle speed

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2021/0276548 A1
- Document ID: US20210276548A1
- Status: Published application
- Kind: A1
- Application number: 16/626,886
- Filed: 2019-02-20
- Published: 2021-09-09
- Earliest claimed: 2018-11-19
- Assignees: Jiangsu University
- Applicants: Jiangsu University
- Inventors: Yingfeng CAI; Yong ZANG; Hai WANG; Xiaoqiang SUN; Long CHEN; Jun LIANG; Yicheng LI; Dehua SHI; Bin TANG
- Web page: https://patentgrep.com/patent/US20210276548A1

## CPC

- B60W 30/12: Lane keeping
- B60W 50/0098: {Details of control systems ensuring comfort, safety or stability not otherwise provided for}
- B60W 30/143: {Speed control (B60W30/16 takes precedence)}
- B60W 30/18109: {Braking}
- B60W 50/0205: {Diagnosing or detecting failures; Failure detection models}
- B60W 2050/0006: {Digital architecture hierarchy}
- B60W 2050/0031: {Mathematical model of the vehicle}
- B60W 2420/403: Image sensing, e.g. optical camera
- B60W 2552/53: Road markings, e.g. lane marker or crosswalk
- B60W: CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT

## 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.

## Claims

### Claim 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.

### Claim 2 (depends on 1)

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:
{
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
⁢
a
⁡
(
F
lf
⁢
sin
⁢
⁢
δ
f
+
F
cf
⁢
cos
⁢
⁢
δ
f
)
-
2
⁢
bF
cr
,
where m is the mass of the vehicle; x is the longitudinal displacement; φ is the yaw angle; δf is the front-wheel angle; y is the lateral displacement; Iz is the Z-axis moment of inertia; Fx is the total longitudinal force of the vehicle tires; Fy is the total lateral force of the vehicle tires; Mz is the total yaw moment of the vehicle; Fcf and Fcr are the lateral threes of the front and rear vehicle tires, respectively, winch are related to the lateral stiffness and the side yaw angle of the tire; Fif and Fir are before and after the vehicle, and the longitudinal force of the tire is related to the longitudinal stiffness and slip ratio of the tire; Fxf and Fxr are the force of the front and rear vehicle tires in the x direction; Fxf and Fyr are the force of the front and rear vehicle tires in the y direction; a is the distance from the front axle to the center of gravity; and b is the distance from rear axle to center of gravity;
the preview deviation includes a heading deviation and a lateral position deviation at the preview point, the mentioned lateral position deviation yL and the heading deviation φh at the preview point are respectively as follows:
{dot over (y)}L={dot over (x)}φh−{dot over (y)}−{dot over (φ)}L
{dot over (φ)}h={dot over (x)}ρ−{dot over (φ)}
where L is the preview distance, and ρ is the road curvature.

### Claim 3 (depends on 1)

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:
{
y
1
=
ρ
⁢
x
2
+
φ
ρ
⁢
x
+
D
L
y
2
=
ρ
⁢
x
2
+
φ
ρ
⁢
x
+
D
r
,
where ρ is the road curvature; DL and Dr are the distances between the vehicle camera and the left and right lane lines, respectively; φρ is the lane line heading angle; y1 is the left-lane line-fitting function; and y2 is the right-lane line-fitting function.

### Claim 4 (depends on 1)

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
R
op
=
[
ISTE
y
[
0
,
a
op
]
ISTE
φ
[
0
,
b
op
]
]
;
aop and bop represent the classical domain constraint range of the control index extension set, and the value can be expressed as follows:
aop=∫0Tst·ryop2dt
and
bop=∫0Tst·rφop2dt,
where ryop is the classical domain constraint range of the lateral position error, and rφop is the extension domain constraint range of the heading deviation:
the extension domain boundary of the control index is expressed as follows:
R
p
=
[
ISTE
y
[
0
,
a
p
]
ISTE
φ
[
0
,
b
p
]
]
;
ap and bp represent the extension domain constraint range of the control index extension set, and the value can be expressed as follows:
ap=∫0Tst·ryp2dt
and
bp=∫0Tst·rφp2dt,
where ryp is the extension domain constraint range of the lateral position error, and rφp is the extension domain constraint range of the heading deviation.

### Claim 5 (depends on 4)

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:
ℛ
⁡
[
P
,
〈
O
,
P
1
〉
]
=
{
-

OP

,
P
∈
[
0
,
P
1
/
2
]
-

PP
1

,
⁢
P
∈
(
P
1
/
2
,
P
1
]

PP
1

,
⁢
P
∈
(
P
1
,
⁢
+
∞
]
⁢
⁢
and
⁢
⁢
R
⁡
[
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
,
+
∞
)
;
the correlation function KISTE(P) of the control index is expressed as follows:
K
ISTE
⁡
(
P
)
=
ℛ
⁡
[
P
,
〈
P
1
,
P
2
〉
]
𝒟
⁡
[
P
,
〈
P
1
,
P
2
〉
,
〈
O
,
P
1
〉
]
,
where [P, P1, P2,O, P1]=[P, P1, P2]−[P, O, P1].

### Claim 6 (depends on 5)

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.

### Claim 7 (depends on 5)

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:
R
o
⁢
s
⁢
ν
x
=
[
e
v
x
[
-
e
v
x
⁢
om
,
e
v
x
⁢
o
⁢
m
]
e
.
v
x
[
-
e
.
v
x
⁢
om
,
e
.
v
x
⁢
o
⁢
m
]
]
;
the velocity feature quantity extension domain boundary is expressed as follows:
R
s
⁢
ν
x
=
[
e
v
x
[
-
e
v
x
⁢
m
,
e
v
x
⁢
m
]
e
.
v
x
[
-
e
.
v
x
⁢
m
,
e
.
v
x
⁢
m
]
]
;
S4.2, 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:
Mvx0=√{square root over (evxom2+ėvxom2)};
the extension domain extension distance is:
Mvx=√{square root over (evxom2+ėvxom2)};
the extension distance of real-time feature state and the best state can be expressed as:
|SvxS0|=√{square root over (evx2+ėvx2)};
When Svx(evx,evx)ϵRosvx;
Kvx(S)=1−|SvxS0|/|Mvx0|;
else,
Kvx(S)=(Mvx0−|SvxS0|)/(Mvx−Mvx0)
therefore, the velocity feature quantity correlation function is as follows:
K
v
x
⁡
(
𝒮
)
=
{
1
-

𝒮
v
x
⁢
𝒮
0

/

M
v
x
⁢
0

,
𝒮
v
x
⁡
(
e
v
x
,
e
.
v
x
)
∈
R
osv
x
(
M
v
x
⁢
0
-

S
v
x
⁢
𝒮
0

)
/
(
M
v
x
-
M
v
x
⁢
0
)
,
S
v
x
⁡
(
e
v
x
,
e
.
v
x
)
∉
R
osv
x
S4.3: The output calculation of speed extension controller is as follows: When Kvx(S)≥0, the real-time speed feature quantity Svx(evx, ėvx) is measurement mode M1, and the state is a fully controllable state;
the output longitudinal tire force Fx of the controller is as follows:
Fx=−Kvevx,
where Kv is state feedback gain coefficient;
when −1≤Kvx(S)<0, the real-time speed feature quantity Svx(evx, ėvx) is measurement mode M2, and the state is critical controllable state;
the output longitudinal tire force Fx of the controller is as follows:
Fx=−Kvevx+Kvc·Kvx(S)·sgn(evx),
where Kvc is the 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(evx, ėvx) is measurement mode M3T which is an uncontrollable state, and the controller maintain last longitudinal force, that is, Fx(t)=Fxmax;
therefore, the output longitudinal force Fx of the controller is:
F
x
=
{
-
K
v
⁢
e
v
x
,
K
v
x
⁡
(
𝒮
)
≥
0
-
K
v
⁢
e
v
x
+
K
vc
·
K
v
x
⁡
(
𝒮
)
·
sgn
⁡
(
e
ν
x
)
,
⁢
-
1
≤
K
v
x
⁡
(
𝒮
)
<
0
F
xmax
,
K
v
x
⁡
(
S
)
<
-
1
.

### Claim 8 (depends on 1)

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,
R
low
⁢
_
⁢
os
=
[
y
L
[
-
y
Lom
,
y
Lom
]
φ
h
[
-
φ
hom
,
φ
hom
]
]
,
and the extension domain,
R
low
⁢
_
⁢
s
=
[
y
L
[
-
y
Lm
,
y
Lm
]
φ
h
[
-
φ
hm
,
φ
hm
]
]
;
in Step 5.2, the method for designing the lower layer extension controller association function specifically includes the steps below;
(be real-time feature state quantity during the vehicle motion is recorded as S(yL, φh), and then the extension distance of real-time feature state quantity and the optimal state point can be obtained as follows:
|SStow0|=√{square root over (k1yL2+k2<φh2)}:
the extension distance of the classic domain is as follows:
Mvo=√{square root over (yLom2+φhom2)};
the extension distance of the extension domain is as follows:
Me=√{square root over (yLm2+φhm2)};
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:
Klow(S)=1−|SSlow0|/Meo:
else,
Klow(S)=(Meo−|SSlow0|Me−/Meo:
in summary, the correlation function is as follows:
K
low
⁡
(
𝒮
)
=
{
1
-

𝒮𝒮
low
⁢
⁢
0

/
M
eo
,
𝒮
∈
R
low
⁢
_
⁢
os
(
M
eo
-

SS
low
⁢
⁢
0

)
/
(
M
e
-
M
eo
)
,
S
∉
R
low
⁢
_
⁢
os
.

### Claim 9 (depends on 8)

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.

### Claim 10 (depends on 9)

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,
where is state feedback coefficient of measurement mode Mlow_1 related to characteristic quantity S, and KlowCM1=[Klow_c1 Klow_c1]T;
when the state is in mode Mlow_2, then the state is in critical instability state and in the controllable range; the controller can re-adjust system to a steady-state using controller additional output; the output steering angle is as follows:
Sf=−KlowCM1{S+KlowC·Klow(S)·[sgn(S)]};
KlowC is an additional output additional output term gain coefficient in the measurement mode Mlow_2;
where
sgn
⁡
(
S
)
=
{
1
,
S
>
0
0
,
S
=
0
-
1
,
S
<
0
;
KlowC·Klow(S)·[sgn(S)] is the additional output additional output term;
when the state 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:
Sf=0;
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
,
𝒮
⁡
(
y
L
,
φ
h
)
∈
M
low
⁢
_
⁢
1
-
K
lowCM
⁢
⁢
1
⁢
{
S
+
K
lowC
·
K
low
⁡
(
S
)
·
[
sgn
⁡
(
𝒮
)
]
}
,
𝒮
⁡
(
y
L
,
φ
h
)
∈
M
low
⁢
_
⁢
2
0
,
S
⁡
(
y
L
,
φ
h
)
∈
M
low
⁢
_
⁢
3
