Академический Документы
Профессиональный Документы
Культура Документы
I. INTRODUCTION
In recent decades, research on dynamics of road transport
vehicles and autonomous vehicles was the subject of special
attention and interest of more and more laboratories,
researchers and industrial suppliers. Particularly, mobile
robots is the focus of much research because of their
increasingly use in dangerous and inaccessible environments,
for civilian or military applications. These problems are far
from being easy to solve. The difficulty lies in apprehending
the overall dynamic behavior of mobile robots particularly in
aggressive situations involving braking, abrupt steering,
skidding . Indeed, there is an urgent need for simulation
tools enabling the study of vehicles in normal and extreme
situations in order to develop appropriate control laws and
trajectory planning strategies.
The objective of the present work is to propose a general
dynamic model that allows the simulation of car-like robots
dynamics with trailers. Moreover, we illustrate the
exploitation of this model for the investigation of severe
scenarios involving skid or reversal events and jack-knife
problems (situations present in road accidents). The proposed
approach for the implementation of this model is based on
versatile methods capable of handling different possible
behaviors with minimal changes. The wheels/ground contact
is handled using a linear model ([1], [2], [3] and [4]) and the
O0 , x0 , y0 , z0 . Let
Gv , xv , yv , zv
be the
2015 IEEE
1
Gr , xr , yr , zr
For i
1...4
e xi
e zi
( 0 Pv
( 0 Pv
e yi
ni
0
vi )
vi )
0
e zi
e zi
e zi
e xi
(3)
0
Pv
c2 c3
s1 s2 c3 c1 s3
c1 s2 c3
s1 s3
c2 s3
s1 s2 s3
c1 s2 s3
s1 s3
s2
c1c3
s1c2
For i
(1)
c1c2
Pr
s4 s5 c6 c4 s6
s4 s5 s6 c4 c6
s5
c4 s5 c6
c4 s5 s6
s4 c5
defined by v i
s4 s6
s4 s6
V Gv
V Gr
wxv
wxv
wxv
1
0
0
0
c1
s1
s2
s1c2
c1c2
x2
r
r
P0 y2 and wr
z2
wxr
wxr
wxr
1
0
0
0
c4
s4
s5
s4 c5
c4 c5
Gi , exi , e yi , ezi
e yi
vi )
0
e zi
e zi
e zi
e xi
vi
cos
0 1 0
Pi
e xi | e yi | e zi
for i 1...8
(4)
1
2
x1 , y1 , z1 , 1 ,
, d1 , d 2 , d3 , d 4 , x2 , y2 , z 2 ,
, d5 , d6 , d 7 , d8 ,
, z , 1,
T
2
3
4
5
6
vi )
(2)
vi
c4 c5
x1
v
P0 y1 and wv
z1
sin
( 0 Pr
( Pr
c5 c6
c5 s6
e xi
ni
5...8
e zi
B. Constraint equations
The equations of constraints of a car-like robot with
trailer are defined by the conditions linked to Ackermann
steering system, the contact holding conditions of
wheels/ground for both tractor and trailer and the conditions
of the tractor/trailer connection. They are developed bellows.
1) Ackermann Conditions
During the movement of a tractor with a trailer along a curve,
the steering angles of the tractor are linked to the existing of
yaw speed wzv and the radius of curvature of this curve by the
following equations:
if wzv
tan
if wzv
0
0
0
tan
(5)
Lv
R Lw 2
Jr
Lv
R Lw 2
n5
n6
n7
n8
0
Bcv i
ni
n5
n6
n7
n8
Pr
Pr
Pv 2
Pr 2
Pr
Pr
v
GrC1
T0
n5 zr
0
0
T0
GrC2
GrC3
GrC4
wv
di
zv
wr
di
zr
n6 zr
wv
wv
n7
T0
zr
0
v
0
0
T0
n8 zr
Gv Ci
for i 1...4
Gr Ci
for i
O0Ci
O0Gv
Gv Ci
rw ni
z v di
(6)
0 for i 1...4
Bcr i
0
* Gv Ci
ni
O0Ci
O0Gr
Gr Ci
rw ni
(7)
0 for i 5...8
With rw: the radius of the wheels and ni : the normal of the
contact plane of the wheel i.
These conditions (6 and 7), derived twice with respect to time,
can be expressed as follows:
Jv
xv
Bcv
Jr
xr
Bcr
(8)
xv
x2 , y2 , z2 , wxr , w yr , wzr , d 5 , d 6 , d 7 , d8
xr
wr
wr
5...8
zr di
O0 P1
(9)
O0 P2
xv
J Lr
xr
BLv
(10)
BLr
I3
J Lr
I3
BLv
Pv
BLr
Pr
0
3
0
3
wv
wr
Pv
Pr
wv
wr
Gv P1
Gr P2
3 4
3 4
Gv P1
Gr P2
Jv
n1
n2
n3
n4
Pv
Pv
Pv
Pv
n1
n2
n3
n4
GvC1
T0
n1 zv
0
0
T0
GvC2
n2 zv
GvC3
GvC4
T0
n3 zv
0
0
0
T0
n4 zv
mv
mv
Fi
i 1
I Gv wv
wv
mr y2
z2
r
I Gr wr
With g :
wr
the
I Gv wv
mr
i 1
Gv Ci
i 5
I Gr wr
i 5
Fi
Gr Ci
Fi
Gv P1
0
v/r
(12)
v /r
Fi
Gr P1
0
v/r
gravitational
Fi
ki d i
L0 i
bi d i for i 1...4
(13)
Fi
ki d i
L0 i
bi d i for i
(14)
5...8
(15)
T
0 10 10
J Lv
0 10 10
Ar
J Lr
J Lv
J Lr
Av
A
10 10
3 10
Mv
Av
Jv
6 10
03
3 10
10 3
03
03
0
v/r
Br
B Lr
; Bv
B Lv
B mv
B cv
wv
i 1
8
mr g
r
wr
I Gr
Fi
Pv
0
Gv Ci
F extv
i
Pi
Fi
M extv
i 5
r
wr
Pi
8
i 5
Fi
Pr
Gr Ci
Pi
F extr
i
Fi
M extr
RESULTS
Parameters
Mass m
Moment of inertia Ixx
Moment of inertia Iyy
Moment of inertia Izz
Height of center of gravity
Front track
Rear track
front wheelbase
Rear wheelbase
Front suspension stiffness
Rear suspension stiffness
Front dumping
Rear dumping
Front camber angle
Rear camber angle
Coefficient of friction
Radius wheel
Hinge point position
4 10
; Mr
; Br
I Gv
Pi
Tractor
Trailer
950 Kg
1270 Kg
1072 Kg/m
1342 Kg/m
1342 Kg/m
0.50 m
1.41 m
1.41 m
1.04 m
1.50 m
9.97 KN/m
6.79 KN/m
897.28 N.s/m
611.01 N.s/m
0.00
0.00
0.70
0.25 m
1933Kg/m
2417Kg/m
2417Kg/m
0.40 m
1.48 m
1.48 m
0.50 m
0.50 m
16.529 KN/m
16.088 KN/m
1.652 KN.s/m
1.608 KN.s/m
0.00
0.00
0.70
0.25 m
6 10
Bv
B
3 3
Jr
03 3
I Gv
Mr
; Ar
xv
xr
10 3
4 10
mv I 3
Mv
10 10
frame; wr :Angular
acceleration of the trailer expressed in r frame;: v I Gv and
r
I Gr are tensors of inertia, respectively, of the tractor and the
trailer; mv and mr: are the masses of the tractor and the trailer;
: the tensile force applied by the tractor to the trailer.
v/r
wv
acceleration; wv :Angular
(11)
v /r
B mr
x2
B mv
i 1
z1
v
mv g
B mr
B cr
mr I 3
03
03
r
03
I Gr
03
the front axle of the tractor. When the brake is applied the
trailer was a drift but no rollover or jack-knife. By cons when
you do not apply a brake on the trailer, it was the case of a
jack-knife, and if we increase the braking torque distribution
and the difference it will probably reversed.
VI.
V.
Fig. 11. Brake Difference 20% of the front right wheel relative to the left front
wheel of the tractor and trailer braking
Fig. 12. Brake Difference 20% of the front right wheel relative to the left front
wheel of the tractor without trailer braking.
VII. CONCLUSION
In this work, we detailed the dynamic model of a car-like
robot with trailers. This model can be used to simulate various
severe scenarios involving skidding overturning and jackknifing. In the developed model, the wheel/ground interaction
is modeled using a linear model and the link between the
tractor and the trailer is handled as a spherical-joint. The
simulation results obtained by the developed application are
validated with those of the PC-Crash software. Comparison of
results for accelerated and turned motion, revealed a very
satisfactory correspondence, thus showing, consistency of the
approach and the correctness of the implementation.
The simulations we have conducted have focused on the
reproduction of normal operating conditions as well as loss of
control situations such as lane departure, jack-knifing and
overturning. As a perspective, control laws and mission
planning will be studied in order to avoid such dangerous
scenarios, involving skid and jack-knife phenomena.
References
[1]
[2]
[3]
[4]
[5]
[6]