Research Inventy: International Journal of Engineering and Science
Research Inventy: International Journal of Engineering and Science
J V
E
=
1
. (1)
Nonlinear Adaptive Control For Welding
48
where | |
T
E E E E
y x V |
=
1
is the velocity vector of the end-effector with respect to the moving
frame, | |
T
3 2 1
u u u u
= is the angular velocity vector of the joints of the manipulator, and J is the Jacobian
matrix.
(
(
(
+ + +
=
1 1 1
123 3 12 2 123 3 1 1 12 2 123 3
123 3 12 2 123 3 1 1 12 2 123 3
C L C L C L C L C L C L
S L S L S L S L S L S L
J
(2)
where
3 2 1
, , L L L are the length of links of the manipulator, ) sin(
1 1
u = S , ) sin(
2 1 12
u u + = S , ) sin(
31 2 1 123
u u u + + = S ,
) cos(
1 1
u = C , ) cos(
2 1 12
u u + = C ) cos(
31 2 1 123
u u u + + = C .
y
x
X
Y
O
b
X
p
Y
P
v
P
p
e
1
u
2
u
3
u
E
v
E
1
J P
3
J
2
J
L
3
L
2
L
1
p
u
y
E
x
E
Y
E
X
E
Fig. 1
Scheme for deriving the kinematic equations of the mobile manipulator
The end-effectors velocity vector with respect to the world frame from the motion equation of a rigid body in a
plane is obtained as follows
E E P P E
V Rot p Rot W V V
1
1
0 1
1
0
+ + = (3)
where:
V
E
:
the velocity vector of the end-effector with respect to the world frame
V
P
:
the velocity vector of the center point of platform with respect to the world frame
W
P
:
the rotational velocity vector of the moving frame
0
Rot
1
:
the rotation transform matrix from the moving frame to the world frame
1
p
E
:
the position vector of the end-effector with respect to the moving frame
(
(
(
u
=
E
E
E
E
Y
X
V
,
(
(
(
u
=
P
P
P
P
Y
X
V
,
(
(
(
u
=
P
P
W
0
0
,
(
(
(
=
E
E
E
E
y
x
p
|
1
,
(
(
(
u u
u u
=
1 0 0
0 cos sin
0 sin cos
1
0
P P
P P
Rot
,
2
3 2 1
t
u u u u + + + = u
P E
,
P E
u + + + = u
3 2 1
u u u
B Kinematic Equations of the Mobile Platform
When the mobile-platform moves in a horizontal plane, it obtains the linear velocity v
p
and the angular
velocity e
p.
The relation between v
p
; e
p
and the angular velocities of two driving wheels is given by
(
=
(
P
P
lw
rw
v
r b r
r b r
e e
e
1
1
. (4)
where
lw rw
e e , are the angular velocities of the right and left wheels.
Nonlinear Adaptive Control For Welding
49
III. CONTROLLERS DESIGN
A. Controller Design For Manipulator
It is assumed that the dimensional parameters of L
1
, L
2
and L
3
are known exactly. The coordinate of the
mobile manipulator with the reference welding trajectory is shown in Fig. 2. Our objective is to design a
controller so that the end-effector with the coordinates ) , , (
E E E
Y X E u tracks to the reference point
( )
R R R
Y X R u . The tracking error vector | |
T
E
e e e E
3 2 1
= is defined as follows
(
(
(
u u
(
(
(
u u
u u
=
(
(
(
=
E R
E R
E R
E E
E E
E
Y Y
X X
1 0 0
0
0
e
e
e
E cos sin
sin cos
3
2
1
. (5)
(5)
Y
R
Y
E
x
y
X
E
X
R
R
E e
3
P
u
X
Y
v
E
v
R
E
Y
R
Y
E
e
2
R
e
1
E
u
X
R
X
E
Fig. 2
Scheme for deriving the error equations of the manipulator
Let us denote
(
(
(
u u
u u
=
1 0 0
0
0
A
E E
E E
cos sin
sin cos
,
(
(
(
u
=
R
R
R
R
Y
X
p
,
(
(
(
u
=
E
E
E
E
Y
X
p
Equation (5) can be re-expressed as follows
( )
E R E
p p A E = . (6)
and its derivative is
( ) ( )
E R E R E
V V A p p A E + =
(7)
(
(
(
+
+
=
(
(
(
=
E R
R E
R E E
E
e e
e e
e
e
e
e e
v e
v v e
3 1
3 2
3
2
1
sin
cos
E
where
R R
V p = and
E E
V p = . Substituting (1), (3) and (6) into (7) yields
)) ( (
1
0 1
1
0 1
u
J Rot p Rot W V V A E A A E
E P P R E E
+ + + =
(8)
The chosen Lyapunov function and its derivative are
E
T
E
E E V
2
1
0
= (9)
E
T
E
E E V
=
0
(10)
To achieve the negative of
0
V
(11)
where ( )
3 2 1
k k k diag K = with positive values k
1
, k
2
and k
3
.
Substituting (11) into (8) yields
)) ( (
1
0 1
1
0 1
u
J Rot p Rot W V V A E A A KE
E P P R E E
+ + =
(12)
If V
P
is chosen in advanced as a constraint, the errors converge to zero if the non-adaptive control law of the
manipulator is given as follows
) ) ( (
1
1
0 1 1 1
1
0 1
E P P R E
p Rot W V V E K A A A Rot J + + =
u
(13)
(13) is the controller of the manipulator, and it can be re-expressed as follows
( )
( ) ( ) ( )
P
E R E
E P e R
S k e L e k e
C e k e C v S v
S L
e
e e e
e
u
|
|
.
|
\
|
+ + + + +
+
=
3 3 3 3 2 1 1
3 1 2 2 12
3
3
2 1
1
1
( ) ( )
( )( )
( ) ( ) ( )
|
|
|
|
.
|
\
|
+ + + + +
+ +
+ + +
=
E R E
E
P e e R
e k e L k e L S L S L
C L C L k e e
C L C L v S L S L v
S L L
e e e
e u
2 1 1 3 3 3 3 3 2 12 1
3 2 23 1 2 2 1
12 2 1 1
3
3 2
3
23 1
2 2 1
2
1
( )
( ) ( ) ( )
( ) ( )
E R
E R E
P E e R
k e
S k e L e k e
C v C e k e S v
S L
e e
e e e
e
u
+ + +
|
|
.
|
\
|
+ + + + +
+
=
3 3
23 3 3 3 1 1 2
1 23 1 2 2
3
23
2 2
3
1
where ) ( sin
3 3 2
3
23
e S
e
+ + = u u and ) sin(
3 3
3
3
e S
e
+ = u .
When the length of link L
i
is known not exactly, an adaptive controller is designed to attain the control objective
by using the estimated value of L
i
.
Let us define the estimation error vector as follows
L L L
~
= (14)
where | |
T
L L L L
3 2 1
= , and L
, J
= = u (16)
where
(
(
(
+ + +
=
0 0 0
~ ~ ~ ~ ~ ~
~ ~ ~ ~ ~ ~
~
123 3 12 2 123 3 1 1 12 2 123 3
123 3 12 2 123 3 1 1 12 2 123 3
C L C L C L C L C L C L
S L S L S L S L S L S L
J (17)
Substituting (16) into (15) yields
d E
J J V u
)
~
(
1
= (18)
If L
i
is estimated, the position vector of the end-effector becomes
E E E
p p p
~
1 1 1
= (19)
( ) ( ) ( )
( ) ( ) ( )
(
(
(
+ + + + +
+ + + + +
=
0
sin
~
sin
~
sin
~
cos
~
cos
~
cos
~
~
3 2 1 3 2 1 2 1 1
3 2 1 3 2 1 2 1 1
1
u u u u u u
u u u u u u
L L L
L L L
p
E
(20)
Now, (8) can be rewritten as
Nonlinear Adaptive Control For Welding
51
))
( (
1
0 1
1
0
1
d E P P R
E E
J Rot p Rot W V V A
E A A E
u
+ + +
=
(21)
Substituting (18) and (19) into (21) yields
( )
d E P d
E P P R E E
J Rot p Rot x W A J Rot
p Rot W V V A E A A E
u u
~
~
))
( (
1
0 1
1
0
1
0
1
1
0 1
+ + +
+ + =
(22)
E P
p Rot AW
~ 1
1
0
and
d
J Rot A u
~
1
0
can be rewritten as follows
( ) ( )
( ) ( )
(
(
(
(
(
(
+
+
=
=
3
2
1
3 3 2
3 3 2
1
1
0
~
~
~
0 0 0
0 sin sin
1 cos cos
~
~
L
L
L
L A p Rot AW
P
A
P
P E P
u u u
u u u
e
(23)
( ) ( ) ( ) ( )
( ) ( ) ( )
(
(
(
(
(
(
+ +
+ + + +
=
=
3
2
1
3 2 1 3 2 1
3 2 1 3 2 1 3 2 1
1
0
~
~
~
0 0 0
0 sin sin
cos cos
~ ~
L
L
L
L A J Rot A
J
A
J d
u u u u u u
u u u u u u u u u
u
(24)
Equation (22) can be re-expressed as follows
( )L A A J Rot
p Rot W V V A E A A E
J P d
E P P R E E
~
))
( (
1
0
1
1
0 1
+ + +
+ + =
u
(25)
The chosen Lyapunov function and its derivative are
L L E E V
T
E
T
E
~ ~
2
1
2
1
1
+ = (26)
L L E E L L E E V
T
E
T
E
T
E
T
E
~
~ ~
1
= + = (27)
where ( )
3 2 1
diag = with
i
is the positive definite value and
T T
L L
~
= .
Substituting (25) into (27) yields
L L L A A E V V
T
J P
T
E
~
~
) (
0 1
+ + = (28)
To achieve the negative value of
1
V
, the control law is chosen as (13), and the parameter update rule is chosen
as
( )
1
+ =
J P
T
E
T
A A E L
(29)
a. Controller Design for Mobile Platform
The task of the mobile latform is to move so as to avoid the singularity of the manipulators configuration. A
simple algorithm is proposed for the mobile-platform to avoid the singularity by keeping its initial configuration
throughout the welding process.
The initial configuration of the manipulator is chosen as shown in Fig. 3. Let us define a point ( )
M M
Y X M , that
coincides to the point E of the end-effector at beginning. If M and E do not coincide, the errors exist. The error
vector | |
T
M
e e e E
6 5 4
= is defined as
Nonlinear Adaptive Control For Welding
52
(
(
(
u u
(
(
(
u u
u u
=
(
(
(
=
M E
M E
M E
M M
M M
M
Y Y
X X
e
e
e
E
1 0 0
0 cos sin
0 sin cos
6
5
4
(30)
In order to keep the configuration of the manipulator away from the singularity, the mobile-platform has to move
so that the point M tracks to the point E. Consequently, the initial configuration of the manipulator is maintained
throughout the welding process, and the singularity does not appear. The initial configuration of the manipulator
is chosen as
4
,
2
,
4
3
3 2 1
t
u
t
u
t
u = = = . From Fig. 4, we get the geometric relations as
P M
P P M P P M
D Y Y D X X
u = u
u + = u = , cos , sin
(31)
where
|
|
.
|
\
|
+ |
.
|
\
|
+ +
|
|
.
|
\
|
|
.
|
\
|
+ + |
.
|
\
|
=
4 2 4
3
sin
2 4
3
sin
4
3
sin
3 2 1
t t t t t t
L L L D Hence, we have
P M P P P P M
P P P P M
D v Y
D v X
e e
e
= u u u =
u u =
, sin sin
, cos cos
(32)
A controller for the mobile-platform will be designed to achieve
i
e 0 when t .
The derivative of (30) can be re-expressed as follows
(
(
(
(
+
+
(
(
(
=
(
(
(
P
P
E
E
E
v
e
D e
e v
e v
e
e
e
e
e 1 0
0
1
sin
cos
4
5
6
6
6
5
4
(33)
The chosen Lyapunov function and its derivative are
5
6 2
5
2
4 0
cos 1
2
1
2
1
k
e
e e V
+ + = (34)
6
5
6
5 5 4 4 0
sin
e
k
e
e e e e V
+ + =
) (
sin
) cos (
5 5
5
6
6 4 0
E E P
E P P
v e k
k
e
e v D v e V
+ + +
+ + =
e e
e
(35)
An obvious way to achieve negativeness of
2
V
is to choose ) , (
P P
v e as
4 4 6
cos e k e v D v
E P P
+ + = e (36)
6 6 5 5
sine k v e k
E E P
+ + = e e (37)
where
6 5 4
and , , k k k are positive values.
Nonlinear Adaptive Control For Welding
53
P(X
P
,Y
P
)
E(X
E
,Y
E
)
M(X
M
,Y
M
)
v
P
P
e
x
y
X
Y
e
6
e
4
e
5
P
u
v
E
E
u
D
Initial configuration
of the manipulator
Fig. 3
Scheme for deriving the error equations of mobile-platform
When the wheel radius r and the distance from the center point to the wheel b are unknown, we design an
adaptive controller by using the estimated values of r and b.
Substituting (3) into (33) yields
(
(
(
(
(
(
(
+
+
(
(
(
=
(
(
(
lw
rw
E
E
E
b
r
b
r
r r
e
D e
e v
e v
e
e
e
e
e
e
2 2
2 2
1 0
0
1
sin
cos
4
5
6
6
6
5
4
(38)
Let us define
r
a
1
1
= and
r
b
a =
2
. Equation (38) becomes
(
(
(
(
(
(
(
(
+
+
(
(
(
=
(
(
(
lw
rw
E
E
E
a a
a a
e
D e
e v
e v
e
e
e
e
e
e
2 2
1 1
4
5
6
6
6
5
4
2
1
2
1
2
1
2
1
1 0
0
1
sin
cos
(39)
Equation (4) becomes
(
=
(
P
P
lw
rw
v
a a
a a
e e
e
2 1
2 1
(40)
If r and b are unknown, (40) becomes
(
=
(
Pd
Pd
lw
rw
v
a a
a a
e e
e
2 1
2 1
(41)
where
Pd
v and
Pd
e are the desired values of
P
v and
P
e ,
r
a
1
= and
r
b
a
2
= are the estimated values of a
1
and
a
2
. Substituting (41) into (39) yields
(
(
(
(
(
(
(
(
+
+
(
(
(
=
(
(
(
Pd
Pd
E
E
E
v
a
a
a
a
e
D e
e v
e v
e
e
e
e
e
2
2
1
1
4
5
6
6
6
5
4
0
0
1 0
0
1
sin
cos
(42)
where
|
|
.
|
\
|
+ |
.
|
\
|
+ +
|
|
.
|
\
|
|
.
|
\
|
+ + |
.
|
\
|
=
4 2 4
3
sin
2 4
3
sin
4
3
sin
3 2 1
t t t t t t
L L L D
P P P Pd
v
r
r
a r v
a
a
1
1
1
= = = v v ,
p p P Pd
r
b
b
r
a
b
r
a
a
e e e e
2
2
2
= = =
Nonlinear Adaptive Control For Welding
54
Let us define the estimation errors as follows
1 1 1
~
a a a = ,
2 2 2
~
a a a = (43)
Equation (42) can be rewritten as follows
|
|
|
|
.
|
\
|
(
(
(
(
(
(
(
+
+
(
(
(
=
(
(
(
Pd
Pd
Pd
Pd
E
E
E
a
a
v
a
a
v
e
D e
e v
e v
e
e
e
e
e
e
2
2
1
1
4
5
6
6
6
5
4
~
~
1 0
0
1
sin
cos
(44)
The chosen Lyapunov function and its derivative are given as
2
2
2 2
2
1
1 1
2
6
2
5
2
4 3
~
2
1
~
2
1
2
1
2
1
2
1
a
a
a
a
e e e V
P P
+ + + + = (45)
2 2
2 2
1 1
1 1
6 6 5 5 4 4 3
~ ~
1
~ ~
1
a a
a
a a
a
e e e e e e V
P P
+ + + + =
|
|
.
|
\
|
+
|
|
.
|
\
|
+ =
Pd
P
Pd
P
Pd
D e a e
a
a
a v e
a
a
V e
1
~
1
~
4 2
2
6
2
2
1
1
4
1
1
2
(46)
where
1 1
~
a a
= and
2 2
~
a a
= .
The controller is still (36) and (37), but there is two update laws as follows
Pd P
v e a
4 1 1
=
(47)
( ) D e e a
Pd P
4 6 2 2
= e
(48)
IV. SIMULATION AND EXPERIMENTAL RESULTS
Table 1 shows the parameter and initial values for the welding wheeled mobile manipulator system used in this
simulation.
Table 1
Numerical values and initial values for simulation
Parameters
Value
s
Units Parameters
Value
s
Units
X
R
- X
E
(t=0) 0.005 m k
1
1.4 /s
Y
R
- Y
E
(t=0) 0.005 m k
2
1.5 /s
E R
(t=0)
15 deg. k
3
1.7 /s
X
E
(t=0) 0.275 m u
1
(t=0) 135 deg.
Y
E
(t=0) 0.395 m u
2
(t=0) -90 deg.
E
u (t=0) -15 deg u
3
(t=0) 45 deg.
R
0.007
5
m/s k
5
65
rad/m
2
k
4
1.6 /s k
6
1.25 rad/s
In this case, the update laws in (29), (47) and (48) are used to estimate the unknown parameters. Parameter
values for simulation are shown in Table 2.
A welding mobile manipulator of prototype as shown in Fig. 4 has constructed to check the effectiveness of the
algorithm.
Nonlinear Adaptive Control For Welding
55
Table 2
The parameter values for simulation
Parameters
Value
s
Units Parameters
Value
s
Units
b
(t=0)
0.11 m
1
0.265
r (t=0) 0.027 m
2
0.187
5
1
L (t=0) 0.195 m
3
0.163
5
2
L (t=0) 0.195 m
P1
4640
3
L (t=0) 0.195 m
P2
12.4
Fig. 4
The wheeled mobile manipulator prototype
The simulation and experimental results of the system with all exactly unknown parameters are presented as the
following figures 5-11.
Welding Reference
Trajectory
Manipulator
Mobile
Platform
Mobile Platform Trajectory
Fig. 5
The trajectory reference and mobile manipulator posture
0 2 4 6 8 10 12 14 16 18 20
-1
0
1
2
3
4
5
6
Time (s)
E
r
r
o
r
e
1
(
m
m
)
Simulation Result
Experimental Result
Fig. 6
Tracking error e
1
from the simulation and experimental results
Nonlinear Adaptive Control For Welding
56
0 2 4 6 8 10 12 14 16 18 20
-1
0
1
2
3
4
5
6
7
Time (s)
E
r
r
o
r
e
2
(
m
m
)
Simulation Result
Experimental Result
Fig. 7
Tracking error e
2
from the simulation and experimental results
0 2 4 6 8 10 12 14 16 18 20
-2
0
2
4
6
8
10
12
14
16
Time (s)
E
r
r
o
r
e
3
(
d
e
g
)
Simulation Result
Experimental Result
Fig. 8
Tracking error e
3
from the simulation and experimental results
0 2 4 6 8 10 12 14 16 18 20
-1
0
1
2
3
4
5
Time (s)
E
r
r
o
r
e
4
(
m
m
)
Simulation Result
Experimental Result
Fig. 9
Tracking error e
4
from the simulation and experimental results
0 2 4 6 8 10 12 14 16 18 20
-0.5
0
0.5
1
1.5
2
2.5
3
3.5
4
4.5
Time (s)
E
r
r
o
r
e
5
(
m
m
)
Simulation Resukt
Experimental Result
Fig. 10
Tracking error e
5
from the simulation and experimental results
0 2 4 6 8 10 12 14 16 18 20
-8
-6
-4
-2
0
2
4
6
8
Time (s)
E
r
r
o
r
e
6
(
d
e
g
)
Simulation Result
Experimental Result
Fig. 11
Tracking error e
6
from the simulation and experimental results
Nonlinear Adaptive Control For Welding
57
V. CONCLISIONS
This paper proposed an adaptive tracking control method for the mobile platform with the unknown
parameters. Two independent controllers are proposed to control two subsystems. The controllers are based on
the Lyapunov function to guarantee the tracking stability of the welding mobile robot. The dimensional
parameters of the mobile manipulator are considered to be unknown parameters which are estimated by using
update law in adaptive control scheme. The simulation and experiment results show that all of the errors are
converged. The controllers are simple. Those are implemented for microcontroller easily.
REFERENCES
[1] Ph. J. Mc Kerrow Introduction to Robotics, Addison-Wesley Publishers, 1991.
[2] H. Seraji Configuration control of cover-counted canipulators Proc. of the IEEE Int. Conf. Robo. Auto.,Vol.3, pp. 2261-2266,
1995.
[3] W. S. Yoo, J. D. Kim, and S. J. Na a study on a mobile Platform-Manipulator Welding System for Horizontal Fillet Joints
Mechatronics, Vol. 11, pp. 853-868, 2001.
[4] T. Fukao, H. Nakagawa, and N. Adachi Adaptive Tracking Control of a Non-holonomic Mobile Robot Trans. Robo. Auto.,
Vol. 16, No. 5, pp. 609-615, 2000.
[5] Fierro R., and Lewis F. L., Control of a Non-holonomic Mobile Robot: Backstepping Kinematics into Dynamics, Proc. IEEE.
Conf. Deci. Cont., Vol. 4, pp. 3805-3810, 1995.
[6] Yamamoto, Y., and Yun, X., Coordinating Locomotion and Manipulation of A Mobile Manipulator, Proc. IEEE Int. Conf.
Deci. Cont., pp. 2843~2848, 1992.
[7] Jeon, Y. B., Kam, B. O., Park, S. S., and Kim, S. B., Modeling and Motion Control of Mobile Robot for Lattice Type Welding,
Int. J. (KSME)., Vol. 16, No 1, pp. 83~93, 2002.
[8] T. T. Phan, T. L. Chung, M. D. Ngo, H. K. Kim and S. B. Kim, Decentralized Control Design for Welding Mobile
Manipulator, Int. J (KSME)., Vol. 19, No 3, pp. 756~767, 2005.