Escolar Documentos
Profissional Documentos
Cultura Documentos
NOMENCLATURE
BM 1,M 2
Brack
Bsc
Bx
Caf , Car
C
CG
FD
Ffr,rack
Fxf , Fxr
Fyf , Fyr
Fxwf , Fxwr
Fywf , Fywr
g
Manuscript received January 16, 2004; revised September 29, 2004 and
February 8, 2005. This work was supported in part by two DOC Grants, an
ARO Automotive Center Grant, a DOE Contract, a Honda Corporation Grant,
and a DARPA Contract. The review of this paper was coordinated by Dr. M. S.
Ahmed.
P. Setlur is with the Electrical and Electronic Engineering Department,
California State University, Sacramento, CA 95819 USA.
J. R. Wagner is with the Department of Mechanical Engineering, Clemson
University, Clemson, SC 29634-0915 USA (e-mail: jwagner@clemson.edu).
D. M. Dawson and D. Braganza are with the Department of Electrical and
Computer Engineering, Clemson University, Clemson, SC 29634 USA.
Digital Object Identifier 10.1109/TVT.2005.861189
h
ia1,a2
IM 1,M 2
IRoll
Isw
Izz
kb1,b2
KS 1
KS 2
k 1, 2
Kx
L1,2
lf
lr
m
mrack
ms
N
r
R
R1,2
rL
rp
Tdriver
Tfr,c
TM 1,M 2
u, ui
v, vi
VS 1,S 2
x, y
xr , yr
x1 , y1
xr 1 , yr 1
yrack
F
M 1,M 2
sw
SETLUR et al.: TRAJECTORY TRACKING STEER-BY-WIRE CONTROL SYSTEM FOR GROUND VEHICLES
Subscripts:
i
f, r
HE MECHANICAL and hydraulic subsystems in passenger and light-duty ground vehicles are being upgraded
with drive-by-wire components in order to boost overall performance, reduce power consumption, and enhance passenger
safety. For example, the electrical equivalents for traditional mechanical linkages and/or hydraulic power assist systems include
brake-by-wire, steer-by-wire, and throttle-by-wire [11],
[23], which offer less environmental concerns due to the removal of hydraulic fluids and continual engine parasitic losses.
A wealth of research has been conducted on hydraulic power
steering systems (e.g., [20], [21], and [26]), electric power steering systems, which maintain a mechanical linkage between the
driver and steering mechanism but replace the hydraulics with
an electric motor (e.g., [12], [13], and [17]), and most recently
steer-by-wire (e.g., [8] and [16]). In a steer-by-wire system,
dual servo-motors are introduced to control the driver interface
and the steering mechanism; the direct connection between the
driver and wheel assembly is removed. A variety of control architectures have been proposed for enhanced vehicle steering
characteristics and automatic tracking in steer-by-wire vehicles.
Furthermore, the development of reliable positioning systems
has made accurate trajectory generation very practical.
Vehicle steering systems translate the drivers steering commands into the rotation of the front wheels about their kingpin axes. The effort required to steer the vehicle must be balanced between power assistance to facilitate vehicle turning
and road feel for driver feedback. Servo-motor-based steering
systems offer improved lateral vehicle responsiveness, weight
reduction, and occupant safety (e.g., [18]). To effectively analyze a steering system, mathematical models that consider the
steering and various chassis subsystems must exist. In [16],
the authors presented a detailed steer-by-wire system model
with accompanying platform dynamics to describe the vehicles
motion.
A vehicle following a prescribed path (or trajectory) is a challenging problem due to the fact that the system is under-actuated.
In [2], the authors developed linear and nonlinear controllers for
the steering system. However, the controller required the forward velocity to be constant and non-zero. In [14], the authors
attempted to predict the vehicles path for prescribed driving
conditions in the presence of disturbances. However, they did
not address the issue of vehicle control. In [19], the vehicles cornering instability was studied and a robust controller to protect
the vehicle from spin was proposed. Their work did not discuss
the trajectory-following problem. On similar lines, in [1] the authors proposed a controller to stabilize disturbance yaw forces
in the vehicle. As in previous works, it was assumed that the
vehicles longitudinal velocity is constant so that the trajectory
following has to be performed as a separate control task.
77
(1)
(2)
78
The directional control assembly uses a high torque servomotor to displace the rack. The rack dynamics reflect the direct
application of the motor torque, so that
yrack = (1/mrack )[2KL (yrack rL F ) Brack y rack
(Ks2 /rp )((yrack /rp ) M 2 ) Ffr,rack ].
(4)
(6)
(7)
The vehicles lateral acceleration is influenced by the longitudinal velocity, the yaw, and the roll in the following manner:
(8)
(9)
1
m
m2s h2 /IRoll
Fig. 1.
(13)
Fyr = Car r .
(14)
(15)
y(t)
(t)]
derivative of q(t) = [x(t)y(t)(t)]T 3 . The variables,
x(t), y(t), and (t) 1 denote the Cartesian position and orientation, respectively, of the vehicles COM. The transformation
matrix S(q) 33 is defined as
cos() sin() 0
S(q) = sin() cos() 0
(16)
0
0
1
the velocity vector V (t) 3 is V = [u v r]T , where
u(t), v(t), and r(t) 1 denote the vehicles longitudinal, lateral, and yaw velocities, respectively. Under the assumptions
SETLUR et al.: TRAJECTORY TRACKING STEER-BY-WIRE CONTROL SYSTEM FOR GROUND VEHICLES
and y(t)
given in (15) may be used with (16) and (24) to obtain
x
= ut cos() sin()um
(25)
y = ut sin() + cos()um
(26)
= r
(27)
(28)
79
(17)
(29)
(31)
(32)
(18)
The front and rear tire forces, Fxwf (t), Fywf (t), Fxwr (t), and
Fywr (t) 1 may be explicitly written as
Fxr = Fxwr = N tanh[(u Rr )/Rr ]
(19)
(20)
(21)
(22)
1
m
FD (u) Fxr + ut
2
2
Fyf =
m
um Fyr
2lf
(23)
(24)
= 1/lf .
(30)
where x1 (t), y1 (t) 1 represents the shifted Cartesian position. After taking the second time derivatives of (31) and (32),
substituting (25)(28), and canceling common terms, the shifted
Cartesian dynamics become
x
1 = (ut + (Izz /m) 2 ) cos() g() sin()
(33)
(34)
A reference model based on the structure of the system dynamics given by (25) and (26) will be designed to facilitate the
tracking controller with
x
r = urt cos(r ) sin(r )urm
(35)
(36)
r = rr
(37)
rr = (m/Izz )urm
(38)
where xr (t), yr (t), r (t) 1 denote the reference Cartesian position and orientation, respectively. The signal rr (t)
1 is an auxiliary reference state variable used to facilitate the analysis, urt (t), urm (t) 1 denote the reference input signals. It is assumed that the reference signals urt (t)
and urm (t) are selected such that urt (t), urm (t), u rt (t), and
u rm (t) are bounded and xr (t), yr (t), r (t) and their first
two time derivatives remain bounded at all times (i.e.,
r (t), yr (t) and r (t)
xr (t), yr (t), r (t), x r (t), y r (t), r (t), x
L ). A transformation similar to the one given in (31) and (32)
is applied to the reference system, (35)(38), as follows:
xr 1 = xr (Izz /m) cos(r )
(39)
(40)
80
written as,
x
r 1 = urt + (Izz /m) 2r cos(r )
yr 1 = urt + (Izz /m) 2r sin(r ).
(41)
(42)
1 is defined
In addition, the orientation tracking error (t)
as
= r .
(47)
(48)
(43)
sy = y 1 + r y1
(44)
x
1 = x1 xr 1
(45)
y1 = y1 yr 1 .
(46)
(49)
z = uc
(50)
(51)
u
1 ut
(52)
uc = T
t = T (uc + ).
r
r
The matrix T () 22 and the auxiliary measurable signal
() 2 are defined as
sx sin() + sy cos() 1
T =
(53)
1
0
rr
r 1 cos() + yr 1 sin() (54)
= (Izz /m)r2 + x
1 cos() + y 1 sin())
r (x
with f () 1 denoting an auxiliary signal defined as
f = 2[
xr 1 sin() yr 1 cos() + rr z2 ]
2r (x
1 sin() y 1 cos()).
The skew symmetric matrix J 22 is defined as
0 1
J=
.
1 0
(55)
(56)
y = y yr .
(57)
SETLUR et al.: TRAJECTORY TRACKING STEER-BY-WIRE CONTROL SYSTEM FOR GROUND VEHICLES
Equation (57) along with (31), (32), (39), (40), (45), and (46)
can now be used to show that actual Cartesian tracking error can
be written in terms of the shifted Cartesian tracking error as
x
=x
1 + [sin() sin(r )]
y = y1 [cos() cos(r )].
(59)
(60)
(61)
B. Control Development
The control objective is to design a controller that exponentially forces the Cartesian/orientation tracking error to
a neighborhood of about zero that can be made arbitrarily small (i.e., GUUB). It will be assumed that the signals
x(t), y(t), (t), x(t),
y(t),
and r(t) are available for measurement. To achieve this objective, we define an auxiliary error
signal z(t) 2 as the difference between the subsequently designed auxiliary signal zd (t) 2 and the transformed variable
z(t) defined in (54) as
(63)
(64)
w = [ud1
u2 ]T = ua k2 z
(65)
where k2 1 is a positive, constant control gain, and the auxiliary control signal ua (t) 2 is
ua = (k1 w + f )/d2 Jzd + 1 zd .
(66)
The dynamics of the auxiliary control signal denoted by zd (t)
2 are defined by the following oscillator-like relationship [3]:
zd = (d /d )zd + (k1 w + f )/d2 + w1 Jzd
(67)
zdT (0)zd (0) = d2 (0).
(68)
u2 ]J T z z2 + f + 2g().
(71)
(72)
where the fact that J T = J has been applied. Finally, by substituting (66) for only the first occurrence of ua (t) in (72), exploiting the skew symmetry of J defined in (56), and observing
that J T J = I2 (Note that I2 denotes the standard 2 2 identity
matrix), the final expression for the closed-loop error system for
w(t) becomes
w = k1p w 4kn 1 w + uTa J z z2 + 2g()
(73)
so that
z = (d /d )zd + (k1 w + f )/d2 + w1 Jzd
1
[ud1 u2 ]T + [ 0]T
(74)
where the auxiliary control input ud1 (t) was injected by adding
and subtracting [ud1 0]T to the right-side of (74) and then (64)
was applied. The final expression for the closed-loop error system for z(t) is obtained by following a similar procedure to [3]
as
(70)
(62)
z = zd z.
d = 0 exp(1 t) + 1
(69)
| sin() sin(r )| ||
|
y | |
y1 | + ||.
(58)
|
x| |
x1 | + ||
81
z = k2 z + wJua + [
0]T .
(75)
(77)
82
D. Stability Analysis
Theorem 1: Given the closed-loop system of (73), (75), and
(77), the position/orientation tracking error signals defined in
(47) and (57) are GUUB in the sense that
|
x(t)|, |
y (t)|, |(t)|
4 exp(4 t) + 4
(78)
where 4 , 4 , and 4 are positive constants that are explicitly defined in the subsequent stability proof.
Proof: To prove Theorem 1, a non-negative, scalar function, denoted by V (t) 1 , is defined as
1
1 2 Izz 2 1 T
w +
+ z z.
(79)
2
2m
2
After taking the time derivative of (79) and making the appropriate substitutions from (73), (75), and (77), the following
expression may be obtained:
V = w k1p w + uTa J z z2
+ zT k2 z + wJua + [ 0]T
+ [k3 + wz2 z1 ] + 4kn 1 w2 + 2g()w . (80)
V =
(83)
zT ]T .
(85)
0 = (0),
4 = min{k1p , k2 , k3 }.
that sx (t), sy (t), (t) L and the fact that the reference trajectory is selected so that xr 1 (t), yr 1 (t), r (t), x r 1 (t),
r 1 (t), yr 1 (t) L , (43)(47) can be utilized
y r 1 (t), r (t), x
to conclude that x
1 (t), y1 (t), x 1 (t), y 1 (t), x1 (t), y1 (t), (t)
L , as mentioned in Remark 6. Using the fact
y(t)
L , and from the fact
that sx (t), sy (t), (t), x(t),
that g() L , it is concluded that f (), T () L
from (55) and (53). Based on these facts, (54), (64),
(65), (66), (69), and (70) can now be utilized, to show
that ud1 (t), ua (t), zd (t), 1 (t), u1 (t), u2 (t), () L . From
(52), it can now be concluded that ut (t), r(t) L . Based on
the previous facts, it is easy to show that u d1 (t) L (see the
Appendix for the explicit expression for u d1 (t)). After utilizing
(76), it can now be shown that the control input, um (t) L .
Standard signal-chasing arguments can now be employed to
conclude that all of the remaining signals in the control and the
system remain bounded during closed-loop operation. To prove
(78), it is first shown that z(t) defined in (54) is GUUB by
applying the triangle inequality to (63), and hence, obtain the
following bound for z(t):
z
z + zd 1 exp(1 t) + 2
(88)
where (70), (84), and (85) have been utilized, and the positive
constants 1 , 1 , 2 1 are some constants of analysis. Equations (43), (44), (84), (85), (87), (88), and Remark 6 may now
be employed to obtain the following tracking-error bounds:
y1 (t)|, |(t)|
3 exp(3 t) + 3
|
x1 (t)|, |
(89)
(86)
From (84) and (85), it is clear to see that w(t), (t), z(t)
L . After utilizing (63) and the fact that z(t), d (t) L , it is
concluded that z(t), zd (t) L . From the fact that z(t), w(t)
L , the inverse transformation of (54) can be used, which is
explicitly given as
1
1
sx
w
2 sin 0
2 sin + 2 cos
1
z1
sy = 1 cos
0
cos
2
sin
2
2
z2
0
1
0
(87)
V. NUMERICAL RESULTS
The controller design presented in Section IV was implemented on a passenger/light-duty vehicle model [16], per the
governing dynamics discussed in Section II. In this case, the
reference signals that generated the required maneuver were
determined by trial and error. The path-planning problem is
not addressed in this work. In practical applications, the desired
trajectories may be obtained from a lead vehicle or operator. To
demonstrate the general tracking performance, a representative
J-turn was chosen as the desired maneuver and the reference
SETLUR et al.: TRAJECTORY TRACKING STEER-BY-WIRE CONTROL SYSTEM FOR GROUND VEHICLES
Fig. 2.
83
Fig. 4.
k2 = 2000,
1 = 0.1,
k3 = 5000,
1 = 0.1
r = 0.1.
All the reference vehicle states were initialized to zero for the
purpose of this simulation. The initial states of the vehicle were
also initialized to zero with the exception of
x(0) = 2 m,
Fig. 3.
1.1]T .
The required function g() in the control signal (76) is calculated from (20), (29), and (30). The vehicle parameters used for
the simulation were
m = 788 kg,
lf = 1 m,
Izz = 1126 kg m2 ,
lr = 2 m,
IRoll = 171 kg m2
C = 6510 N/rad.
The vehicle dynamics, with integrated steering tracking algorithms, were numerically simulated for t = 150 s. The position
and orientation tracking errors for the maneuver are shown in
Fig. 4. Clearly, the vehicle path closely follows the reference
trajectory. As shown in Fig. 4, the controller quickly compensated for the initial errors and during the transient phase,
the maximum errors were 4.5 m and 1.2 m along the x
and y directions, respectively. The orientation error initially increased to 0.03 radians ( 1.7 ) before reaching a steady
state value close to zero. The steady state position errors x
(t)
and y(t) were within 0.09 m and 0.002 m, respectively.
All errors were within 0.1% of the reference trajectory generated, thus validating the performance of the control algorithm.
The vehicles longitudinal, lateral, and yaw velocities are shown
in Fig. 5.
Remark 10: The controller designed in (76) requires exact
model knowledge (i.e., the exact vehicle parameters such as the
sprung mass of the vehicle, inertia of the vehicle about the yaw
axis, distance from the front axle to the COM and distance from
the rear axle to the COM must be known a priori). In the actual
operating environment, the calculation of these parameters may
be difficult which could result in vehicle model uncertainties.
In such scenarios, robust high gain, high frequency, or adaptive
84
and
f = 2 urt + Im 2r cos()
u rt + 2Imr r + urt + Im 2
sin()
r
x
r (
1 cos() + y 1 sin()) + rr z2
+ mIurm z2 + r g() .
REFERENCES
Fig. 5.
1 =
2+
2
d
d
d2
d3
[1] J. Ackermann and W. Sienel, Robust yaw and damping of cars with front
and rear wheel steering, IEEE Trans. Contr. Syst. Technol, vol. 1, no. 1,
pp. 1520, Mar. 1993.
[2] J. Ackermann, J. Guldner, W. Sienel, R. Steinhauser, and V. Utkin,
Linear and nonlinear controller design for robust automotive steering,
IEEE Trans. Contr. Syst. Technol., vol. 3, no. 1, pp. 132143, Mar.
1995.
[3] A. Behal, W. Dixon, D. Dawson, and Y. Fang, Tracking and regulation
control of an underactuated surface vessel with nonintegrable dynamics,
IEEE Trans. Automat. Contr., vol. 47, no. 3, pp. 495500, Mar. 2002.
[4] D. Dawson, J. Hu, and T. Burg, Nonlinear Control of Electric Machinery.
New York: Marcel Dekker, 1998.
[5] W. Dixon, D. Dawson, E. Zergeroglu, and F. Zhang, Robust tracking
and regulation control for mobile robots, Int. J. Robust Nonlinear Contr.:
Special Issue on Control of Underactuated Nonlinear Systems, vol. 10,
no. 4, pp. 199216, 2000.
[6] W. Dixon, D. Dawson, E. Zergeroglu, and A. Behal, Nonlinear Control
of Wheeled Mobile Robots, Lecture Notes in Control and Information
Sciences, Springer-Verlag, 2001.
[7] J. Dugoff, P. Fanches, and L. Segel, An analysis of tire traction properties
and their influence on vehicle dynamic performance, SAE, Paper No.
700377, 1970.
[8] W. Harter, W. Pfeiffer, P. Dominke, G. Ruck, and P. Blessing, Future
electrical steering systems: Realizations with safety requirements, SAE,
Paper No. 2000-01-0822, 2000.
[9] J. Hendrikx, T. Meijlink, and R. Kriens, Application of optimal control
theory to inverse simulation of car handling, Vehicle System Dynamics
Int. J. Vehicle Mechanics Mobility, vol. 26, no. 6, pp. 449461,
1996.
[10] G. J. Heydinger, W. R. Garrott, J. P. Chrstos, and D. A. Guenther, A
methodology for validating vehicle dynamics simulations, SAE, Paper
900128, 1990.
[11] M. Jordan, Drive-by-wire will end the era of the handbrake turn, Electron. Eng., vol. 71, no. 875, pp. 2830, 1999.
[12] T. Kohno, S. Takeuchi, M. Momiyama, H. Nimura, E. Ono, and S. Asai,
Development of electric power steering (PS) system with h infinity control, SAE, Paper No. 2000-01-0813, 2000.
[13] M. Kurishige, K. Fukusumi, N. Inoue, T. Kifuku, and S. Otagaki, A
new electric current control strategy for EPS motors, SAE, Paper No.
2001-01-0484, 2001.
[14] C. Lin, G. Ulsoy, and D. LeBlanc, Vehicle dynamics and external disturbance estimation for vehicle path prediction, IEEE Trans. Contr. Syst.
Technol., vol. 8, no. 3, pp. 508518, May 2000.
[15] P. Martin, S. Devasia, and B. Paden, A different look at output tracking:
Control of a VTOL aircraft, Automatica, vol. 32, no. 1, pp. 101107,
1996.
[16] V. Mills, J. Wagner, and D. Dawson, Nonlinear modeling and
analysis of steering systems for hybrid vehicles, in Proc. ASME
IMECE, Design Engineering Division, vol. 112, New York, Nov.
2001, pp. 173180.
[17] S. Millsap and E. Law, Handling enhancement due to an dutomotive
variable ratio electric power steering system using model reference robust
tracking control, SAE, Paper No. 960931, 1996.
[18] T. Nakayama and E. Suda, The present and future of electric power
steering, Int. J. Vehicle Design, vol. 15, no. 4, pp. 243254, 1994.
[19] E. Ono, S. Hosoe, H. Tuan, and S. Doi, Bifurcation in vehicle dynamics
and robust front wheel steering control, IEEE Trans. Contr. Syst. Technol.,
vol. 6, no. 3, pp. 412420, May 1998.
[20] J. Post and E. Law, Modeling, characterization and simulation of automobile power steering systems for the prediction of on-center handling,
SAE, Paper No. 960178, 1996.
SETLUR et al.: TRAJECTORY TRACKING STEER-BY-WIRE CONTROL SYSTEM FOR GROUND VEHICLES
[21] L. Segel, On the lateral stability and control of the automobile as influenced by the dynamics of the steering system, J. Eng. Ind., vol. 88, no. 3,
pp. 283295, 1966.
[22] P. Setlur, D. Dawson, Y. Fang, and B. Costic, Nonlinear tracking control
of the VTOL aircraft, in Proc. 39th IEEE Conf. Decision and Control,
vol. 5, Orlando, FL, 2001, pp. 45924597.
[23] N. Stanton and P. Marsden, Drive-by-wire systems: Some reflections
on the trend to automate the driver role, in Proc. Institut. Mechanical
Engineers, Part D: J. Automobile Eng., vol. 211, no. D4, 1997, pp. 267
276.
[24] M. Stoll, Introduction to Real Analysis. Reading, MA: Addison-Wesley,
1997.
[25] J. Wong, Theory of Ground Vehicles. New York: Wiley, 1978.
[26] T. Wong, Hydraulic power steering system design and optimization simulation, SAE, Paper No. 2001-01-0479, 2001.
Pradeep Setlur received the B.E. degree in instrumentation technology from the University of Mysore,
India, in 1995 and the M.S. and Ph.D. degrees
in electrical engineering from Clemson University,
Clemson, SC, in 1999 and 2003, respectively.
He worked as a Post-Doctoral Researcher at
the Biomimetic and Cognitive Robotics Laboratory,
Brooklyn College, The City University of New York,
in 2004. His research interests include modeling and
nonlinear control of robotic and automotive systems.
Dr. Setlur is currently an Assistant Professor in
the Electrical and Electronic Engineering Department, the California State University, Sacramento.
85