Articulo Trans Elevado R
Articulo Trans Elevado R
DOI 10.1007/s00521-012-1224-7
ORIGINAL ARTICLE
Received: 9 December 2011 / Accepted: 23 September 2012 / Published online: 21 October 2012
Springer-Verlag London 2012
Abstract In this paper, the structural, sensor, and actuator mathematical models of a transelevator are presented;
after, the mathematical model with sensor and actuator of
the transelevator is obtained by using the combination of
the above mentioned mathematical models. The proposed
mathematical model is validated comparing the simulation
results against the experimental results. Finally, the stability analysis of the aforementioned model is studied.
Keywords Mathematical model Transelevator
Robotic systems Validation
1 Introduction
The structural mathematical model is used for the control
applications, but when a system is controlled, a sensor and
an actuator are required, so this work is interested to obtain
the mathematical model with sensor and actuator for a
transelevator. A transelevator is a crane similar to a
Cartesian robotic arm which is moved inside of a warehouse, this transelevator is used to move loads from one
place to another one inside of the warehouse.
123
278
2 Preliminaries
The Euler Lagragian method is used to obtain the mathematical model of the transelevator. The first step of this
method is to find the kinetic energy Ki, it is the addition of
the speed of the motion and the rotation kinetic energy, it is
given as follows:
n 2
1
1 X
Ki mi v2i Ji hi
2
2 i1
n
X
Ki Vi
and Zi are the derivatives of Xi ; Yi ; and Zi ; respectively,
Xi ; Yi ; and Zi ; are the coordinates of the linear movement of
the link i.
The second step is to find the potential energy, it is given
as follows:
2
123
Vi mi ghi
i1
X1 x1
Y1 0
Z1 0
279
m13 x1 s1
5
X 2 x1
Y2 0
Z 2 z2
Z 3 z2
where y3 is the length to the mass center of the link 3. From
the Fig. 1, the parameter y3 is bounded as follows
0 B y3 B ymax. Using (1) and (9), the kinetic energy for
the joint 3 is:
1 2 1 2 1 2
K3 m3 x1 m3 z2 m3 y3
2
2
2
10
11
V3 m3 gz2
Substituting the Eqs. (6), (8), (10), and (11) in (3) gives the
Lagrangian as follows:
1
1
1 2
2
2
L m13 x1 m23 z2 m3 y3 m23 gz2
2
2
2
m23 z2 m23 g s2
12
14
15
dia
Rmi iai Vi Vbi
dt
16
where:
Vbi Kbi h_ m
From the Fig. 1, the potential energy for the three links is
as follows:
V1 0
V2 m2 gz2
m 3 y 3 s3
From the Fig. 1, the parameters x2, y2, and z2 of the Eq. (1)
are:
13
17
18
where Vfi is the input voltage for link i for the actuator
circuit, VRci is the voltage in the resistance for link i for the
actuator circuit, Vmi Vi is the input voltage of the motor
for link i for the actuator circuit, it is known that:
123
280
h1 max
x1
xmax
h2 max
h2
z2
z2 max
h3 max
h3
y3
y3 max
h1
24
19
where i = 1, 2, 3, Rci = Roi is the resistance for the actuator circuit, ici is the current in the resistance Rci.
Substituting the Eq. (19) in the Eq. (18) gives:
Vfi Rci ici Vm1
20
21
26
where kmi is the constant torque for link i, imi is the current
in the motor for link i; smi si is the torque in the motor,
and Vmi = Vi.
3.3 Sensor mathematical model
Figure 4 shows the sensor circuit, it is known as a voltage
divider where the output voltage is time-varying depending
of the measured position in each link; that is, this circuit is
used to obtain the displacements of each link in function its
the motor angle h_ i ; i 1; 2; 3: It is important to know that:
123
25
22
h1 max
x1
xmax
h2 max
h2
z2
z2 max
h3 max
h3
y
y3 max 3
h1
27
Substituting Eq. (17) and Eq. (22) into Eq. (16) for i = 1
gives:
L1
d
im1 Rm1 im1 Vf 1 Rc1 im1 kb1 h_ 1
dt
28
d
h1 max
im1 Rm1 Rc1 im1 kb1
x 1 Vf 1
dt
xmax
29
281
Vo1 max
h1
h1 max
30
where i 1; 2; 3; j 1; 9:
Substituting the inputs, the states, and the outputs of
Eq. (39) into Eqs. (27), (29) (30), (31), (33), (34), (35),
(37), and (38) yields:
X_ 1 X2
40
km1
X3
X_ 2
m13
41
m23
z2 m23 g km2 im2
kb1 h1 max
Rm1 Rc1
1
X_ 3
X2
X 3 u1
L1
L1
L1 xmax
42
X_ 4 X5
43
km2
X_ 5
X6 g
m23
44
kb2 h2 max
Rm2 Rc2
1
X_ 6
X5
X 6 u2
L2
L2
L2 zmax
45
X_ 7 X8
46
km3
X_ 8
X9
m3
47
kb3 h3 max
Rm3 Rc3
1
X_ 9
X8
X 9 u3
L3
L3
L2 ymax
48
31
Substituting Eq. (17) and Eq. (22) in the Eq. (16) for i = 2
gives:
L2
d
im2 Rm2 im2 Vf 2 Rc2 im2 kb2 h_ 2
dt
32
33
Vo2 max
h2
h2 max
34
35
Substituting Eq. (17) and Eq. (22) in the Eq. (16) for i = 3
gives:
L3
d
im3 Rm3 im3 Vf 3 Rc3 im3 kb3 h_ 3
dt
36
Y1
Vo1 max
X1
h1 max
49
Y2
Vo2 max
X4
h2 max
50
Y3
Vo3 max
X7
h3 max
51
d
h3 max
im3 Rm3 Rc3 im3 kb3
y Vf 3
dt
ymax 3
37
Vo3 max
h3
h3 max
38
U2 Vf2 ; U3 Vf3
X2 x1 ; X3 im1
X5 z2 ; X6 im2
X8 y3 ; X9 im3
Y2 Vo2 ; Y3 Vo3
39
Fig. 5 Circuit of the sensor and the actuator
123
282
V2 = 5 V
Rm2 125:5 X
Rm3 17 X
Rc2 1 X
Rc3 1 X
L1 = 42.5 mH
L2 = 96.1 mH
L3 = 29.9 mH
km1 = 10 Nm/A
km3 = 1 Nm/A
Vf1 = 14 V
Vf2 = 10 V
Vf2 = 4 V
Vo1max = 2.36 V
Vo2max = 2.3 V
Vo3max = 2 V
m13 = 2.9020 kg
m23 = 0.5480 kg
m3 = 0.150 kg
xmax = 0.45 m
zmax = 0.29 m
ymax = 0.23 m
where V1, V2, and V3 are the voltages of the circuit of Fig. 2,
Rm1, Rm2, and Rm3 are the values of motor resistance, L1, L2, and L3
are the values of motor inductance, Rc1, Rc2, and Rc3 are the values of
resistance for the circuit of Fig. 3, kb1, kb2, and kb1 are the constants
back emf of the motor, Vf1, Vf2, and Vf3 are the motor supply voltages,
km1, km2, and km3 are the nominal torques of the motors, h1max,
h2max, and h3max are the maximum angles found by the potentiometer,
xmax, zmax, and ymax are the maximum distances that run through the
links, m13 = m1 ? m2 ? m3, m23 = m2 ? m3, and m3 are the link
masses.
123
V3 = 5 V
Rc1 1 X
283
0.6553
0.0080
123
284
167.10i,
s = 103.34 - 167.10i, s = - 1279.4, s =
- 730.88, s = 0, s = 0, s = 0, the above elements are the
system eigenvalues. Since not all the real parts of the
eigenvalues are negative, the proposed mathematical
model is not guaranteed to be stable.
6 Stability analysis
7 Conclusion
X AX BU F
Y CX
53
where:
60
km1
0
6
m13
6
6
k h max
c1
Rm1LR
6 0 Lb11 x1max
1
6
60
0
0
6
6
0
0
0
A6
6
6
60
0
0
6
60
0
0
6
6
60
0
0
4
0
0
0
h
B 0 0 L11 0 0 L121 0
F 0 0
2V
o1 max
h1 max
6
C6
4 0
0
0 g
0
0
1
0
0
0
0
0
0
0
max
kLb22hz2max
km2
m23
c2
Rm2LR
2
0
0
0
0
0
0
0
0
1
0
max
0 kLb32hy3max
1
L3
iT
0 0
0 T
Vo2 max
h2 max
Vo3 max
h3 max
0 0
7
7
7
7
7
7
7
7
7
7
7
7
7
7
7
7
7
7
5
54
7
0 07
5
0 0
123
0
km3
m3
c3
Rm3LR
3
References
1. Bachrach J, Beal J, McLurkin J (2010) Composable continuousspace programs for robotic swarms. Neural Comput Appl
19:825847
2. Celikkanat H, Sahin E (2010) Steering self-organized robot flocks
through externally guided individuals. Neural Comput Appl
19:849865
3. Chaoui H, Sicard P (2011) Adaptive Lyapunov-based neural
network sensorless control of permanent magnet synchronous
machines. Neural Comput Appl 20:717727
4. Chen C, Inoue Y, Shibata K (2011) Identification of a golf swing
robot using soft computing approach. Neural Comput Appl
20:729740
5. Chiu C-H (2010) Self-tuning output recurrent cerebellar model
articulation controller for a wheeled inverted pendulum control.
Neural Comput Appl 19:11531164
6. Christensen DJ, Campbell J, Stoy K (2010) Anatomy-based
organization of morphology and control in self-reconfigurable
modular robots. Neural Comput Appl 19:787805
7. Lee W-P, Yang T-H (2011) Combining GRN modeling and
demonstration-based programming for robot control. Neural
Comput Appl 20:909921
8. Leite D, Ballini R, Costa P, Gomide F (2012) Evolving fuzzy
granular modeling from nonstationary fuzzy data streams. Evolv
Syst 3(2):6579
9. Lemos A, Caminhas W, Gomide F (2011) Fuzzy evolving linear
regression trees. Evolv Syst 2(1):114
10. Lewis FL, Dawson DM, Abdallah CT (2004) Control of robot
manipulators. Theory Pract. ISBN: 0-8247-4072-6
285
11. Lughofer E, Bouchot JL (2011) On-line elimination of local
redundancies in evolving fuzzy systems. Evolv Syst 2(3):
165187
12. Perez-Cruz JH, Alanis AY, Rubio JJ, Pacheco J (2012) System
identification using multilayer differential neural networks: a new
result. J Appl Math 2012:120
13. Perez-Cruz JH, Ruiz-Velazquez E, Rubio JJ, de Alba-Padilla CA
(2012) Robust adaptive neurocontrol of SISO nonlinear systems
preceded by unknow deadzone. Math Probl Eng 2012:123
14. Rubio JJ, Garca E, Pacheco J (2011) Trajectory planning and
collisions detector for robotic arms. Neural Comput App, online
15. Rubio JJ, Torres C, Rivera R, Hernandez CA (2011) Comparison
of four mathematical models for braking of a motorcycle. IEEE
Latin Am Trans 9(5):630637
16. Rubio JJ, Ortiz F, Mariaca CR, Tovar JC (2011) A method for
online pattern recognition for abnormal eye movements. Neural
Comput Appl. doi: 10.1007/s00521-011-0784-2
17. Rubio JJ, Salazar M, Gomez AD, Lugo R (2012) Modeling of the
relative humidity via functional networks and control of the
temperature via classic controllers for a bird incubator. Neural
Comput Appl 21(7):14911500
18. Spong MW, Hutchinson S, Vidyasagar M (2006) Robot modeling
and control. Wiley, London. ISBN-13: 978-0-471-64990-8
19. Villaverde I, Grana M (2011) Neuro-evolutionary mobile robot
egomotion estimation with a 3D ToF camera. Neural Comput
Appl 20:345354
20. Wu Y, Sun F, Zheng J, Song Q (2010) A robust training
algorithm of discrete-time MIMO RNN and application in fault
tolerant control of robotic system. Neural Comput Appl 19:
10131027
123