Professional Documents
Culture Documents
net/publication/227275700
CITATIONS READS
4 138
3 authors, including:
Some of the authors of this publication are also working on these related projects:
All content following this page was uploaded by Thanh-Son Dao on 16 July 2014.
+ f _
and turning of vehicular motions. L +
Most previous studies dealt with simplified ma~
thcmatical models of two-wheeled vehicles which i
, i",, l)
then were used to implement simulations, analy-
sis and experiments, However, due to their sim- Ill '.,~ !+, ~
plicity, the mathematical models were unable to
present all of the dynamic motions of the sys- (a)
tem in some situations. With that in mind, we
approach by modeling a two-wheeled vehicle as
a nine DOF system in three-dimensional space by
using Lagrange's equations for quasi-coordinates.
Also, the constraints equations are derived from
t " A-," \
wheel ground contact conditions.
This paper is organized as follows : In Section
2, the nine DOF model describing the motion of
two-wheeled vehicles is obtained by Lagrange's o'
(#, r 0) are the three Euler angles, which des- The relative rotation f r o m / ' o to _F'cis determined
crabe the relanve posmon and orientation be- by the 3-2 1 Euler angles 6~=[.g, r ~?~z
tween the coordinates .Pc and ff'o ~ ts the steering The angular velocmes of the vehicle body and
angle, r and e r are the rotating angles of the the rear wheel are written m sue as
front and rear wheels, respectively The velocity o t ~ [ O J x O)y (oz~ T
vector as (2)
ro~=~oS,+ro$:A=[o)x o), r (o~] ~
where r [0 q~r 01 r is the angular velocity
whose components are quasi-veiocmes (genera- of the rear wheel relative to the vehicle body
hzed speeds) The vehicle body's angular velocities o&, ~oy and
fox are referred to as yaw, Dtch and roll Iates,
2.2 Dynamics of the nine DOF model respectively The angular velocities are related
For slmphctty, the posmon, velocity and angu- to the nine rates of the three Euler angles by the
lar velocity vectors of body M in frame ~ , will formula
be denoted by r } , v~t and m~ respectively One
roA=Sa)
can write the position vectm of point c m ./lo as
r~ Y z ] r Let the posnton vectors of the [ -sine 0!1
centers of mass of the vehicle body, rear wheel where S = ~ c o s r sin O cos 8
and point e relative to point c as Pa, P~ and Pc, [ c o s O cos r - s i n 0
respectwely That ~s, p ~ - - [ x a 0 z ~ r, pCb _ [x~ 0 The angular velocities of the fork and the front
b~] r and p g = [ x e 0 Ze] r In Fe In a s~mllar wheel can be expressed m Fe as
fashion, the position vectors p / and Pa of the t o eF __ 1D e..k. e
lt~eeOJA ! OJFIA
centers of mass of the fork and the front wheel (3)
e__ etoe r , 0jc-- e e
~ D - - O)F DJF ~r A "1- O)FJA OJDIF
relative to point e are expressed in /'e as p.$=
Ix: 0 z / l r and p w [xa 0 za] r where oJ.f-~a= [0 0 ~]T Is the angular velocity of
One can write the position vectors of the centers the fork retanve to the vehicle body and oje:F -~
of mass of each part an Fo as [0 --q S: 0] r 1S the angular velocity of the front
0
ra=re
OO[~'nT
l , Pa
0 wheel relative to the fork
Denote the velocity vector of point c by vc,
r ~o = r eo+ R T c
pe
O O T C T e
(1) one has vg = [ v x vy ve~r The velocities of all
re=re+R (p~ +Ree0a) parts of the vehicle are expressed as
r:--re +R (pe+R~eO:) O.
Va--Vc+
e ~ c
O)A )(, P a
=I
Tr = ~ r1r z : / v: ;e-' )r c V / + T (1 . ~OF)
e~ rIero~
cos 8 c o s e s m a cosOslnr
/
Table 1 Samulauon parametels of a two-wheeled The generalized velocities q are related to the
vehicle quast-vefoemes u by
(a)
u=gq or q=Wu (6)
Name Value Name Value
rna 11 05 (kg) m~ 2 09 (kg) where Y and W are the 9 • transform matrices
ma 3 92(kg) m: 4 04 (kg) defined by
Oa (0 1296, 0, 0 285) pb (--0365, 0, 0503)
pa (0, 0, 0 601) Pe (--7 789, O, 0078) Y: S , w:g LI: 8 -1
p: (0 017, 0, 0 1083) r 0 325(m) _ 0 0
g 9 80665 (m/s x) 15~
and ~1=[32 Y Z ~' r 0 3 e r e y ] r
(b) Lagrange's equatmns for quasl-coordmates can
Moment of Inertia (kg.m 2) be formulated as
Vehicle L=/
o,o7 1 934
o _OoO,] d [87"~+07' A 3Tw+0Vw=ur (7)
dt \ 8u ] 3u Oq Oq
Bkody [ 1 558 ]
87"=urj d lOT\ r- , r
Front Fork [ 0
I : = 0 421 0 384 1 where o~u , ~-~-~-]=u Jtu
U n c - W r Q n c are non-conservative forces The
d, and
where TA, TB, Te and T~ are the kinetic energy Ju:-Ju-ArJu+Wr ( ~-)T--wT / o3V ~ r
of the vehicle body, the rear wheel, the fork and \Oq/ +U
the front wheel, respectively ; In, IB, IF and ID
arc the inertia matrices of each corresponding or simply,
body Their values m our slmulanon are shown Ju =Q (8)
in Table 1 The total kmettc energy is obtained
by summing all kinetic energy of all parts By 3. Constraint Conditions for Wheels
subsntutmg the velocmes m Eqs (2), (3), (3)
into (5) gives In the two-wheeled vehicle model, the contact
relanonshlps between the two wheels and the
T = T ~ + 7"B+ T ~ + T o = 2 u r J u ground are assumed to have the properttes of
rolling without shppmg The constraint equations
where J is the inertia matrix of the system, for the reai and the front wheels are correspon-
The potential energy has the form dingly developed as follows
V=mgh
3.1 Rear wheel
or~ Ftg 2 shows the schematic of the rear wheel
Let R r be the posmon vector of contact point o'
V = - g r (m~r o + mbrg + m f r } + mar~)
relanve to the center of mass b of the rear wheel
where g~= [0 0 g ] T The position of the contact point o' is
0 Vo,=Vb + Voqb
(t4)
- [Vo.x vo.y v o ' ~ ] r
A
Assume that the wheel rolls without slipping, that
Is v g , = 0 In Fo, vo, can be written as
, J
where
K vo,~=vo,,(cos r cos r
Fig. 2 Schematm of rear wheel +v~.,(cos .~ s m r sm O-sin r cos O) (16)
+vo,~(cos r r cos 0 + s i n # s m 0)
ro,=rb+R~ (9)
Vo,v= vo,x(sln ~k cos r
Express Eq (9) m I"o and note that the contact + v o , , ( s m ,P s m r sin 0 + c o s r cos 0) (L7)
point o' ts on the ground The K component of + Vo,z(sln !k sin r C0S 0+COS r sin 0)
ro~ is zero Th~s leads to a holonom~c constraant
vo,z,= -- V~,x s i n r + Vo,y COS r s m 0
Z-sin r (xb-r sin e~) (10) (18)
+Vo,~ cos r cos 0
+cos r cos O(zb+r cos a~) =0
It appears that the constraint vo,e,~O is proved
where a~ ts the included angle between Rr and
to be an mtegrable equation, whmh can be obtain-
ke, r IS the radius of the two wheels
ed by dffferelstlatmg Eqs (1O) and (13) There-
Furthermore, denote the intersecting vector be-
fore, Eq (18) is tllvtal since ~t is only a veloci-
tween the ground and the rear wheel planes by
ty form of the holonom~c constraint Thus, fiom
p ~ [x y 0] r, since it is on the I - J plane By the
Eqs (16) and (17) we only have two nonholono-
observatmn that p r~ IS perpendicular to ]e, thel
mlc constraints
r dot product is zero That is
vo.dcos f cos r +v~.,(cos r san esm 0-sin r cos 0)
(Rpro) rj~=x(cos # sin r sm 0 - s i n r cos 0)
+ vo,,(cos #sm r cos O+sin ~/sm 0) =0
+ y (sin r s m r sm 0 +cos ~ cos 0) ( 1 I)
=0 Vo'x(8In ~ COSr + Vo'y(sin ~.~sm
' r sin O- cos ,~cos t?)
where j~-~ [0 1 0] r + v~..(sm#sm r cos 0 +cos #sm 0) =0
Equation (11) gives
3.2 Front wheel
The constraint condmons of the front wheel
can be obtained by the same procedures as those
used with the real wheel Vector Ry is used to
Similarly, p~ and R~ are perpendmulal By equa- designate the posmon of the center of mass d of
tmg p r ' R , - (with D~ given in Eq (12)) to zero the wheel relative to the contact point s The
yields another holonomlc constraint including the position of the contact pomt s is
extra parameter fir r~=r~+R~ (19)
cos r cos O s l n a , - - - s m r (13) Wilting Eq (19) m f'o and equating the 1~
To find the nonholonomm constraint equatmns, component of r~ to zero gives a holonomm con-
we write the velomty of contact point o' as straint
represents the eight Lagrange multipliers or con- variables X , ]7 r gh~and qh~ ; and at equilibrium
straint forces coupled to the system by the 8 • 11 state: ~ d r = d ' / = 0 . Therefore, there are still
constraint Jacobian matrix B, and z" is the gener- fourteen among totally twenty two state variables
alized nonconservative /brce vector. lo be determined. The four holonomic constraints
in Eqs, (10), (13), (20) and (22) can be derived
4. Equilibrium of Two-Wheeled to yield their time rates, which are also constraint
Vehicles equations, l-lence, there are totally twelve con-
straint equations.
Equilibrium is an essential and very useful The Newton's second law can be used to cal
concept in dynamics. For a multibody dynamic culate the equilibrium points of the system by
system, equilibrium is defined as the state when setting the acceleration term in Eq. (30) to zero.
the total torce acting on the system is zero (Baruh, The constrain~ condition thus is defined as
1999). For a two-wheeled vehicle system, equi- TQ~.+Tr-0 {31)
librium is necessary to understand its interesting
The searching steps for equilibrium points then
dynamic behaviors and to control file vehicle to
can be summarized as follows
follow a given circular path or a straight line.
This section discusses an important question (1) Given ,0, change the value of Vx in a cer~
coming to mind when deMing with the equilibri- lain range, e.g., I ) O < U x ' Q U 1 9 F o r e a c h pair of
um oftwo~wheeJ.ed vehicles on : How to calculate (0, vx), solve for all file state variables and
the equilibrium points of two wheeled vehicles' calculate the two matrices B and Qe+
dynamics. (2) Compule the orthogonal complement ma-
trix T from B : there are a number of methods to
4.1 Equilibrium points searching strategy calculate T, the Pseudo Upper Triangular De:
To calculate the equilibrium poinls of a two composhion Method (Amirouche, 1992) is one of
wheeled vehicle system one can utilize 111e cot> lhem.
stralnt equations to compute the stale variables (3) Verify whether E q (31) is safis[ied.
when the system is at equilibrium. Equalion (28) Simulation results show that, even at equili-
suggests that brium state, d~ere still exists a small amount of
JeU=Q~+ r BTa (29) steering torque z~ to maintain the vehicle's stabi-
lization. It is ,'easonab[e because this torque is
Practice shows that only the steering torque is necessary to counteract the sell" aligning torque,
needed to control the vehicle to an equilibrium which tends to align the wheel plane with the
point+ Therefore, in the force vector r, only the direction of mo~ion when the angles a'r and as
scventh element, the steering torque ra. is nonzero a r e n o i1ZelO,
is necessary. That is *'~ [0, --, 0, ra, 0, "--, 0] r.
Two-wheeled vehicle dynamics and the com- \ 6
putation of constraint equations are implemented
in numerical simulations. It: order to eliminate . / ~ 1 1 ~i '
the kagrange multipliers in the constraint equa-
tions, Eq. (29) is muhiplied by the orthogonal
complement of matrix B, matrix T, so that T B T=
0. t"quatlon (29) thu~ becomes
TJflS-TQ~,+Tr (30)
o~_~g) lO 15 20 25
~tates \
X (km/h) NAC NAC NAC NAC
Y (kin/h) NAC NAC NAC NAC
Z (kin/h) 0 0 0 0
W (kin/h) tO 283 9552 837r~ 661t
v, (kin/h) 0 750 [ 168 I 568 2 065
Vz (kin/h) --0 167 0 373 --0 657 --1 065
~' (rad/s) 0581 0 906 1 291 1 798
~b (rad/s) 0 0 0 0
0 (tad/s) 0 0 0 0
(tad/s) 0 0 0 0
if, (rad/s)' 9 051 --8 772 8 289 --7 608 Y lca~
ffj (rad/s) 9 390 --9 574 10148 --11085 Fig. 4 TraJectory of two wheeled vehtcle at equl-
0t~ (tad/s) 0 0 0 0 hbrmm
aV (rad/s) 0 0 0 0
X (m) NAC NAC NAC NAC
_ L
Y (m) NAC NAC NAC NAC
0 ~ ,~ ~ B . .
Z (m) - 0 813 --0 796 --0 774 --0 747
~k (deg) NAC NAC NAC NAC
~b (deg) --0 I75 --0329 --0424 --0562
o (aeg) to 15 20 25
(deg) 14 739 22 542 31 157 41 731
~6,, (deg) NAC NAC NAC NAC
4 , (deg) NAC NAC NAC NAC
m (deg) --0 178 --034t --0452 0366
a's (deg) I 1 787 7 615 1 450 7 355
r~ (N m) ~00931 00745 --00201 --00010
Re (m) 49418 2 9514 1 8459 I 0745 0'
NAC stands for "Not a constant" ]Fig. 5 Kadn of curvatures
LsslT- r s i n c0 (35)
cos o~ cos ~p
" ....... :t"ana-~ . . . . . . . . . . . . -{an ~; . . . . . . . . (36) Fig. Relationship betw'een t.'x and ~ with constant
0
the radius of curvature of point x on the front
wheel
!
[,
C-'I%
t I~
=,: .
R, /
/
2 "...
/
0
Fi~. 6 Determine 1}', ~,nd R:. Fig, 8 Relationship between Vx, 8 and /q~.
ternatlonal Conference on Intelligent Robots and the Motion of a Riderless Bicycle by Using a
System, Vol 3, pp 2200--2205 Samphfied Dynamic Model," Mathematical and
Suryanarayanan, S., Tomlzuka, M and Weav- Computer Modethng, Vol 25, pp 6 7 - 7 4
er, M, 2002, "System Dynamics and Control of Yavm, Y, 1998, "Navigation and Control of
B~cycles at Htgh Speeds," American Control Con- the Motion of a Riderless Btcycle," Compute
ferenee, Vol 2, pp 845--850 Methods Appt Meeh Engrg, 160, pp 193--202
Yao, Y S and Chellappa, R, 1994, "Esuma- Yavln, Y, 1999, "Stabilization and Control of
taon of Unstablhzed Components in Vehicular the Mouon of an Autonomous Bacycle by Using
Motaon," Proceedings of the 12 th IAPR Interna- a Rotor for the Tilting Moment," Computer
ttonal Conference on Computer Vtslon & Image Methods in Apphed Mechamcs and Engineering,
Processing, Vol 1, pp 641-644 Vol 178, pp 233--243
Yavln, Y, 1997, "Navtgatlon and Control of