Scara Robot
Scara Robot
Scara Robot
Theverificationoftheobtainedresultsbybothsoftwares
allows us to qualitatively evaluate and underline the
validityof the chosen model and obtain the right
conclusions. The results of the simulations are discussed
andanagreementbetweenthetwosoftwaresiscertainly
obtained.
Int JBrahim
Adv Robotic
2012,
Vol. 9,Meghatria:
245:2012
Mahmoud Gouasmi, Mohammed Ouali,
FerniniSy,
and
Mhamed
Kinematic Modelling and Simulation of a 2-R Robot Using SolidWorks and Verification by MATLAB/Simulink
1.Introduction
Roboticsisaspecialengineeringsciencewhichdealswith
robot design, modelling, controlling and utilization.
Nowadaysrobotsaccompanypeopleineverydaylifeand
have taken over some of their daily procedures. The
rangeofrobotutilizationisverywide,fromtoysthrough
to office and industrial robots, through to very
sophisticatedonesneededforspaceexploration.
Amanipulationtaskisusuallygivenintermsofadesired
endeffector trajectory. Since the manipulator is
controlledbyjointservos,amappingfromthetaskspace
to the joint space is required. Trajectory planning
convertsadescriptionofadesiredmotiontoatrajectory
definingthetimesequenceofintermediateconfigurations
of the arm between the origin and the final destination.
An effective approach to the motion control problem for
roboticmanipulatorsisthesocalledkinematiccontrol.
Thepossibilitytoperformrealtimesimulationsbecomes
particularly important in the later stages of the design
process. The final design can be verified before one
embarks on the costly and time consuming process of
buildingaprototype[4].
Inthiswork,atwoaxis2Rrobotsystemforapickand
place operation will be designed and developed using
the SolidWorks program and MATLAB/Simulink
simultaneouslyasshowninFigure1andFigure2.
Figure1.A2RrobotusingSolidWorks
Thestructurewillbebuiltdependingontheprinciplesof
solidbodiesmodellingwithSDtechnology[8,9].
CS2
B
CS3
Revolute1
Pice1000-2
CS2
Weld1
CS3
CS2
Pice4-3
CS3
CS4
Cylindrical
Pice1000-1
B
Revolute
CS2
Env
CS3
B
RootGround
F
Weld2
CS3
CS2
RootPart
Pice2-1
F
Weld
Figure2.Thesame2RrobotmodelledinMATLAB/Simulink
2.Robotkinematicsanddynamics
2.1Forwardkinematics
ConsiderthetwoDOFplanarredundantmanipulatoras
shown in Figure 3 where the joints axes are assigned
based on the DenavitHartenberg representation (Table
1). The manipulator moves in a vertical plane so the
gravityforceisincludedinthenumericalsimulation.
Link
ai
di
l1
1*
l2
2*
Table1.DHparametersofthe2Rrobot
The(4x4)rigidtransformationmatricesare:
Forthefirstlink:
c1 s1
s
c1
T10 1
0
0
0
0
0 l1c1
0 l1s1
(1)
1 0
0 1
andthesecondlink:
Figure3.DHparametersofthetwojoint2Rrobot
www.intechopen.com
c2
s
T21 2
0
s2
c2
0
0
0 l2c2
0 l2 s2
(2)
1 0
0 1
We can then
n get the overrall manipulattor transformaation
matrix:
c12
s
T20 12
0
s12
c12
0
0 l1c1 l2c12
0 l1s1 l2 s12
(3)
1
0
0
1
nematicsoftherobot
2.2Inversekin
p
x
c1
py
oX
aX
oz
az
oy
ay
pX
py
(4)
pz
1
s1 (l1 l2 c2 ) py l2 s2 px
(17))
pX2 p y2
c1
c1 (l1 l2 c2 ) px l2 s2 py
(18))
pX2 py2
Thefinalequ
uationrepresen
ntingtherobo
otis:[10]:
T20 THR (5)
andfinallywehaave:
1 a tan
variable 2 :
Forthejointv
Weget:
( l1 l2 c2 ) p y l2 s2 px
s1
a tan
n
(19))
c1
( l1 l2 c2 ) px l2 s2 py
Theanglesforelb
bowupare:
2 a tan
Wethenhavee:
1 a tan
c2
1
( p 2 py 2 l12 l22 ) (8)
2l1l2 X
s2 1 c2 2 (9)
2 a tan
s2
(10)
c2
Thejointvariiable 1 :
l2 s2
(16))
l1 l2 c2
s1
Thedesiredllocationofthee2Rrobotis givenbythe((4x4)
matrix:
nX
ny
THR
nz
0
px
(15))
py
l l c
1
2 2
s1
l2 s2
s2
(20))
c2
(21))
andtheanglesforrelbowdown
nare:
2 a tan
1 a tan
s2
(22))
c2
px l2 s2 py (l1 l2c2 )
px ( l1 l2 c2 ) ( py l2 s2 )
(23))
Rearrangingequation(6)aandequation((7)yields:
Solvingequaations(11)and
d(12)byCram
mersrule:
l l c
1 2 2
l2 s2
l2 s2
2
2
(l1 l2 c2 ) (l2 s2 ) (13)
l1 l2c2
andwehave:
Figu
ure4.Thetwop
posturesofthe22Rrobot
www.intechopen.com
2.3Robotdynamics
2.3.1Kineticenergy
K1
1
m l 2 2 (24)
2 11 1
2.3.3Jointstorques
Figure6.Thehomepositionofthe2Rrobot(twopostures):
MATLAB/Simulink
Figure7.Thehomepositionofthe2Rrobot(twopostures):
SolidWorks
Startingfromagiveninitialposition,i.e.,
pX 2 ; p y 0
Toadesiredposition,i.e,
pX 0.86 ; p y 1.5
The equations of movement for the borrowed path for
elbowdowntoreachthedesiredpositionsaregivenby
thetwofollowingchosenpolynomials[11]:
Figure5.Link:massparameters
www.intechopen.com
NB:Anotherexampleoftrajectorygenerationisgivenin
theAppendixattheendofthispaper.
3.1.1Theresultingpath
Wemaycheckthepath:
Applying the relations (20), (21), (22) and (23) in (6) and
(7)wecanobtainthefollowingtable:
Elbowdown
time(sec)
Elbowup
Theta1(deg) Theta2(deg)
pX (m)
py (m)
Theta1(deg) Theta2(deg)
pX (m) py (m)
0.11
0.015
1.99
0.004
0.126
0.015
1.99
0.004
0.49
0.16
1.99
0.02
0.65
0.16
1.99
0.02
1.25
0.67
0.05
1.92
0.67
0.05
2.49
1.92
1.996
0.12
4.41
1.92
1.996
0.12
4.37
4.37
1.98
0.21
8.75
4.37
1.98
0.21
7.05
8.64
1.95
0.39
15.69
8.67
1.95
0.39
10.73
15.43
1.88
0.62
26.16
15.43
1.88
0.62
15.61
25.6
1.71
0.927
41.21
25.6
1.71
0.927
20
40.09
1.44
1.20
59.04
40.09
1.44
1.20
30
60
0.86
1.5
90
60
0.86
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
1.5
Table2.Thepositionforthetwoposturesduring1s
6
www.intechopen.com
3.1.2CheckingthetheoreticalresultsofTable2using
SolidWorksandMATLAB/Simulink
Att=0.5s
Elbowdown;
Figure12.Elbowup(SolidWorks)
andatt=1s
Elbowdown;
Figure9.Elbowdown(MATLAB/Simulink)
Figure13.Elbowdown(MATLAB/Simulink)
Figure10.Elbowdown(SolidWorks)
Elbowup:
Figure14.Elbowdown(SolidWorks)
Elbowup;
Figure11.Elbowup(MATLAB/Simulink)
www.intechopen.com
Figure15.Elbowup(MATLAB/Simulink)
3.1.4Thedisplacementofcentreofgravityforthetwopostures
Figure16.Elbowup(SolidWorks)
P o s itio n d u c e n t re d e g r a v it 1 ( m m )
482
ThejointvariablesexpressedinMATLAB/Simulinkarein
radians.
3.1.3Individualchangeofpositionofthetwolinksforthe
twoposturesduring1s.
351
221
91
-39
0.00
0.30
0.40
0.50 0.60
Dure (sec)
0.70
0.50 0.60
Dure (sec)
0.70
0.50 0.60
Dure (sec)
0.70
0.80
0.90
1.00
P o s i ti o n d u c e n t r e d e g r a v i t 2 ( m m )
1501
1223
946
669
392
0.00
Figure18.Elbowup
NOTE1:Theresultsobtained,whetherusingSolidWorks
or MATLAB/Simulink, are exactly the same. This
similarity of results confirms the reliability of the
kinematicmodel.
0.10
0.20
0.30
0.40
0.80
0.90
1.00
Figure22.link2(x)elbowup
P o s i ti o n d u c e n t r e d e g r a v it 1 ( m m )
Figure17.Elbowdown
0.20
Figure21.Link1(x)elbowup
WecantakeadvantageofthisanalysisusingSolidWorks
to study the behaviour of the robot for the two postures
to establish an energetic balance comparative to these
postures.
0.10
589
461
332
204
76
0.00
0.10
0.20
0.30
0.40
0.80
0.90
1.00
Figure23.Link1(y)elbowup
www.intechopen.com
1320
1002
685
367
291
237
184
130
76
0.00 0.10 0.20 0.30 0.40 0.50 0.60 0.70 0.80 0.90 1.00
Dure (sec)
49
0.000.10 0.20 0.300.40 0.50 0.600.70 0.80 0.90 1.00
Dure (sec)
Figure27.Link1(y)elbowdown
Figure24.link2(y)elbowup
482
471
460
450
998
761
524
287
49
0.00 0.10 0.20 0.30 0.40 0.50 0.60 0.70 0.80 0.90 1.00
Dure (sec)
Figure28.Link2(y)elbowdown
439
0.00 0.10 0.20 0.30 0.40 0.50 0.60 0.70 0.80 0.90 1.00
Dure (sec)
Figure25.Link1(x)elbowdown
3.1.5Simulationofdynamicmodel
1501
1343
1185
1027
869
0.00 0.10 0.20 0.30 0.40 0.50 0.60 0.70 0.80 0.90 1.00
Dure (sec)
Figure26.link2(x)elbowdown
www.intechopen.com
Figure29.Kineticenergy
Figure30.Potentialenergy
variationofthetotalkineticenergycalculatedforposture
elbowdownwith: K 243.02 J
The variation of the total potential energy calculated
according to posture elbow up is higher than the
variation of the total potential energy calculated
accordingtopostureelbowdownwith: V 82.95 J .
NOTE4:Therobotconsumesmuchmoreenergywhenit
isrequestedtoworkaccordingtoelbowup,forthesame
trajectory and the same desired position according to
elbowdown;[10][11][12]
4.Conclusion
Figure31.Jointtorque(1)
Figure32.Jointtorque(2)
NOTE3:Comparisonbetweenthetwopostures:
Wenoticefromthesimulationresultsthat:
Thiscanbeeasilyjustifiedwhenbearinginmindthatthe
effect of different combinations of the two angles will
playamajorroleindeterminingthevalueofthepotential
energy of thesecond link, and the potential energy of a
linkwillplaythegreatestroleindeterminingthetorque
valueofthatlink.
Inourcase,wecanconclude(dependingontheobtained
results by the comparative analysis of the two postures)
that the dissipated energies during the movement of the
robot according to the first posture (elbow down) are
lower than those which would be dissipated if the robot
performsthemovementaccordingtothesecondposture
(elbow up), and this is for the same trajectory and the
same duration according to the presentations listed
above.Seenotes1,2,3and4.
www.intechopen.com
Appendix
qd
[4x4]
qdd
le two link
jtraj
2
T2xyz
[4x4]
XY Graph
fkine
Figure33.Trajectorygenerationof2RrobotwithMATLAB/Simulink
Figure34.Simulationblocktocalculatethetrajectory
Sometrajectoriesobtainedinthedisplacementsofthetwoposturesforthesamedesiredpositionduring1s:
Elbowup:[11]Elbowdown:[11]
www.intechopen.com
11
Simulationofthemotion
(a)(b)
Figure35.(a)Elbowup(MATLAB/Simulink);(b)Elbowup(SolidWorks)
(a)(b)
Figure36.(a)Elbowdown(MATLAB/Simulink);(b)Elbowdown(SolidWorks)
5.References
[1] P. Sorenti, 1997. Efficient Robotic Welding in
Shipyards Virtual Reality Simulation Holds the
Key,IndustrialRobot,24(4),pp.278281
[2] M.T. Das and L.C. Dulger, 2005. Mathematical
modelling,
simulation
and
experimental
verificationofascararobot,SimulationModelling
PracticeandTheory13,pp.257271
[3] O. Michel, 2004. Professional Mobile Robot
Simulation, International Journal of Advanced
Robotic Systems, Vol.1, No.1, pp.3942 ISSN 1729
8806.
[4] A. Kazi, G. Merk, M. Otter and H. Fan, 2002.
Designoptimizationofindustrialrobotsusingthe
Modelica multiphysics modeling language,
Proceedings of the 33rd ISR (International
SymposiumonRobotics)October711.
12 Int J Adv Robotic Sy, 2012, Vol. 9, 245:2012
20002002,No.2526,ISBN3000115838,pp.168
177.
[9] F. Ionescu, 2007. Modeling and Simulation in
Mechatronics, IFAS inter.confer.MCPL2007, Sep.
pp.2629,Sibiu,Romania.
[10]John Wiley & Sons, Inc. Robot modeling and
control. New York / Chichester / Weinheim /
Brisbane/Singapore/Torontopage97
[11]R. N. Jazar, 2009,Theory of applied robotics
(kinematics, dynamics and control) second edition
www.intechopen.com
13