Modeling and Simulation
Modeling and Simulation
Universidad de Antioquia
ISSN: 0120-6230
revistaingenieria@udea.edu.co
Universidad de Antioquia
Colombia
How to cite
Complete issue
Scientific Information System
More information about this article Network of Scientific Journals from Latin America, the Caribbean, Spain and Portugal
Journal's homepage in redalyc.org Non-profit academic project, developed under the open access initiative
S. Mohan et al.; Revista Facultad de Ingeniería, No. 81, pp. 63-72, 2016
Revista Facultad de Ingeniería, Universidad de Antioquia, No. 81, pp. 63-72, 2016
Department of Mechanical Engineering, Velammal College of Engineering and Technology. Madurai to Rameshwaram High Road,
Viraganoor, Madurai-625009. Madurai, India.
ARTICLE INFO ABSTRACT: The robots are electromechanical systems that need mechatronic approach
Received March 23, 2016 before manufacturing them, in order to reduce the development cost. In this paper, a
Accepted September 29, 2016 novel attempt of Modelling PRRP (Prismatic-Revolute-Revolute-Prismatic), configuration
redundant SCARA (Selective Compliance Articulated Robot Arm), robot with a Multi spindle
drilling tool (MSDT) using SolidWorks CAD software, and the dynamic study with the aid of
MATLAB/SimMechanics is presented. The SCARA with MSDT is used to drill multiple holes
in the printed circuit boards (PCBs) and sheet metal. In this work, the 3D CAD model of the
proposed robot is converted into SimMechanics block diagram by exporting it to the MATLAB/
KEYWORDS SimMechanics second generation technology environment. Then, SimMechanics simulation
SCARA, multi spindle is performed and by utilizing its motion sensing capability, the dynamic parameters velocity
drilling tool, SolidWorks, and torque of the manipulator are observed for modified variable robot structure. The
SimMechanics, dynamic, simulation results indicate the considerable change in the dynamic performance for varying
simulation, mechanics explorer design parameters.
SCARA, herramienta de RESUMEN: Los robots son sistemas electromecánicos que necesitan enfoque mecatrónico
perforación multi-eje,
antes de fabricarlos, esto con el fin de reducir el costo de desarrollo. En este trabajo se
SolidWorks, SimMechanics,
presenta un nuevo intento de modelado PRRP (prismáticos-revoluto-revoluto-prismático),
dinámica, simulación,
explorador de mecánica una configuración redundante SCARA (Brazo robótico articulado de respuesta selectiva),
herramienta de perforación milti-eje (MSDT) usando el software CAD de SolidWorks y el
estudio dinámico con la ayuda de MATLAB/SimMechanics de perforación. Un SCARA con
MSDT se utiliza para perforar varios agujeros en las placas de circuito impreso (PCB) y
la chapa metálica. En este trabajo, el modelo de CAD 3D del robot propuesto se convierte
en un diagrama de bloque SimMechanics exportando a MATLAB/SimMechanics segunda
generación de tecnología de modelado y simulación. Entonces se realiza una simulación
SimMechanics y utilizando su capacidad de detección de movimiento la velocidad de
parámetros dinámicos y la torsión del manipulador se observa la estructura del robot
variable modificado. Los resultados de la simulación indican un cambio considerable en el
rendimiento dinámico para diferentes parámetros de diseño.
63
S. Mohan et al.; Revista Facultad de Ingeniería, No. 81, pp. 63-72, 2016
64
S. Mohan et al.; Revista Facultad de Ingeniería, No. 81, pp. 63-72, 2016
4. Robot Kinematics
Robot Kinematics is a geometric study of motion of a Figure 2 Front view of the SCARA with MSDT and
robotic manipulator with respect to the datum coordinates D-H parameters
system. In this paper, kinematic model is developed using
the Denavit-Hartenberg (D-H) forward kinematic approach.
The primary goal of kinematic modelling is to describe the
robot mechanism.
Ai = T (z, d) T (z, Ө) T(x, a) T(x, α) (1) Figure 3 Bottom view of the MSDT
65
S. Mohan et al.; Revista Facultad de Ingeniería, No. 81, pp. 63-72, 2016
Where ⎡ C 6 −S 6 0 0 ⎤
⎢ ⎥
lm is length of the main arm in mm. S6 C6 0 0 ⎥
A6 = ⎢
lf is length of the fore arm in mm. ⎢ 0 0 1 d5 ⎥
la is length of the drilling Tool A from the prismatic arm axis ⎢ 0 0 0 1 ⎥⎦
⎣ (9)
(Z3).
lb is length of the drilling Tool B from the prismatic arm
axis (Z3), it is in the x axis but in negative direction .So it is ⎡ C 7 −S 7 0 0 ⎤
⎢ ⎥
assumed as - lb. S7 C7 0 0
A7 = ⎢ ⎥
⎢ 0 0 1 d6 ⎥
d1, d2, d3, d4, d5, d6, d7 are link offset length between the ⎢ ⎥
⎣ 0 0 0 1 ⎦
successive links. (10)
C2, C3, C6, C7 are Cosine function of joint angles. 4.2. Kinematic model for drilling Tool A
S2, S3, S6, S7 are Sine function of joint angles.
and Tool B position
⎡ 1 0 0 0 ⎤ The direct kinematic model to find the orientation and
⎢ ⎥
0 1 0 0 the position of the tool A is obtained by applying the
A 1= ⎢ ⎥
⎢ 0 0 1 lp + d 1 ⎥ homogeneous transformations given in the Eqs. (11) and
⎢
0 0 0 1
⎥ (12).
⎣ ⎦ (4)
TA= A1A2.A3.A4. A6. (11)
⎡ C 2 −S 2 0 lmC 2 ⎤
⎢ ⎥
S2 C2 0 lmS 2
A2 = ⎢ ⎥ ⎡ C 6C 23+ S 6S 23 −S 6C 23+ C 6S 23 0 (la + lf )C 23+ lmC 2 ⎤
⎢ 0 0 1 0 ⎥ ⎢ ⎥
C 6S 23− S 6C 23 −S 6S 23− C 6C 23 0 (l a + lf )S23 + lms2
⎢
⎣ 0 0 0 1 ⎥
⎦ TA = ⎢⎢ ⎥
⎥
(5) 0 0 −1 d 1+ lp − d 5− d 4
⎢ ⎥
⎢⎣ 0 0 0 1 ⎥⎦
⎡ C3 S3 0 lmC 3 ⎤
⎢ ⎥ (12)
S 3 −C 3 0 lmS 3
A3 = ⎢ ⎥
⎢ 0 0 1 0 ⎥ The Eqs. (13-15) represent the Tool a Position with reference
⎢ 0 0 0 1 ⎥
⎣ ⎦ (6) to the base frame.
⎡ 0 la ⎤
xA = (la + l )C + lmC 2
1 0 f 23 (13)
⎢ ⎥
1 1 0 0 ⎥
A 4= ⎢
⎢ 0 0 1 d4 ⎥
⎢ y A = (l a +l )S23 + lms2
⎣ 0 0 0 1 ⎥⎦ f (14)
(7)
z A = d1 + l p − d − d4
⎡ 1 0 0 − lb ⎤ 5 (15)
⎢ ⎥
0 1 0 0
A5 = ⎢ ⎥
The kinematic model in the homogeneous transformation
⎢ 0 0 1 d4 ⎥
⎢ ⎥ matrix form for Tool B is TB given in the Eqs. (16) and (17).
⎢⎣ 0 0 0 1 ⎥⎦
(8)
TB= A1.A2.A3.A5.A7 (16)
66
S. Mohan et al.; Revista Facultad de Ingeniería, No. 81, pp. 63-72, 2016
xB = (l f − lb )C23 + lmC2
(18)
yB = (l f − lb )S23 + lm S2
(19)
zB = d1 + l p − d6 − d4
(20)
x D = l f C23 + lmC2
In the Eqs. (12-14) and Eqs. (17-19), C23 denotes Cos (Ө2 + (27)
Ө3), S23 denotes Sin (Ө2 + Ө3).
y D = l S23 + lmS2
f (28)
4.3. Determination of drilling tool C
and D position z D = l p + d1 − d4 − d M
(29)
The coordinate position of the midpoint ‘M’ of the tool
head is found as follows in the Eqs. (21-23) using the D-H 4.4. Inverse kinematics for the end
representation. effector
x M = l f C23 + lmC2 In the inverse kinematics the joint variables are determined
(21)
for the desired position and orientation of the end effector
of the robot. The algebraic methods [27, 28] of inverse
y M = l S23 + lmS2 kinematics are used to verify the joint angles when its is in
f (22)
tool A position using the coordinate Eqs. (13) and (14).
z M = l p + d1 − d4 − dM
(23) The inverse kinematic model is expressed in the Eqs. (30-33)
by solving the Eqs. (13) and (14) by required simplifications.
Here dM = d5 = d6
θ 3 = π ± Cos(α ) (30)
Geometrically by using the principle of a right angle triangle
the position of tool C and tool D are found out using the
α = lm ((l p +(l + la ))/4l p (l + la )± ...
Figure 4. From the geometrical representation in Figure 4, f f
the tool C position coordinates xc and yc can be predicted by
((4l p (l + la )− lm )(2l p (l + la )− l p 2....
2
substituting the value Ө3 = Ө3 - δ in the Eqs. (24) and (25). f f
Zc coordinate can be found out by using the Eq. (26). 1
−(l + la )2 )+ 4l p (l + la )( x a2 + y a2 ))2 /4l p (l + la )
xC = l C 23 + lmC 2 f f f
f (24) (31)
67
S. Mohan et al.; Revista Facultad de Ingeniería, No. 81, pp. 63-72, 2016
68
S. Mohan et al.; Revista Facultad de Ingeniería, No. 81, pp. 63-72, 2016
69
S. Mohan et al.; Revista Facultad de Ingeniería, No. 81, pp. 63-72, 2016
70
S. Mohan et al.; Revista Facultad de Ingeniería, No. 81, pp. 63-72, 2016
7. Conclusion
This paper presents the first attempt of modelling and
simulation of a new type of redundant SCARA robot with
MSDT by utilizing the SolidWorks CAD modelling and
MATLAB/SimMechanics software. With the aid of schematic
representation of the CAD model of the robot and assigned
D-H parameters, new kinematic model was developed to
identify the four tool positions of the MSDT attached to
the SCARA. The simulation was performed in the MATLAB
/SimMechanics second genetration environment by
Figure 14 Angular Velocity of revoulte joint exporting the 3D CAD model from the SolidWorks platform.
2 if l m = l f = 300mm The dynamic performance velocity and torque are
observed from the simulation results for the manipulator
Figures 15 and 16 shows the required torque at joint 1 and movement in elbow up and elbow down path for modified
joint 2 as 42.49Nm and 16.12Nm respectively. main arm length and fore length of robotic manipulator.
The simulations results of dynamic performance for the
modified variables of the robot structure infer that the
structure of the robot can be modified to get the required
dynamic parameters. The modelling and simulation of
robot using SolidWorks and SimMechanics methodology
reveals that the design and structural changes can be done
with great ease based on the simulated dynamic study.
Thus, developing a robot with a desired configuration will
be economical and easier; it is the obtained end result of
this innovative research.
8. Acknowledgements
The work presented here had been done in the lab developed
in Velammal College of Engineering and Technology,
Figure 15 Torque of revoulte joint Madurai, Tamil Nadu, India by the All India Council for
1 if l m = l f = 300mm Technical Education, Government of India project grant
under research promotion scheme (No.20/AICTE/RIFD/
RPS(POLICY-III)111/ 2012-2013) for developing “Intelligent
Robot Manipulator Systems”.
71
S. Mohan et al.; Revista Facultad de Ingeniería, No. 81, pp. 63-72, 2016
72