Professional Documents
Culture Documents
Dynamic Behavior of A SCARA Robot
Dynamic Behavior of A SCARA Robot
Brahim Fernini
Depatement of Mechanical, Blida University, Algeria
Design, path planning and dynamic modeling for serial robots by using Solidworks (2013) and Matlab/Simulink (2012)
Nomenclature:
i1
Ai D-H transformation matrix for adjacent frames, i and i 1
Ci Cosinei
Cijk Cosineijk = cosine {(i + j ) + k }
di Distance from the origin of the ( i 1) the coordinate frame to the intersection of the Zi1 axis with the
Xi axis along Zi1 axis
ei is the position vector of the COM of link i with respect to frame i
Fi Input force for i th joint
fi Force exerted on link i by link i 1 at the coordinate frame ( Xi1, Yi1 , Zi1 ) to support link i and
the links above it
i The joint angle from Xi1 axis to the Xi axis about the Zi1 axis (using the right hand rule)
Ri 1 A 3 × 3 rotation matrix which transforms any vector with reference to coordinate frame ( Xi , Yi , Zi )
Si Sinei
Sijk
Sine ijk = sine {( i + j ) + k }
Vi Linear velocity of the coordinate system ( Xi , Yi , Zi ) with respect to base coordinate system ( X0, Y0 ,
Z0 )
i Angular velocity of the coordinate system ( Xi , Yi , Zi ) with respect to base
coordinate system ( X0, Y0 , Z0 )
1. INTRODUCTION
Pick And Place cycle is the time, in seconds, to execute the following motion sequence: Move down
one inch, grasp a rated payload; move up one inch; move across twelve inches; move down one inch;
ungrasp; move up one inch; and return to start location.
The SCARA Selective Compliant Assembly Robot Arm or Selective Compliant Articulated Robot
Arm is widely used for operations “pick-place”. The robot was called Selective Compliance Assembly Robot
Arm, SCARA. Its arm was rigid in the Z-axis and pliable in the XY-axes, which allowed it to adapt to holes
in the XY-axes.
By virtue of the SCARA's parallel-axis joint layout, the arm is slightly compliant in the X-Y
direction but rigid in the ‘Z’ direction, hence the term: Selective Compliant. This is advantageous for many
types of assembly operations: pick-place, inserting a round pin in a round hole without binding.
The second attribute of the SCARA is the jointed two-link arm layout similar to our human arms,
hence the often-used term, Articulated. This feature allows the arm to extend into confined areas and then
retract or “fold up” out of the way. This is advantageous for transferring parts from one cell to another or for
loading/ unloading process stations that are enclosed.
The SCARA robots are generally faster and cleaner than comparable Cartesian systems. Their single
pedestal mount requires a small footprint and provides an easy, unhindered form of mounting. On the other
hand, SCARA's can be more expensive than comparable Cartesian systems and the controlling software
requires inverse kinematics for linear interpolated moves. This software typically comes with the SCARA
though and is usually transparent to the end-user.
In this work, 4 axes« R-R-P-R » robot systems for operation pick and place will be designed and
developed using Solidworks program as shown in figure 1, and modeled by Matlab/Simulink as shown in
figure 2.Simulation by using MATLAB/Simulink software will be carried out. The Results of both sofwares
Figure 1. SCARA robot modeled by Solid Works Figure 2. SCARA robot modeled by Matlab/Simulink
Previous Work
The previous work [1] [2] studied the dynamic of this robot by using N-L method, but this method is
not commonly used for real time control as its need large amount of computation time and space, and the
study of the dynamic behavior is done for path created by the joint space, this last does not give the desired
trajectories like (straight line, circle,..).
Present Work
The present analysis of this robot is carried out to study the dynamics behavior for a straight line
(rest to rest path) by using N-E method. The significance of this study lies in the fact that it gives insight into
the dynamic behavior of this robot.
The direct kinematics allows us to find the relationship between the angular displacement and the
position of the end-effector, the inverse kinematics allow us to connect between two positions by a straight
line (rest to rest path).
SolidWorks and Matlab Simulink softwares are used to model and check the robot motion
simulation.
2. ROBOT KINEMATICS
4 0 0 d*
4
4*
*: joint variables
0
The expression for the end effector frame relative to the base frame is given by the arm matrix ( T4 ) as:
T40 T102T31T4 2T3, where:
c1 s1 0 l1c1 c2 s2 0 l2c2 1 0 0 0 c4 0 0
s4
s c 0ls s c 0ls 0 1 0 0 s c 0 0
T0
1 1 11
T 2
1 2 22 T 2 3
T 4 4
1 3
0 0 1 0 0 0 1 0 0 0 1 d3 0 0 d4
2 4
1
0 0 0 1 0 0 0 1, 0 0 0 1, 0 0 0 1
,
After multiplication and use of addition matrices, one gets the homogeneous transformation matrix;
c s124 0 l1c1 l2c12
124
s c 0 ls l s
T40 0124 124
0
1 1
1 d d
2 12
3 4
0 0 0 1 .
l 1 s2 l1l2 s2
Inverse solution for acceleration:
)
s (P c ) (P c P
l1cX 2s121 P
12 2y 12
12 X 12 y
(Py s1 Px c1)l1 (Py s12 Px c12)l2
1
l 1 s2 2 l1l2s2
(P c P s )l P c ) l l c
(P s l 2
y1 x111 X 12 y 12 2 12 1 2 2 2
l1l2s
2
3. ROBOT DYNAMICS
We find the dynamics equations of motion of robots by two methods:
Newton-Euler and Lagrange. The Newton-Euler method is more fundamental and finds the dynamic
equations to determine the required actuators’ force and torque to move the robot, as well as the joint forces.
Lagrange method provides only the required differential equations that determine the actuators’ force and
torque. [5]
The N-E method is based on two recursions forward and backward recursive equations. The forward
recursive equation is used for the kinematics information such as velocities and accelerations at the center of
mass of each link. The backward recursive equation is used for the forces and moments exerted on each link
from the end effector to the base of the robot.
The rotation matrices are as follows:
C0 1 S1 0 C2 S2 0 C4 S4 0
, ,
R S 1 0 0
C 0 R1 C 0 R 3 C4
2
R 0 1 0
S S ,0
1 1 1 2 2 2 4 4 3
0 0 1 0 0 1 0 0 1 0 0 1
C12
S12 0 , R0 R0 S124 0 S1 0
C124 , C
3 1
R S
0
2 R S
0
R S
1
0 C 0 C 0
C
012 1 0 1 01 0 1
2 12 4 124 124 0 1
0 0
C2 C
S2 0 , 2 12 S12 0
R S
2
C 0 R0 S C 0
1 2 2 12 12
0
0 1 0 0 1
R*3 R2 , P* l C , l S , 0T , ,l , 0T , P* 0, 0, d T
P l C S
0 0 1 111 1 2 1 12 1 12 3 3
Forward recursive:
R01 R0 0 Z 0
1 0 1 1
1 1 T
0
R0 2 R12 R011 Z0 2
2
0 1 1 2
T
0
R R 0 0 1
3
R
3 2 T
0 3 2 0 2 1 2
R R R Z
4 4 3
0 4 3 0 3 0 4
0 0
1T 1 2 4
R R Z Z
1 1
0 1 0 0 0 1 0 01
0 0 1T 1
R R R Z R Z
2 2 1 1
0 2 1 0 1 0 2 0 1 02
0 0 1T 1
2
3
R R R 0 0 1
3 2 T
0 3 2 0 2 1 2
R R R Z R Z
4 4 3 3
0 4 3 0 3 0 4 0 3 04
0 0 1T 1
2
4
R V R R p R
1 1 1 * 1
0 1 0 1 0 1 0 1
R R p R R V l ,l , gT
1 1 * 1 1 2
0 1 0 1 0 0 0 1 1 1 1
R V2 R 2 0R p
2
0 0
2
R 2
2
*
02
2
R
0 2 2
R p R R V
0
2
2
*
1
2
01
1
2
2 T
l11S 2 l11 C2 l2 1 2 ,
l l 2 S l C , g
2 1 2 1 1 2 1 1 2
R0 V3 R2 Z0
3 3
3
0 R
2
2 V R R p
0 3
3
03
3 *
2 R R Z
3 3
3 0 3 2 0 3
R R R p
3 3 *
0 2 0 3 0 3
R2 R0 V2 R R p
3 2 3 3 *
0 3 03
R0 3 R R p
3 3 3 *
0 3 0 3
2
2
T
l11S 2 l11 C2 l2 1 2 ,
l C l 2 S l , g
1 1 2 1 1 2 2 1 2
226 ISSN: 2089-4856
R04V4 R0 4
4
0 4 R p
4 *
1 1 24 1 1 24
2 1 2 4 1 2 4
1 1 24 1 1 24 2 1 2 4 1 2 4
e3 0, 0, d / 2T
e4 0, 0, 0T
R0 a1 R0 1 0 R
1 e
0 1R 0 1 R 0 1 R e
1 1 1 1 1 1
R V R V l / 2,l / 2, gT
1 1 2
0 1 0 1 1 1 1 1
R0 a2 R0 2 0 R2 e 0 R2 0 2R 02 R e
2 2 2 2 2 2
R0 V2 0 R2 V
2 2
2
2
T
R0 V3
3
R V
0 3
3
2
2
T
l11S2 l11 C2 2 l2 1 2 ,
l C l S l , g
11 2 1 1 2 2 1 2
4
R0 a4 R0 4 0 R
4
4
4
e
R R R e
4 4 4
0
4
0 4 04
R V R V
4 4
0 4 0 4
l1
1l 1 24 2 1 2 42 C 1 2 4
1 24
T
2C l
2
S l
S ,
l1 1 24 l1 1 24 2
1 2 4 2 S
1 2 4
C , g
Backward recursive:
We have: f5 n5 0
R0 f4 R5 R0 f5 m4 R0 a4 m
4 4 5 4 4
4 0R
4 a
l l
2
C ,
T
4
1 1 242C1 1 24 l 2 1 2 2 4
1 2 4
m l C
1 1
l S l
2
24
S C , g
11 24 2 1
2 4 1
2 4
3
R f
R R m R a
3 4 3
f 4 0 4
0 3
3 03 2
2
T
m l11S2 l11 C2 l2 1 2 ,
3 m4 l C l S l , g
2
1 1 2 1 1 2 2 1 2
R0 f 2 R3 R0 f3 m2 0 R
2 2 3 2
2 a
2
x l1 1
2 1 1 2
S l 2C yl
2 1 2
,
x l
2
1 1
C l S yl
2
, xg
1 1 2 2
1 2
1
R0 f1 R2 R0 f2 1m0 1R a
1
2
1
l x m / 2 yl 2 C T
2
2
1 1
1 2 1 2
,
1 2 S2
l x
m / 2
1 1 1 , x m g
1
2
yl2 1 2 S2 1 2 C2
x m2 m3 m4
y m2 / 2m3 m4
The moments exerted on the links:
R n R R n R p R f
4
0 4 5
4
5
0 5
5 *
0 4
5
05
4
R0 p4 R0 e4 m4 R0 a4
* 4
4
J 40 4R
4
R J
4
4
R
0
4 4 04
J Ri I R0
i 0 i i
i 1, 2, 3, 4
Generally, the mass and the length of link (4) are very small in comparison to other links; the inertia of link
(4) is evaluated to be zero.
R044n 0
Rn R R n R p R f
3
0 3
3 4
4 0 4
4 *
0 3
4
0 4
3 *
R p0 3 R e0 3 m R3 a0
3
3
J
3
3
303 R
R
J
3
d3 m2 m4
0 3 /2 3 R ml
3
03
3 3
l
C l S l
2 , T
1 1 2 1 1 2 2 1 2
l S l 2C l 2 , 0
1 2 2 1 1 2 2 1 2
R n
2
R
2
R 3n
3
p* R 3
f
0 2 3 0 3 R 0 2 0 3
2
p * R e
2
m R a
2
J
2
R
0 2 0 2 2 0 2 R 2 0 2
R 0 2 J 2 R
2
2
0 2
l l S
2
l T
C
1 1 2 1 1 2
2 1 2
,
l 1 2 2 l 1
2
1 2 l 2
1 2
2
lgy,
2
C2
ly
l l S l 2
C
2 1 1 2 1 1 2 2 1 2
d 2 m 3 m 4 d 3 m 3 m 4 m 3 l3 / 2
m2 /3 m3 m4
1 1
R
R n
R2
R 2
p
*
R 2
f
1 0 n 0 2 0 1 0 2
R 1
0 p 1
*
R 0e 1
1
mR a 1
1
0 1
J R1 0
1
1
R 10 1
1
R 01 1
J
l 1 1 l2 2 C 2
1 l gy S ,
l
2 2
2
S
2 1 2 2
1 1 2 1 2 2 2 1 2 2 2
l 2 l
l C
S
l2g x yC 2 m1 / 2 ,
/ 3 l 2 l l C
2
l2 x y
m 1 2
l l
1l
C y 2
l
l S
1 2 y 2 2 1
2 1 2 2 2 1 2 2 2 1 2
The joint torque of link (1):
l 2
xm / 3
R n R
T
1 1
1 1
1
Z
l 2ll C y
2
1 0 1 0
0
l l l S y 2
2 1 2 2
2
ll C y
2 1 2 2 2
1 2 2 2 1 2
Figure 3. The trajectory generation of a SCARA robot with Matlab/Simulink by using inverse kinematics
Trajectory simulation:
Elbow down
Elbow up
0.5 2
elbow down
elbow down elbow up
elbow up
1.5
0
1
joint velocity (rad/sec)
-0.5
joint velocity(rad/sec)
0.5
-1
0
-1.5
-0.5
-2 -1
-1.5
-2.5
0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1
time(sec) -2
0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1
time(sec)
131 131
angular velocity (deg/sec)
angular velocity(deg/sec)
99
99
66
66
Elbow up: 33
0
0.00 0.10 0.20 0.30 0.40 0.50 0.60 0.70 0.80 0.90 1.00
time (sec)
131 131
A ngular Ve locity5 ( deg/sec)
Angular Velocity4 (deg/sec)
0
0.00 0.10 0.20 0.30 0.40 0.50 0.60 0.70 0.80 0.90 1.00
time (sec)
99
99
66
66 33
0
33
0.000.100.200.300.400.500.600.700.800.901.00 0.00 0.10 0.20 0.30 0.40 0.50 0.60 0.70 0.80 0.90 1.00
Time (sec) Time (sec)
0
Figure 12. Link (1) Figure 13. Link (2)
IJRA ISSN: 2089-4856 231
The results obtained by the two softwars Matlab/Simlulink and Solidworks about the joint velocity and the
angular velocity show us that the velocity constraint is verified at initial and final points by the two
softwares,
The similarity of results of both softwars Solidworks and Matlab/Simulink confirms the reliability of the
kinematic model. The SCARA robot achieved a straight line motion between two positions with respect the
constraints position and velocity.
0.8
0.6
0.4
0.2
Y(m)
-0.2
-0.4
-0.6
-0.8
-1
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6
X(m)
Figure 14. Arbitrary change of the two links of SCARA robot (elbow up and elbow down)
Y
Y
-0.1
-0.6
-0.2
-0.8 -0.3
-0.4
-1 Z
-0.5
Y (m )
Y(m)
-1.2 -0.6
-0.7
-1.4
-0.8
-0.9
-1.6
-1 Z
X
-1.8 1.4 1.6 1.8 2 2.2 2.4 2.6
X -1.1
X(m)
1.2 1.4 1.6 1.8 2 2.2 2.4 2.6
X(m)
200
Trquevariations (N.m)
100
-100
-200
-300
-400
0 0.2 0.4 0.6 0.8 1
time (sec)
6. DISCUSSION:
The dynamic equations found by N-E method show that there is no coupling between the link2 and
the link3 because the link3 has only motion in vertical direction and there is no torque acting for this link
there is only a force to achieve the vertical motion. For these reasons the effective mass can be added to the
link1 and the link2 while determining the torques. This fact is clear from the torque equations. And it’s found
the torques are independents of angular positions and this makes the robot very compliant. Another fact that
the joint torques are independent by the lengths of link3 and 4,they are dependent only by their masses as
shown the torque equations.
The torques time analysis for SCARA robot is carried out taking the link masses of link 1, link2,
effective mass are: 16.92Kg, 16.92Kg, 2Kg respectively .The fig.17 illustrates the variations of torques with
time of elbow up and elbow down. It’s found the magnitude of the torque of link 1 is higher than the torque
requirement for link 2. There is an increasing difference in the two torques as time increased for elbow up
and elbow down.
The following table shows the torques value at T=0s and T=1s.
Table 2. The torque values at T=0s and T=1s for elbow up and elbow down
Elbow up Elbow down
Time(sec) Torque Torque Torque Torque
(N.m) Link1 (N.m) (Link2) (N.m) (Link1) (N.m) (Link2)
T=0s -116.0985 -83.5574 -362.0553 -66.9041
T=1s 362.0553 66.9041 116.0985 83.5574
The torques of link1 and link2 of elbow down are symmetric with the torques of link1 and link2 of elbow
down respectively, this fact is clear from the results of the table2 and the figure 17.
The results obtained from the table2 and accordingly the figure 17 show that energy consumption is the same
for elbow up and elbow down for this operation, in which means elbow up and elbow down swept the same
area as shown in figure 14.
7. CONCLUSION
The use of both softwares SolidWorks and Matlab/Simulink permitted to us to qualitatively develop
and highlight the relevance of the studied of the kinematic model of SCARA robot.
From the dynamic model by using N-E, it’s found that the effective mass can be added to the link1 and the
link2 while determining the torques, and there is no coupling between link 3 and link2.Another fact the
torques are independents of angular positions and the masses of link3 and link4 and this makes the robot very
compliant.
In our case, we can conclude depending from the dynamic analysis by N-E the choice of elbow
down or elbow up is the same for this operation “pick-place” with straight line while respecting the
constraints, because the final energy balance is the same.
REFERENCES
[1] Mohamed Salah Khireddine and Abdelhalim Boutarfa, Reconfigurable Control for a SCARA Robot using RBF
Networks, Journal of Electrical Engineering, VOL. 61, NO. 2, 2010, 100–106.
[2] Philip Voglewede, Anton H.C. Smith, and Antonello Monti Dynamic Performance of a SCARA Robot Manipulator
With Uncertainty Using Polynomial Chaos Theory, IEEE Transactions on Robotics, Vol. 25, No. 1, February 2009.
[3] Z. Robot modeling and control, JOHN WILEY & SONS, INC. New York, Chichester, Weinheim, Brisbane,
Singapore, Toronto, page 97.
[4] Brahim Fernini, Mahmoud Gouasmi, M’hamed Meghatria, Kinematic Modeling and Simulation of a 2-R Robot by
Using Solidworks and Verification by Matlab/Simulink. International Journal of Advanced Robotic Systems.
[5] Reza N Jazar, Theory of applied robotics, Kinematics, Dynamics, and control, second edition springer, path
planning, ISBN 978-1-4419-1749-2.