Two Link Planar Robot Manipulator Mechanism Analysis With MATLAB
Two Link Planar Robot Manipulator Mechanism Analysis With MATLAB
net/publication/340538754
CITATIONS READS
4 7,615
2 authors:
Some of the authors of this publication are also working on these related projects:
Optimization of effective process parameters for improved mechanical properties and surface roughness of additive manufactured (FDM) product of polymer-metal hybrid
materials View project
All content following this page was uploaded by Pushkal Badoniya on 19 April 2020.
Abstract: Kinematic and dynamic modeling of serial robot manipulator is a challenging task but To obtain the best performance
of the system, the study of the kinematic and dynamic mechanism of the system is essential. In order to study and analyze the
kinematic and dynamic interaction of each link for various configurations, planar robot manipulator is used as a simplified
model for kinematic and dynamic analysis.
In this paper, the mathematical equations for kinematic and dynamic modeling of two link planar robot manipulator having two
revolute joints are derived and equations are analyze by obtaining MATLAB code. The kinematic analysis is the relationships
between the positions, velocities, and accelerations of the links of a manipulator and dynamic analysis is the relationship
between force and motion generate on the joints and links. The kinematics separate in two types, forward (direct) kinematics
and inverse kinematics and this same for dynamics also but my focus is on to formulate and analyze forward kinematics and
dynamics only. In forward kinematics, the length of each link and the angle of each joint is given and we have to calculate the
position of any point in the work volume of the robot. In dynamic analysis, to be able to control a robot manipulator as required
by its operation, it is important to consider the dynamic model in design of the control algorithm and simulation of motion. The
mathematical equations for kinematics and dynamics of two link planar robot manipulator based on the Denavit-Hartenberg (D-
H) framework and Newton-Euler formulation are derived. MATLAB code in the form of several M-files are developed for
kinematics and dynamics analysis of two link planar manipulator and results are plotted in the form of graphical representation.
Keywords: D-H coordinate, link, planar, torque, joints
I. INTRODUCTION
Robotics is a relatively young field of modern technology that crosses traditional engineering boundaries. Understanding the
complexity of robots and their applications requires knowledge of electrical engineering, mechanical engineering, systems and
industrial engineering, computer science, economics, and mathematics. New disciplines of engineering, such as manufacturing
engineering, applications engineering, and knowledge engineering have emerged to deal with the complexity of the field of robotics.
The science of robotics has grown tremendously over the past twenty years, fuelled by rapid advances in computer and sensor
technology as well as theoretical advances in control and computer vision. At the present time, the vast majority of robot
applications deal with industrial robot arms operating in structured factory environments so that a first introduction to the subject of
robotics must include a rigorous treatment of the topics in this text.
The industrial robot manipulator can be considered as an open chain mechanism consisting of rigid links and joints. The problem of
finding efficient tools to analyse the rigid body motions in space has long been on the agenda of physicists and mathematicians and
is considered to be a well-researched and well-understood problem. Robotics, computer vision, graphics, and other engineering
disciplines require concise and efficient means of representing and applying generalized coordinate transformations in three
dimensions. Robotics requires systematic ways to analyse the kinematics and dynamics of manipulators. A number of different
simulation packages have been developed. However, with the advent of high-speed computers and their application to the
generation of animated graphical images and control of robot manipulators, new interest arose in identifying compact and
computationally efficient mathematical equations.
C. Manipulator Dynamics
The dynamic behaviour is described in terms of the time rate of change of the robot configuration in relation to the joint torques
exerted by the actuators. This relationship can be expressed by a set of differential equations, called equations of motion, that govern
the dynamic response of the robot linkage to input joint torques. The problem of dynamics analysis has been investigated as found
in many literatures.
Silver (1982) shows that there was in fact no fundamental difference in computational efficiency between Lagrangian and Newton-
Euler formulations. The efficiency of the above-mentioned Newton-Euler formulation was due to two factors: the recursive structure
of the computation and the representation chosen for the rotational dynamics. Both of these factors can be achieved in a Lagrangian
formulation. This paper compares the representations that had been used and shows that with a proper choice the Lagrangian
formulation was indeed equivalent to the Newton-Euler formulation. Featherstone et al (2000) reviewed some of the
accomplishments in the field of robot dynamics research, from the development of the recursive Newton-Euler algorithm to the
present day. Equations and algorithms were given for the most important dynamics computations, expressed in a common notation
to facilitate their presentation and comparison. Saha et. Al (2006) proposed to simplify the robot's dynamic coupling by suitably
choosing the manipulator‘s kinematic and dynamic parameters. The intention was to make the Generalized Inertia Matrix (GIM) of
the serial manipulator associated with its dynamic equations of motion diagonal and/or constant. Such choice automatically ensures
the associated convective inertia terms vanish. Such simplifications were carried out by investigating the expression of each element
of the GIM. The concepts of the twist propagation matrices and the joint motion propagation vectors were used to obtain the
analytical expressions of the GIM elements that allow one to investigate the elements for simplifications. The methodology is
illustrated with a 3-link spatial manipulator arm. Ata et al. (2013) presented in this paper an implementation of Newton-Euler to find
equations of motion for any general multi-axis robot giving only rotational configurations was introduced. The program was verified
for a 3 Degree-of-Freedom robot. The robot equations of motion are obtained from the implemented program and verified against
those obtained using only Newton equation. The output of program for the 3 DOF robot was used to find the optimal torque using
analytical optimization analysis for a given set of parameters.
Figure 4.1: D-H parameters and frame assignments for the two link planar robot
Figure 4.2: Geometric solution approach for two link planar robot manipulator
So for linear velocity of end effector point P, we differentiate linear displacement of end effector frame point P with respect to the
base frame is :
. .
v px = - l1sθ1.θ1 - l2sθ12 .θ12
. .
v py = l1cθ1.θ1 + l2cθ12 .θ12
Similarly for linear acceleration of end effector point P, we differentiate linear velocity:
.. ..
a px = - l1cθ1.θ 12 - l1sθ1.θ1 - l2 cθ12 .θ 12
2
- l2 sθ12 .θ12
.. ..
a py = - l1sθ1 .θ 12 + l1cθ1.θ1 - l2sθ12 .θ 12
2
+ l2cθ12 .θ12
displacement in y-direction of end effector. So we done our analysis with constant joint rate and plot graphs for Cartesian path
followed by end-effector versus joint angles and with respect to time also.
Figure 5.4: Cartesian path followed by end-effector against joint angle Theta 1
Figure 5.5: Cartesian path followed by end-effector against joint angle Theta 2
In this case for analysis, the two link robot manipulator moved for time t = 10 sec. and joint angles and rate of change of
jointangleswere changed according to their movement so that the joint velocities, accelerations, torques τ1 and τ2 are also vary
with respect to their joint angles.
Figure 5.11: Motion of two link planar robot manipulator against time
Figure 5.12: Motion of two link planar robot manipulator against time
VI. CONCLUSIONS
In this paper, the complete mathematical formulation for forward kinematics and dynamics modeling of two link planar robot
manipulator having two degree of freedom are derived. In the forward kinematics modeling of the system, the mathematical
equations for the position, velocity and acceleration of end effector with respect to the base frame by using the Denavit-Hartenberg
convention and homogeneous transformation matrices are derived. D.H parameters are applied to determine the coordinate
transformation matrices through their different orientations and transformation. Similarly for direct dynamics modeling,
mathematical equations of motion for two link planar robot manipulator system by using Newton-Euler formulation which is based
on the force-moment balance. For the computational analysis of mathematical formulation of complete forward kinematics and
dynamics of the system MATLAB code are developed in the form of several M-files. The simulated results are also plotted. Thus
various concerned graphics corresponding to stated analysis and math have been plotted.
A. Future Directions
This paper presents the forward kinematics and dynamics analysis of two link planar robot manipulator, there exist a wide range of
possibilities for extensions. Several interesting openings for future research and development are:
1) The kinematics and dynamics modeling done in this work is limited to planar robot having rotational joints only but it can be
also extended for planar robots having prismatic joints
2) The results discussed in this work can be compared with the results of other standard methods like neural network,
SimMechanics for suitability of application.
3) The work can be extended to develop a laboratory prototype.
REFERENCES
[1] Silver W. M. (1982), “On the equivalence of Lagrangian and Newton-Euler Dynamics for Manipulators” ,The International Journal of Robotics Research, vol.
1, pp. 60-70.
[2] Featherstone Roy and Orin David (2000), “Robot Dynamics: Equations and Algorithms”, in Proc. IEEE International Conference on Robotics and Automation,
Vol. 1, pp. 826-834.
[3] Saha S.K., Shirinzadeh B. and Gürsel Alici (2006), “Dynamic Model Simplification of Serial Manipulators”, Int. Symp. on Robotics & Automation, ISRA, vol.
3, pp. 1-6.
[4] Milićević Ivan, Slavković Radomir and Golubović Dragan (2007), “Industrial Robot Models Designing and Analysis With Application of MATLAB
Software” ,Adeko, Vol. 21, pp. 22-27.
[5] Goyal Khushdeep, And Sethi Davinder (2010), “An Analytical Method to Find Workspace of a Robotic Manipulator”, Journal of Mechanical Engineering,
Vol. Me 41, No. 1.
[6] Khalil Wisama (2011), “Dynamic Modeling of Robots Using Recursive Newton-Euler Techniques”, Informatics in Control, Automation and Robotics, Volume
89, pp 3-20.
[7] Dodds Stephen (2012), “A Two-Link Manipulator: Simulation and Control Design”, University of Nebraska at Omaha, Ne, 68134.
[8] Mitra A. K. (2012), “Joint Motion-based Homogeneous Matrix Method for Forward Kinematics Analysis of Serial Mechanisms”, International Journal of
Emerging Technology and Advanced Engineering, ISSN 2250-2459, Vol. 2, Issue 5.
[9] Farooq Binyameen, Hasan Osman, And Iqbal Sohail (2013), “Formal Kinematic Analysis of The Two-Link Planar Manipulator”, Springer-Verlag Berlin
Heidelberg, Vol. 8144, pp 347-362.
[10] Patel Y. D.and George P. M. (2013), “Performance Measurement and Dynamic Analysis of 2dof Robotic Arm Manipulator”, Ijret, Vol. 2, pp. 77-84.
[11] Soomro Z. A. (2013), “Kinematic Modeling and Simulation of 2-D Link and 3-R Pendulum Serial Manipulator Robotic Arm”, International Researcher Vol. 2,
Issue 4, pp. 169-175.
[12] Abbas T. F. (2013), “Forward Kinematics Modeling of 5dof Stationary Articulated Robots”, Eng. &Tech. Journal, Vol.31, pp. 500-513.
[13] Ata A. A.,Ghazy M. A., And Gadou M. A. (2013), “ Dynamics of a General Multi-Axis Robot With Analytical Optimal Torque Analysis”, Journal of
Automation and Control Engineering, Vol. 1, pp 144-148.
[14] Craig J. J. (2002), “Introduction to Robotics Mechanics and Control”, Addison Wesley Longman, ISBN0-201-09528-9,pp.1–450.
[15] Uicker J. J. and Pennock G. R. and Shigley J. E. (2004), “Theory of Machines and Mechanisms” , Third Edition, Publ. Oxford University Press.
[16] Spong M. W., Hutchinson S., and Vidyasagar M. (2004)., “Robot Dynamics and Control”, Second Edition.
[17] Marghitu D. B. (2009), “Mechanisms and Robots Analysis with MATLAB” , Springer-Verlag London Limited, ISBN 978-1-84800-390-3, pp.1-479.
[18] Cai, H.M. and Xing T.T. (2012), “Kinematics Simulation of Industrial Robot based on MATLAB”, Adv. Mater. Res., pp.415-417: 690-696.