M Khairi Aripin
I.
INTRODUCTION
127
2012 IEEE 8th International Colloquium on Signal Processing and its Applications
controlled
4WAS
and
(5)
br
Vx
(6)
f =f
r = r
By substitutes and rearrange equations (3), (4), (5) & (6) into
(1) & (2), state space model can be obtained as follows;
x = Ax + Bu
(7)
(8)
where
a11 =
a 21 =
C f + Cr
mV x
aC f bC r
r
b11 =
Figure 1. Single track model 2 d.o.f
b21 =
, a12 = 1
Cf
mV x
aC f
Iz
Iz
, b12 =
, a 22 =
aC f bC r
mV x 2
a 2C f + b 2Cr
I zV x
Cr
mV x
, b12 =
bC r
Iz
(9)
(10)
(11)
(12)
where
Lateral motion;
(1)
f = d + c
Yaw rate;
I z r = aFyf bFyr
(13)
(2)
III.
(3)
F yr = C r r
(4)
128
2012 IEEE 8th International Colloquium on Signal Processing and its Applications
0
1
/ r r k rd / r
r
d
where
Ae + ( A Ad ) x d +
1
(CB ) C [ Ae ( A Ad ) x d + B d u d ]
T
V = C B
(CB ) 1 Q sgn( )
B u
d d
k d = 0, k rd
m b
a
Vx
=
and
K
=
2 L C f C r
L(1 + KV x 2 )
V = T = T C [Ae + ( A Ad ) x d + Bu B d u d ]
Replacing equation (21) into (23)
(16)
r rd
T Q sgn( )
where = T sgn( )
IV.
(19)
(20)
(21)
(24)
= C [Ax Ax d + Ax d Ad x d + Bu B d u d ]
(23)
(22)
129
2012 IEEE 8th International Colloquium on Signal Processing and its Applications
0.5
desired
4WAS
AFS
0
0.4
0.2
0
-0.2
-0.4
-0.6
-0.8
-0.5
-1
-1.5
1.2
1.4
-2
-2.5
-3
-3.5
-4
3
t(sec)
0.45
desired
4WAS
AFS
0.4
0.35
yaw rate(rad/s)
0.3
0.35
0.25
0.3
0.2
0.25
0.15
1.2
1.4
1.6
0.1
0.05
0
-0.05
3
t(sec)
130
2012 IEEE 8th International Colloquium on Signal Processing and its Applications
5
desired
4WAS
AFS
3
2
1
0
-1
-2
-3
-4
-5
3
t(sec)
0.6
desired
4WAS
AFS
0.4
yaw rate(rad/s)
0.2
-0.2
-0.4
-0.6
-0.8
3
t(sec)
131
2012 IEEE 8th International Colloquium on Signal Processing and its Applications
V.
[2]
CONCLUSION
[3]
[4]
[5]
ACKNOWLEDGMENT
[6]
[7]
REFERENCE
[1]
132