Professional Documents
Culture Documents
Modeling, Control, and Simulation of A SCARA PRR-type Robot Manipulator
Modeling, Control, and Simulation of A SCARA PRR-type Robot Manipulator
1. Introduction can operate without the need for large areas. For
this reason, the processes such as packaging, sorting,
Nowadays, the objective of production at high speeds alignment, planar welding, and assembly in the pro-
with low costs and low error rates in industrial pro- duction lines are usually performed with SCARA-type
duction lines has gained great importance in terms of manipulators. The rst SCARA robot was developed
competitiveness. For this reason, companies often use in 1978 by Professor Hiroshi Makino at Yamanashi
dierent types of robots, such as Cartesian, SCARA, University in Japan [3]. Afterwards, many types
etc., in industrial applications. Cartesian systems are of SCARA robots have emerged to be used in the
widely used in high-density warehouses and, generally, machine, automotive, and robot industries.
have both shuttle and aisle robots that generate the In literature studies, kinematic and dynamic
Cartesian structure [1,2]. SCARA (Selective Compli- modeling, simulation analysis, dierent control meth-
ance Assembly Robot Arm) manipulators take up less ods, and trajectory planning have been studied both
space than Cartesian systems, are easier to install, and theoretically and experimentally. Dierent decentral-
ized and centralized (model-based) controllers have
*. Corresponding author. Tel.: +90 2642956912; been tested with experimental studies of an industrial
Fax: +90 2642956424 SCARA robot.
E-mail addresses: muhammed.uk@ogr.sakarya.edu.tr (M.E. As a result, the performance of decentralized
Uk); faris.ali.shah@outlook.com (F.B. Sajjad Ali Shah);
msoyaslan@sakarya.edu.tr (M. Soyaslan); controllers was found to be suciently accurate for a
eldogan@sakarya.edu.tr (O. Eldogan) large number of industrial applications [4]. Accurate
results of experimental studies depend on well-made
doi: 10.24200/sci.2018.51214.2065 mathematical modeling. In SCARA robots, which
M.E. Uk et al./Scientia Iranica, Transactions B: Mechanical Engineering 27 (2020) 330{340 331
are generally used in industrial applications, it is heavy weights is a challenge. Since the base is xed
very important to make both dynamic and kinematic on one point, powerful torque motors for lifting heavy
calculations accurately in order to make the system loads linearly can be used easily.
work properly. While Das and Dulger [5] developed a In this study, a PRR-type (Prismatic-Revolute-
complete mathematical model with actuator dynamics Revolute) SCARA robot manipulator is designed. In
and motion equations derived by using the Lagrangian addition, a gripper is placed on the last joint so that
mechanics, Alshamasin et al. [6] investigated kinematic the objects can be picked and placed at the desired
modeling and simulation of a SCARA robot by using locations. In the rst section, the usage areas of
solid dynamics by means of Matlab/Simulink. Unlike SCARA robots and the studies in the literature are
other studies, Urrea and Kern [7] implemented a mentioned. In Section 2, the forward kinematics of the
simulation of a 5-Degree-Of-Freedom (DOF) SCARA robot is obtained by using the Denavit-Hartenberg (D-
manipulator using Matlab/Simulink software. Their H) method [22]. Then, the inverse kinematic equations
study has no physical application, although it bears and Jacobian matrix are obtained by using analytical
similarity with the work we have done. This study methods. In Section 3, the experimental setup of
enjoys some advantages over these types of works, the robot is explained. In Section 4, the control and
which include only modeling and simulation. Kaleli simulation software are described. In the conclusion
et al. [8] and Korayem et al. [9] designed a program section, the results and discussion are presented.
for simulating and animating the robot kinematics
and dynamics in LabView software. Similar to these 2. Robot kinematics
works, there are various robot control, simulation, and
calculation program studies in the literature [10{20]. 2.1. Forward kinematics
While some of them are just based on the analysis and Robot forward kinematics deals with the relationship
simulation of one type of robot arms, some give results among the positions, velocities, and accelerations of
for robots in dierent types. robot joints [23]. A robot consists of links that are
SCARA robots with RRP (Revolute-Revolute- attached to each other by prismatic or rotary joints.
Prismatic) or PRR (Prismatic-Revolute-Revolute) Coordinate systems are placed to each joint to nd the
joint congurations are easy to provide linear move- transformation matrices that set the relation between
ment in vertical directions. RRP and PRR types two neighboring joints. The transformation matrix
have some advantages and disadvantages. RRP-type between the two joints is shown like i 1i T . The relation
SCARA manipulators are very common in light-duty between the base frame and the tool frame is dened by
applications that require precision and speed, which is the serial joint transformation matrices. This relation
dicult to achieve by human beings [21]. While the is called forward kinematics and shown in Eq. (1):
prismatic joint motor is only lifting the objects in RRP
type, it is lifting the whole robot structure with the 0T
N = 01 T 12 T 23 T 34 T N N1 T: (1)
objects in PRR type. Therefore, the prismatic joint
motor of PRR type has higher torque than that of The projected SCARA robot and the axes on
RRP type. Therefore, the PRR-type SCARA robot the joints are shown in Figure 1. While d3 is the
conguration is preferred in applications, where lifting length of the vertical joint, l1 and l2 are the horizontal
2 3 2 3
Table 1. D H parameters. c1 l1 + c12 l2 P1
6s1 l1 + s12 l2 7 6P2 7
i i 1 a ai 1 b i c di d O=P =6 7 = 6 7: (4)
4 d3 5 4P3 5
1 0 0 0 d3 1 1
2 0 0 1 0
3 0 l1 2 0 Eqs. (5){(7) can be easily understood from Eq. (4):
4 0 l2 0 0 P1 = c1 l1 + c12 l2 ; (5)
a i 1 : Angle between zi 1 and zi around xi 1 ;
b ai 1 : Distance between axes zi 1 and zi throughout xi 1 ; P2 = s1 l1 + s12 l2 ; (6)
c i : Angle between xi 1 and xi around zi ;
d di : Distance between axes xi 1 and xi throughout zi . P3 = d3 : (7)
2.2.1. Calculation of 1 angle
lengths of the other two joints. The length of d3 is Eqs. (5) and (6) are rearranged as follows:
calculated considering the height of the gripper. The
transformation matrices are obtained as in Eq. (2) by (c12 l2 )2 = (P1 c1 l1 )2 ; (8)
the D-H method:
(s12 l2 )2 = (P2 s1 l1 )2 : (9)
2 3 2 3
1 0 0 0 c1 s1 0 l1 Eqs. (8) and (9) are summed up together as follows:
60
0 T =6 1 0 07 6s1
1 T =6 c1 0 07
d3 5 ; 05 ;
7 7
1 40 0 1 2 40 0 1 l22 = P12 P22 + l12 2l1 (P1 c1 + P2 s1 ): (10)
0 0 0 1 0 0 0 1
Eq. (11) is obtained when b1 is used instead of (P1 c1 +
2 3 P2 s1 ):
c2 s2 0 l2
2T =
6s2 c2 0 07 (2) l22 = P12 P22 + l12 2l1 b1 : (11)
05 :
6 7
3 40 0 1
0 0 0 1 Figure 2 shows the 1 derivation illustration. Due to
the existence of b1 , v1 also can be derived by analytical
The abbreviations c and s represent the terms \cosine" methods as in Eq. (13). The variables in Figure 2 are
and \sine". The D H parameters are given in Table 1. calculated as follows:
b1 = (P1 c1 + P2 s1 ); (12)
The forward kinematic matrix is obtained through
Eq. (3) by the product of the transformation matrices. v1 = ( P1 s1 + P2 c1 ); (13)
2 3
c12 s12 0 c1 l1 + c12 l2 r2 = v12 + b21 ; (14)
6s
0 T = 6 12 c12 0 s1 l1 + s12 l2 7
7: (3)
3 4 0 0 1 d3 5 r2 = P12 + P22 ; (15)
0 0 0 1 q
v1 = P12 + P22 b21 ; (16)
2.2. Inverse kinematics
Inverse kinematics is the process of nding the values
of joint variables according to the given position and
orientation data of the end eector. In other words,
for the movement of the end eector to the desired
position, we need to nd the rotation and linear motion
values of joints by means of inverse kinematics. Any
found mathematical expression may not be a physical
solution. There may also be more than one solution
for the end eector to go to the desired position.
In other words, the robot manipulator can reach the
desired positions with dierent solutions. In this study,
the inverse kinematics solution is obtained by the
analytical method. The third column of the forward
kinematic matrix is shown in Eq. (4), and it gives the
x, y, and z position coordinates of the robot. Figure 2. Derivation illustration of 1 .
M.E. Uk et al./Scientia Iranica, Transactions B: Mechanical Engineering 27 (2020) 330{340 333
Figure 7. Open CM9.04 and 485 exp. control cards, servo motor, and pin connections.
Figure 10. (a) Main control panel. (b) Kinematic calculations interface.
moved synchronously by the simulation software. Step- motor powers can be increased to produce a commercial
per motor in the prismatic joint and servo motors in and industrial robot arm. Such a robot like this
other joints were used. Although dierent types of can be easily used in mass production lines in the
motors made it dicult to control the system, very industry, where picking and placing operations are
successful results were achieved. In future studies, the done.
338 M.E. Uk et al./Scientia Iranica, Transactions B: Mechanical Engineering 27 (2020) 330{340