Professional Documents
Culture Documents
Robot
Chao Ren1 and Shugen Ma2
I Department
2 Department
I. INTRODUCTION
In the past few years, omnidirectional mobile robots
(OMRs) have received growing attention in the field of
wheeled mobile robots because of their high maneuverability.
Compared with non-holonomic mobile robots, OMRs, which
are holonomic, are able to achieve translational and rational
motions independently and simultaneously. As a result, they
are extremely useful in tight environments, such as hospitals,
warehouses, residential homes, and sheltered workshops for
disabled people.
A variety of omnidirectional wheel mechanisms have been
proposed over the past few decades. Several mechanisms
based on the "universal wheel concept" have been designed,
which is an assembly providing a combination of constrained
and unconstrained motion when turning [1]. The initial
universal wheel design was used to accomplish omnidirec
tional motions without changing the direction of the wheels,
but this wheel type suffers from successive shocks when
the individual rollers make contact with ground. To realize
smoother contact with the ground, the "orthogonal-wheels"
concept and two major wheel assemblies, i.e., Longitudi
nal and Lateral orthogonal-wheel assemblies, were proposed
in [1]. Based on the same idea but with different number
and slicing of the spheres, MY wheel [2] and MY wheel
II [3] were proposed. The previous MY wheel may get stuck
by surface irregularities due to the specific wheel structure,
i.e., the gaps between each two adjacent crowns are rela
tively large. To overcome this problem, the MY wheel-II
(a)
Fig.
(b)
Fig.
1>2
\\\
....
2. Prototype platform
D,
.
. ...... ./
.
.
.
.
..
..
.
..
. . ...... ....
..
.
. ..
.. .
.. .
...
.
......
.. .
..
.... ...
.
.
.
..
..
.
Fig.
A.
(1)
Kinematic Modeling
(3)
where
-cos( -8)
sin(8- )
cos8
W
=
=
WI
y
W2
W3
is
cos( +8)
-cos( -8)
sin8
the
motor
angular
rate,
is the angular
gle in the world frame, cD = (P I (P2 (P 3
velocity of the wheel shaft, n is the gear reduction ratio, R is
Ll.
{ D'Doub ifIf
t n,
!!.
+ !:!:!!.
2 <
1C
nrr
8 + 2'
A..
'f/l
<
<
-
l!!.
me
8 + 2
IT
nn
::; 8 + 2'
n=0,I,2,...
(4)
and
D
t
ou are the inner and outer contact radius, re
and Din
spectively; i is the angular position of the wheel shaft.
B.
Dynamic Modeling
Mq +Cq=Bu
po + m
(5)
A.
Controller Design
The robot dynamic model (5) can be rewritten as:
o
Ll+Lr2L3.
)
Po (
2
po + m
V; po(LI - L2)
-me
PI
V; Pl (LI - L2)
where f( t) =
is regarded as the 'to
tal disturbances' of the three channels, including the input
output cross coupling effects and the changing dynamics of
the robot due to the switching.
And then (6) can be written as
q=fU) +MOlBou
Po
_
-
n2/0
R2' P 1
_
-
n2
R2
ktk,,
(b 0 + To) ' P2
r,
nkt
- RRa'
= UI U2 U3
and Ui is the applied motor voltage, m is the robot mass, Ra is
the armature resistance, kb is the motor back emf constant, k/
is the motor torque constant, Iv is the robot moment of inertia,
Iw is the wheel moment of inertia, 10 is the combined moment
of inertia of the motor, gear train and wheel referred to the
motor shaft, bo is the combined viscous friction coefficient of
the motor, gear and wheel shaft.
Since the contact radius L; switches between the inner and
outer wheel contact radius, i.e., between D;n and Dout (see
(4)), it can be seen from (5) that the robot is a switched non
linear system. In addition, as each wheel has two contact
modes, a three wheeled OMR based on MY wheels-II has
eight contact modes in total. Thereby, the robot has eight
smooth nonlinear subsystems in total [17]. However, not all
of the eight contact modes always appear in the robot motion.
It depends on the robot initial orientation, wheel initial posi
tion and robot trajectory, which can be derived from the robot
kinematic equation (2). Moreover, the switching signal of
the switched robot system is the contact radius L;, i= 1,2,3.
The contact radius depends on the the wheel angular posi
tion, while the latter depends on the robot trajectory (i.e., the
robot states). Therefore, the mobile robot is an autonomous
switching system [18].
In addition, it can be seen from (5) that the mobile robot
will be a smooth linear dynamical system if the robot moves
(7)
(8)
Define the estimation error of the 'total disturbances' as:
(9)
where fe(t) =
With the assumption that f(t) can be well estimated, i.e.,
fe(t) 0, then the nonlinear piecewise-smooth MIMO robot
dynamics can be reduced to three decoupled SISO double in
tegrators in an approximate manner:
(10)
For the decoupled double integral systems (10), simple PD
control is applied to the three channels:
[ :r
[ :
The gai
Kp =
, Kd =
(11)
e
2we
2we
w
where We is the controller bandwidth [20]. The selection of
Kp and Kd is to make the characteristic polynomial of each
channel Hurwitz, i.e., s2 + 2wc + w is Hurwitz.
q=[XYB]T
Fig.
Stability Analysis
We,
C.
ESO Design
Define Xl =
y e
X2 =
Y e
X3 = f(t).
X3 is the augmented state vector, the robot dynamic model
(7) can be written in the state space form:
Xl =X2
.
X2 =X3 +M-LB
0 OU
X3 = get)
(13)
[x
r,
[i
el = Zl -XI
ZI=z2-/30 1 el
zFz3-/302el +M01Bou
ZF -/303el
r,
D +D
Ll =L2 =L3 =.
(14)
POI =
P02 =
[
[
P03 =
Wo
3w
where
is the observer bandwidth [20] and is the only pa
rameter to be tuned in ESO. In addition, the high observer
bandwidth will improve the system response and estimation
performance of the ESO but subject to noise sensitivity. In
practice, therefore, a trade off also exists in the parameter
tuning of ESO.
We
wo)
We
Wo
Wo
5)we.
is set as
Om Om Orad ion voltage of the motor is
12 V. The robot initial position and orientation is set as
Om Om Orad
5-
1-
Rererence- Robol
- - Observed
:E;;--
:P S;-d 1'r><'.:-
;
<=
= ----""-; -------+.:""---Jl
:; t j : t
0.8
-X
10
15
10
20
15
25
20
30
25
t(8)
Fig.
.q;
1,:D f ==-= ii
, ii
l I=
I t .
;0
-";:5
30
..L,0=--
;0
--
--
,0=--
g
:3
---
I(S)
2.8
....'
1.6
N'
3.5 5
:3
3.45
4-<'
7.4
t(8)
25
---
"i:_
30
t(8)
0
,0
0
'
5
10
Fig.
15
20
25
30
.
10
10
15
20
25
30
15
20
25
30
1(8)
Fig.
25
....A.
30
c-n<'
20
25
30
8.4
t(8)
B.6
-0.21,'c;71 ----,;;
,8-;-:
7-.;;
8 ---- ,-;C;7-;;
-c 7;c;.2 ----:-17C:-CAc
.6----,-: C:
B.8
t(8)
.1
q.
0.2
0.15
0.1
''-
0.2
B.2
\;-----+----;-;;--+._---c--!c_---L
0.25 ___"""CT"---------- --
0.2
0.15
0.1
;;----7---7;;---;-;--.;;;---;'c--- .
0.2
0.15
0.1
\;-3---"o---:-::---:-:,5c-::20:---::25=--- 0
Fig.
'
...L2=5
-
'
--
20
15
<:'IWIt'i:N>
o: ====-;:===;1_,' '___
+.c-J_",'_ _'
o
10
15
t(8)
-0.08 8
2.4
Fig.
10
0.06
30
1.2 '-:----:-::--::---:-:--:------:-::-::---:---:-!
-:-:
12
12.2 12.4 12.6
7.8
7.6
:-:: 20
"1
3.65
".-
-0.04
L-...L2
5
=:..:.:.JI30
:::
20
---',5
-0.40
.,.,
--
:-::
20
15
3.75
---:;;-',5
10
---
---
--
---
---
_.
0.16c------
10
20
'\
o '----i
0
,
'0
A
__ _ ,
.0.3
nn----
-
----,0
, 5-----.:20
25--
305
0
30
10 ;---
------':;;-:O ----:-:
15C------.:2::-----:-::
25-0
30
1\
OA /
t(8)
[7] K. Watanabe,
t=10S
0.5
E
;;:
J.
/,
...,
-0.5
- . - Robot Trajectory
... . -
:;/
-1
-1
-0.5
and
'/
479, 2008.
[9] 1. Han, "From pid to active disturbance rejection control, " In
-._.-'
-1.5
Fig.
Initial position
1. Tang,
Y. Shiraishi, S. Tzafestas,
'
x(m)
0.5
1.5
actions on, vol. 12, no. 3, pp. 364 - 374, may 2004.
[15] S. Talole, 1. Kolhe, and S. Phadke, "Extended-state-observer
based control of flexible-joint system with experimental vali
dation, " Industrial Electronics, IEEE Transactions on, vol. 57,
no. 4, pp. 1411 -1419, april 2010.
[16] B. Sun and Z. Gao, "A dsp-based active disturbance rejection
control design for a l-kw h-bridge dc-dc power converter, " In
dustrial Electronics, iEEE Transactions on, vol. 52, no. 5, pp.
1271 - 1277, oct. 2005.
REFERENCES
[1] F. Pin and S. Killough, "A new family of omnidirectional and
holonomic wheeled platforms for mobile robots, " IEEE Trans
actions on Robotics and Automation, vol. 10, no. 4, pp. 480
-489, Aug 1994.
[2] C. Ye and S. Ma, " Development of an omnidirectional mobile
platform, " in Proceeding of IEEE International Conference on
accepted.
[18] M. Branicky, V. Borkar, and S. Mitter, "A unified framework
for hybrid control: model and optimal control theory, " Auto
matic Control, IEEE Transactions on, vol. 43, no. 1, pp. 3145, 1998.
[19] K.-S. Byun and I.-B. Song, " Design and construction of con
tinuous alternate wheels for an omnidirectional mobile robot, "
Journal of Robotic Systems, vol. 20, no. 9, pp. 569-579, 2003.
[20] Z. Gao, "Active disturbance rejection control: a paradigm shift
in feedback control system design, " inAmerican Control Con