Professional Documents
Culture Documents
Two Joint PDF
Two Joint PDF
Y. D. Patel1, P. M. George2
1
Associate Professor, Department of Mechanical Engineering, A. D. Patel Institute of Technology, New Vallabh
Vidyanagar, Gujarat, India, yash523@rediffmail.com
2
Professor, Department of Mechanical Engineering, Birla Vishvakarma Mahavidyalaya Engineering College, Vallabh
Vidyanagar, India, pmgeorge02@yahoo.com
Abstract
Forward and inverse kinematic analysis of 2DOF robot is presented to predict singular configurations. Cosine function is used for
servo motor simulation of kinematics and dynamics using Pro/Engineer. The significance of joint-2 for reducing internal singularities
is highlighted. Performance analysis in terms of condition number, local conditioning index and mobility index is carried out for the
manipulator. Dynamic analysis using Lagrangian’s and Newton’s Euler approach is worked out analytically using MATLAB and
results are plotted for their comparison.
Index Terms: Forward kinematics, Inverse Kinematics, Workspace boundary, Singularity, Dynamics
-----------------------------------------------------------------------***-----------------------------------------------------------------------
__________________________________________________________________________________________
Volume: 02 Issue: 09 | Sep-2013, Available @ http://www.ijret.org 77
IJRET: International Journal of Research in Engineering and Technology eISSN: 2319-1163 | pISSN: 2321-7308
L θ
1 0 0
x L cosq L cos q q
2 0 0
C S 0 L C C S 0 L C
(1)
y L sinq L sin q q
S C 0 L S S C 0 L S
,
T ' + T ' +
(2)
0 0 1 0 0 0 1 0
0 0 0 1 0 0 0 1
Joint ranges are constrained for the manipulator analysis in the
C S 0 L C L C
present case as,
S sinθ
C cos θ θ
In matrix form,
and q represents joint rates. For a rotational joint the analytic a Space
Inverse Kinematics
Space
geometric jacobian are different. Jacobian matrix represents
the relationship between rates of change of pose with respect
to joint rates. Rank deficiency of jacobian represents
singularity. Fig -3: Kinematic Mapping
3. INVERSE KINEMATICS
R P
The pose of the robot manipulator H / 1 is known and
Rate of change Rate of change
0 1
Jacobian
of Cartesian of joint position
pose the joint variables need to be identified for a pose. The
geometric solution of the inverse kinematics are summarized
2.1 DH parameters of 2DOF arm in the form of,
x y L L
cosq
2L L
y L cosq L x L sinq
tanq
x L L cosq yL sinq
q J4 X
C / L S S / L S
J4 ! "
L C L C /L L S L S L S /L L S
Fig -2: Frame attachment for Two DOF planar manipulator
__________________________________________________________________________________________
Volume: 02 Issue: 09 | Sep-2013, Available @ http://www.ijret.org 78
IJRET: International Journal of Research in Engineering and Technology eISSN: 2319-1163 | pISSN: 2321-7308
Norm aliz ed m u
joint angles. Multi valued inverse mapping and redundancy
0.5
are common problems with inverse kinematic.
4. PERFORMANCE MEASUREMENT 0
0.6
Manipulability measures the effective robotic pose for object 0.4 0.4
0.2 0.2
manipulation with in workspace. The term was proposed by 0 0
-0.2
Yoshikawa [10] and manipulability index (μ is defined as, y (m)
-0.2 -0.4
x (m)
600
Fig -5: Variation of condition number and mobility index
Condition number
400
with respect to time
__________________________________________________________________________________________
Volume: 02 Issue: 09 | Sep-2013, Available @ http://www.ijret.org 79
IJRET: International Journal of Research in Engineering and Technology eISSN: 2319-1163 | pISSN: 2321-7308
x
1.5
cos(360*x/T)
]x `
i \x _
1
τ g c i 0 c
/τ 1 ! "\ _
g c i 0 c i \xZ _
0.5
\xW _
Amplitude
0 cos(360*x/T)-1
-0.5 0 100 200 300 400 [xV ^
-1
The inertia matrix of 2 DOF robot arm is symmetric and
-1.5 positive definite and its elements are,
i i
! "
-2
i i
cos(360*x/T)+10
-2.5
Angle (deg)
T=2
i m aa m a aa 2a a a C I I
Where,
i m aa a aa C I
i m aa a aa C I
Fig -6: Cosine function with horizontal and vertical offset
5. DYNAMIC ANALYSIS i m aa I
The dynamic behavior of manipulator is described in terms of The inertia has maximum value for fully extended arm.
the time rate of change of the robot configuration in relation to The elements of centripetal and coriolis matrix,
c c 2m a a a S xW m a aa S xW
the joint torques exerted by the actuators. Hence, the resulting
/c c 1 ! "
m a aa S x 0
equation of motions represents such relationship in form of set
of differential equations that govern the dynamic response of
the robot linkage to input joint torques. Dynamic model for
two DOF robot using Newton’s Euler approach, the dynamic Entries of gravitational terms are,
g m ga a C m g a C aa C
equations are written separately for each link. Equations are
/g 1 ! "
m ga a C
evaluated in numeric or recursive manner. In this case, the
M q . qL C q, qL . q g(q) f q τM
When arm is fully extended in the x-direction, the effect of
gravitational moment becomes maximums. The closed form
dynamic equations of n-degree-of-freedom robot in the form
q Joint displacements
Where, of,
q Joint velocities e e e
τ i i x c c x g
/g 1 Xx Y
sum of torques is equal to variation of angular momentum.
/τ 1 ! " /x 1 /c c 1 /x W 1
i i
The total energy stored in each link is represented as,
V
1 1
τ- c i m- |Va- | Iω l
2 2 - -
Where,
-;
qL x qL xV
q x q xW
q x q xZ
The resulting expression as same as obtained using Newton’s
Euler approach. Lagrangian formulation is simpler than
Newton’s Euler approach.
__________________________________________________________________________________________
Volume: 02 Issue: 09 | Sep-2013, Available @ http://www.ijret.org 80
IJRET: International Journal of Research in Engineering and Technology eISSN: 2319-1163 | pISSN: 2321-7308
Theta-1 (degree)
The case of 2-DOF serial manipulator under consideration has 130
following mass properties,
80
Link1 30
Material Properties: steel (AISI 1045) -20
Poisson’s ratio: 0.27 at 25˚C 0 1 2 3 4 5 6 7 8
Length L = 0.2 m
Density: 7.827×10 kg/m3
Link2 90
Theta-2 (degree)
Material Properties: steel (AISI 1045)
70
Poisson’s ratio: 0.27 at 25˚C
Length L = 0.15 m
Density: 7.827×10 kg/m3
Mass m = 0.82658 kg
10
-10
0 1 2 3 4 5 6 7 8
Inertia with respect to coordinate system attached at base Time (sec)
(tonne. m2)
2.1817 n 10 ,
0 0
m 0 2.0030 n 10 ,
0 o
0
0 0 2.0405 n 10 ,
0 1 2 3 4 5 6 7 8
-100
300 3480.589
X_component of acc. P3
200 2480.589
Acceleration-a1
(deg/sec2)
100 1480.589
(mm/sec2)
0 480.5898
-100 0 1 2 3 4 5 6 7 8
-519.410
0 2 4 6 8 10
-200
-1519.41
-300
Time (sec) -2519.41
150
2727.662
100
Acceleration-a2
Y_component of acc. P3
1727.662
(deg/sec2)
50
727.6619
(mm/sec2)
0
-50 0 -272.338
1 2 3 4 5 6 7 8 0 2 4 6 8 10
-100 -1272.33
-150 -2272.33
Time (sec)
-3272.33
respect to time Fig -8: Variation of velocity and acceleration of point P with
respect to time
1451.354
X_component of Vel.
951.3543 200000
of P3 (mm/sec)
Lagrangian
Torque (N-mm)
451.3543
100000 Newton_Eule
-48.6456
-548.645 0 2 4 6 8 10
0
-1048.64 0 2 4 6
Time (Sec)
-100000
Time (Sec)
1240.171 Lagrangia
150000
Y_component of Vel.
50000
240.1715
0
-259.828 0 2 4 6 8 10 -50000 0 2 4 6
-759.828 Time (Sec)
Time (Sec)
100
2-DOF Planer Robot Using Artificial Neural Network, World
Academy of Science, Engineering and Technology, Vol. 81,
0 pp. 282-285, 2011
-400 -200 -100 0 200 400 [3]. Denavit, J. & Hartenberg, R. S., “A kinematic notation for
lower-pair mechanisms based on matrices”, Journal of
-200 Applied Mechanics, Vol., 1, pp. 215-221, 1955
x_P3 (mm)
[4]. Tarcisio A.H. Coelho, Liang Yong, Valter F.A. Alves ,
“Decoupling of dynamic equations by means of adaptive
balancing of 2-dof open-loop mechanisms”, Mechanism and
x_y_10 Machine Theory 39, (2004), 871–881
400 [5]. B.K. Rout, R.K. Mittal, “Parametric design optimization
300 x_y_20 of 2-DOF R–R planar manipulator- A design of experiment
y_P3 (mm)
__________________________________________________________________________________________
Volume: 02 Issue: 09 | Sep-2013, Available @ http://www.ijret.org 83
IJRET: International Journal of Research in Engineering and Technology eISSN: 2319-1163 | pISSN: 2321-7308
BIOGRAPHIES
Y.D Patel is working as Associate
Professor in Mechanical Engineering
department of A D Patel Institute of
Technology, New Vallabh Vidyanagar
Gujarat.
__________________________________________________________________________________________
Volume: 02 Issue: 09 | Sep-2013, Available @ http://www.ijret.org 84