Professional Documents
Culture Documents
A Comparative Study of Two Methods For Forward Kinematics and Jacobian Matrix Determination
A Comparative Study of Two Methods For Forward Kinematics and Jacobian Matrix Determination
A Comparative Study of Two Methods For Forward Kinematics and Jacobian Matrix Determination
net/publication/317095083
CITATIONS READS
2 356
2 authors:
Some of the authors of this publication are also working on these related projects:
All content following this page was uploaded by Abdel-Nasser Sharkawy on 05 October 2017.
Abstract—In this paper, a comparative study of two methods transformation one. Sariyildiz et al [9] compared three
are presented to determine the forward kinematics and inverse kinematic formulation methods for the serial
Jacobian matrix for any serial manipulator, based on product industrial robot manipulators based on screw theory. The
of exponentials formula and unit dual quaternion algebra. This first one was based on quaternion algebra, the second one
comparison is qualitative and particularly quantitative taken was based on dual quaternions, and the last one was the
into account computational costs and memory requirements exponential mapping method. They found that the method
that are very critical in the manipulator control and real-time which is based on dual quaternion gives the most compact
algorithms. For the first time the computational cost in and computationally efficient solution. In both of the
determining the Jacobian matrix by using these two algorithms
previous publications the computational cost of the forward
is compared. The two algorithms are applied to the 7-DOF
kinematic equations was considered but not the one for the
Kuka Lightweight Robot using MATLAB and compared.
Jacobian matrix calculation.
Keywords-forward kinematics; jacobian matrix; product of The unit dual quaternions are used in the design of
exponentials; dual quaternion; comparison; kuka robot controllers for rigid bodies and manipulators. Erol Özgüra,
Youcef Mezouarb [10] used unit dual quaternions to model
I. INTRODUCTION the kinematics and to design a controller for the pose of a
The most popular method used in robot kinematics is robot arm. They presented the computational cost for the
based on the Denavit-Hartenberg (D-H) notation for Jacobian calculation based on the exponentials of the unit
definition of spatial mechanisms and on the homogeneous dual quaternions. They found that this modeling is compact
transformation of points [1]. Many researchers sought to find and computationally efficient and then suitable for real time
algorithms based on appropriate theories for representing the control applications. Pham and his group [11] presented an
rigid body motions in space and to make them well unified position and orientation control for robot manipulator
understandable and improve their efficiency. by describing the end-effector motion as a dual quaternion
Alternative approaches based on screw theory were involving the translation and rotation. Their simulation and
proposed in robot kinematics and the most important ones experimental results highlighted the efficiency and
are expressed via unit dual quaternions [2] or exponentials of performance of this controller.
twists [3]. In screw theory, every transformation of a rigid In a recent paper [12], a robust controller was presented
body or a coordinate system with respect to a reference for robot manipulators using unit dual quaternion that allows
coordinate system can be expressed by a screw displacement, an advanced representation of the end-effector
which is a translation along an axis with a rotation about the transformation without decoupling the rotational and
same axis [4]. As an efficient tool to describe rigid translational dynamics. So the investigation of the
transformation, the unit dual quaternion has been applied in computational efficiency of the robot kinematics and
various fields, such as robotics, mechanical design, computer dynamics is very important for controllers design and other
graphics and vision as well as navigation [5, 6, 7]. The dual real-time considerations.
quaternion deals with line representation and transformation In this paper, the forward kinematics using two
instead of point representation and transformation under algorithms; product of exponentials (PoE) formula and unit
exponentials of twists. dual quaternion are presented. Mathematical analysis of the
Aspragathos and Dimitros [8] compared unit dual main steps of these algorithms is performed in order to
quaternion method based on the transformation and facilitate their comparison in qualitative and quantitative
representation of joint axes with the homogenous terms. Compactness, easiness of understanding and
transformation method and Lie algebra representation. They representation and transformations, computational costs and
found that the unit dual quaternion and Lie algebra based memory requirements are considered. In addition, the
methods offer a more compact and consistent way for the Jacobian matrix is determined using both approaches and for
definition of the end-effector than the homogeneous the first time a comparison is made between these algorithms
where ݍො is the scalar part and ݍොis the vector part ofܳ .
SinceݏƸ is perpendicular to ݊ොିଵǡ as shown in “Fig.1” then
the unit dual line vector ݊ොǡାଵ is determined by the
transformation of the݊ොିଵǡ [14]:
ܰଶ ߝܰଶ
݊ොǡାଵ ൌ ܳ ݊ොିଵǡ ൌ ݍො ൈ ݊ො ݍො݊ො ൌ ܰଷ ߝܰଷ (4)
ܰସ ߝܰସ
where ݊ොis the vector part of݊ොିଵǡ . The unit dual quaternion
Figure 1. The definition of the twists and unit dual quaternions and for the transformation between the unit line vectors ݏƸ and
vectors in successive joint axes. ݏƸାଵ is given by
According to the above presented forward kinematics the ܳǡାଵ ൌ
ߙොǡାଵ ݊ොǡାଵ ߙොǡାଵ ൌ
spatial Jacobian is determined as [3];
ܬ௦௧
௦
ሺߠሻ ൌ ሾߦଵ ߦଶ ᇱ ǥ ǥ ߦ ᇱ ሿ
ቀܿ ݅ߙݏ ܰͳ ݅ߙ݊݅ݏ ߝሺ ݅ߙݏܿ ͳܰ ݅ܮ ܰͳ ݅ߙ݊݅ݏ െ ݅ߙ݊݅ݏ ݅ܮሻቁ
where ߦ ᇱ ൌ ݀ܣቀ ෩భഇభ ǥǥǤ ෩షభഇషభ ቁ ߦ
ܰʹ ݅ߙ݊݅ݏ ߝ൫ ݅ߙݏܿ ʹܰ ݅ܮ ܰʹ ݅ߙ݊݅ݏ ൯
Each column of the Jacobian is formulated by the
transformation of the reference joint twists to the current ൦ ܰ͵ ݅ߙ݊݅ݏ ߝ൫ ݅ߙݏܿ ͵ܰ ݅ܮ ܰ͵ ݅ߙ݊݅ݏ൯ ൪ (5)
configuration of the manipulator, so its calculation depends ܰͶ ݅ߙ݊݅ݏ ߝ൫ܰ ݅ܮͶ ܿ ݅ߙݏ ܰͶ ݅ߙ݊݅ݏ ൯
heavily on the calculation of the adjoint of the relative
180
Then the instantaneous spatial velocity of the end-effector as the
ݏƸାଵ ൌ ܳǡାଵ ݏƸ (6) following equation
Equation (6) is not presented in the extended form since
the computational cost is equal to the one of (4). ܬൌ ሾݏƸଵ ݏƸଶ ǥݏƸ ǥ ݏƸ ሿ (14)
According to [8] for the computation of the position
vector of the end effector only the primary parts of the dual ݏ
where ݏƸ ൌ ൨ and this equation gives the same results
unit vectors are required as ݏ
using the product of exponential formula based Jacobian
ൌ σ
ୀଵሺ݀ ݏ ܮ ܽǡାଵ ሻ (7) matrix given by (2).
The transformation matrix ܶ that presents the end IV. COMPUTATIONAL TIME FOR THE TWO ALGORITHMS
effector frame relative to the base frame is calculated by
using only the primary parts of the dual unit vectors: Using the equations presented in the two previous
sections the computational burden for each method is
݊ǡାଵ ݏାଵ ൈ ݊ǡାଵ ݏାଵ
ܶ ൌ ቂ ቃ (8) determined. For the forward kinematics, the entire sum of the
Ͳ Ͳ Ͳ ͳ required multiplications and additions of simple real
In most of manipulator control systems the Jacobian is numbers are calculated and analytically presented for two
used, so its fast determination is quite critical. The methods in the Table Ι along with the respective equations.
instantaneous first order kinematics can be solved assuming
TABLE I. NUMBER OF OPERATIONS FOR THE FORWARD KINEMATICS
that the forward kinematics were determined. To derive the
Jacobian matrix using unit dual quaternions, the following Product of Exponential Formula
equations illustrate the Velocity relations – Jacobians [2].
Term Additions Multiplications
݁ ఠఏ (eq.1) 18 33
σ ሶ መ
ୀଵ ߠప ݏƸ ൌ ܸ ܵ ൌ ሺ߱ ߝݒሻሺ ݏ ߝ ݏሻ (9)
൫ ܫെ ݁ ఠఏ ൯ 3 0
where ߠపሶ ൌ ߠሶ ߝ݀ሶ and ݏƸ ൌ ݏ ߝ , so (9) can be ሺ߱ ൈ ݒ ሻ 3 6
written as the following equation: ൫ ܫെ ݁ ఏ
ఠ
൯ሺ߱ ൈ ݒ ሻ 6 9
෨
Overall ݁ క ఏ (eq.1) 30 48
ߠపሶ ݏƸ ൌ ൣߠሶ ݏ ߝ൫ߠሶ ݏ ݀ሶ ݏ ൯൧ Multiplication of two 4 36 48
ୀଵ ୀଵ X 4 transformation matrices
Total operations for m 30m + 36m = 48m +48m =
ൌ ߱ ݏ ߝሺ ݏ ߱ ݒݏሻ (10) Link Robot 66m 96m
Unit Dual Quaternion Method
For rotational joints,݀ሶ ൌ ͲǤͲ, then
Dual Part is included
߱ ݏൌ σ ሶ
, ߱ ݏ ݒݏൌ σ ሶ (11) ܳ୧ (eq.3) 3 13
ୀଵ ߠ ݏ ୀଵ ߠ ݏ
݊ොǡାଵ (eq.4) 21 27
ݒݏൌ െ ݏ ߱ ߠሶ ݏ ൌ ሺ െ ାଵ ሻ ൈ ݏ ߠሶ ܳǡାଵ (eq.5) 3 13
ୀଵ ୀଵ ݏƸାଵ (eq.6) 21 27
181
For the determination of the number of operations the forward kinematics and Jacobian matrix. For the forward
required for the calculation of the Jacobian matrix it is kinematics, unit dual quaternion requires 54m + 3 and 18m
supposed that the forward kinematics were done so the +3 additions using dual part and ignoring it respectively
required operations for this are not recalculated. In the compared with product of exponentials that requires 66m.
෨
product of exponential the calculation of ݁ కఏ and for the For multiplications, unit dual quaternion requires 86m + 6
multiplications of the 4 X 4 transformation matrices are and 30m + 6 using dual part and ignoring it respectively and
ready from forward kinematics. For the determination of the the product of exponential requires 96m. For the Jacobian
Jacobian based on unit dual quaternions,ݏ and ݏ are ready matrix, unit dual quaternion requires 6m + 21 additions
from the forward kinematics. For the Jacobian matrix compared with product of exponentials that requires 30m -
calculation, the number of operations for the two methods is 30. For multiplications, unit dual quaternion requires 6m +
shown analytically in the Table ΙΙ. 60 and the product of exponential requires 45m - 45. In case
of the Jacobian given by (14) which is identical to the one
TABLE II. NUMBER OF OPERATIONS FOR THE JACOBIAN MATRIX given by (2), the computational cost is zero since the unit
CALCULATIONS. dual vector is calculated in the forward kinematics by (6).
Product of Exponential Formula
Therefore for real time applications and kinematic control of
serial manipulators the unit dual quaternion representation is
Term Additions Multiplications
preferable.
Adjoint Matrix = ݀ܣ 9 18 It is clear that the number of calculations is lower by
Multiplication 21 27 using the unit dual quaternion method and it is known that
by ߦ (eq.2) unit dual quaternion requires 8 memory locations for the
Overall Operations for 30 (m -1) = 45 (m -1) = representation of position and 3 memory locations for the
m Link Robot 30m - 30 45m - 45 orientation despite of the product of exponential that is based
Unit Dual Quaternion Method on the 4 X 4 transformation matrices that require 16 memory
locations for both the position and orientation so the storage
୫ାଵ 21 60
in a memory needs less space. Therefore the computational
ݏ ൈ ାଵ െ ݏ 6 6 costs and memory requirements are lower in unit dual
( eq.13)
quaternion. The explanation of the physical meaning of the
Overall Operations for 6m + 21 6m + 60 parameters and operations in dual quaternion and PoE shows
m Link Robot
that the intuitive understanding of the combined orientation
and translation it is easier in unit dual quaternion based
A comparison of the number of mathematical operations algorithm.
required for the computation of the end-effector position and
orientations and the Jacobian matrix versus the number of V. APPLICATIONS OF THE ALGORITHMS IN KUKA LWR
joints using the two methods is presented in Fig. 2. ROBOT
182
compared algorithms. To our knowledge is the first time that computational time and memory requirements. Calculations
the POE and unit dual quaternion are used for the forward of the forward kinematics and Jacobian matrix using these
kinematics and the Jacobian determination of the 7-DOF two algorithms are applied and programmed in Matlab on the
Kuka LWR and in addition that are programmed and the 7-DOF LWR Kuka Robot and are compared. According to
required operations are compared. In KUKA Control the quantitative comparison and the presented qualitative
Toolbox [15] the forward kinematics are based on advantages of the unit dual quaternion approach it is clear
homogeneous transformations and the Jacobian is not that for real-time applications and manipulator control the
determined. dual quaternions is much preferable than PoE.
After the calculation of forward kinematics, it is found
that the two algorithms give the same results for the forward ACKNOWLEDGMENT
kinematics but with different calculation time. There is a Abdel-Nasser Sharkawy is funded by the “Egyptian
difference in the results of the Jacobian matrix given by (2) Cultural Affairs & Missions Sector” and “Hellenic Ministry
and the one given by (13); since in the case of the product of of Foreign Affairs Scholarship” for Ph.D. study in Greece.
exponential formula, the angular component is the
instantaneous angular velocity of the body as viewed in the REFERENCES
spatial frame, however the linear component is not the [1] Donald L. Pieper, The kinematics of manipulators under computer
velocity of the origin of the end-effector frame, rather it is control. PhD, 1968.
the velocity of a possibly imaginary point on the rigid body [2] J. Kim and V. R. Kumar, “Kinematics of Robot Manipulators via
which is traveling through the origin of the spatial frame at Line Transformations,” J. Robot. Syst., vol. 7, no. 4, pp. 649–674,
time t, as it is stressed in [3]. If the Jacobian given by (13) is 1990.
used then the calculated translational velocity is the one of [3] R. M. Murray, Z. Li, and S. S. Sastry, A Mathematical Introduction to
Robotic Manipulation. CRC Press, 1994.
the origin of the end-effector frame.
[4] J. D. Adams and D. E. Whitney, “Application of Screw Theory to
The computational time required by the corresponding Constraint Analysis of Mechanical,” Trans. ASME, vol. 123, pp. 26–
Matlab programs is not compared because this depends on 32, March 2001.
the way of programming. From the general comparison of [5] A. Perez and J. M. McCarthy, “Dual Quaternion Synthesis of
the two algorithms illustrated in section 4, for the 7-DOF Constrained Robotic Systems,” J. Mech. Des., vol. 126, pp. 425–435,
LWR Kuka robot (m=7), the forward kinematics requires May 2004.
672 multiplications and 462 additions using the Product of [6] Y. WU, X. HU, D. HU, T. LI, and J. LIAN, “Strapdown Inertial
Exponential formula and 608 multiplications and 381 Navigation System Algorithms Based on Dual Quaternions,” IEEE
additions using the unit Dual Quaternion taking into Trans. Aerosp. Electron. Syst., vol. 41, no. 1, 2005.
consideration the dual part while in the case of ignoring the [7] P. N. Azariadis and N. A. Aspragathos, “Computer Graphic
Representation and Transformation of Geometric Entities using Dual
dual part, 216 multiplications and 129 additions are required. Unit Vectors and Line Transformations,” Comput. Graph., vol. 25, no.
The Jacobian matrix requires 270 multiplications and 180 2, 2001.
additions based on Product of Exponential formula and 102 [8] N. A. Aspragathos and J. K. Dimitros, “A Comparative Study of
multiplications and 63 additions using the unit Dual Three Methods for Robot Kinematics,” IEEE Trans. Syst. MAN,
Quaternion algorithm. Cybern. B Cybern., vol. 28, no. 2, pp. 135–145, 1998.
From the analytic presentation of the algorithms and its [9] E. Sariyildiz, E. Cakiray, and H. Temeltas, “A Comparative Study of
programming in Matlab, it is clear that unit dual quaternions Three Inverse Kinematic Methods of Serial Industrial Robot
Manipulators in the Screw Theory Framework,” Int. J. Adv. Robot.
present higher compactness and facilitates the understanding Syst., vol. 8, no. 5, pp. 9–24, 2011.
of the geometrical meaning of the joint axes. Therefore, the
[10] E. Özgür and Y. Mezouar, “Kinematic modeling and control of a
wider use of these methods into the robotics community has robot arm using unit dual quaternions,” Rob. Auton. Syst., vol. 77, pp.
to be considered particularly the dual quaternion approach in 66–73, 2016.
the manipulator control of simultaneous rotation and [11] H. Pham, V. Perdereau, B. V. Adorno, and P. Fraisse, “Position and
translation of the end-effector. Orientation Control of Robot Manipulators Using Dual Quaternion
Feedback,” in 2010 IEEE/RSJ International Conference on Intelligent
VI. CONCLUSION Robots and Systems (IROS), pp. 658–663, 2010.
[12] L. F. C. Figueredo, B. V Adorno, J. Y. Ishihara, and G. A. Borges,
In this paper, two methods are presented in an “Robust kinematic control of manipulator robots using dual
algorithmic way for the formulation of the kinematic quaternion representation,” in 2013 IEEE International Conference on
equations and Jacobian matrix of serial manipulators. The Robotics and Automation (ICRA), pp. 1949–1955, 2013.
comparative study including the calculation of the number of [13] B. Kenwright, “Inverse Kinematics with Dual-Quaternions,
arithmetic operations (additions and multiplications) as an Exponential-Maps , and Joint Limits,” Int. J. Adv. Intell. Syst., vol. 6,
index of the computational costs for each algorithm are no. 1, pp. 53–65, 2013.
determined and compared. The unit Dual Quaternion Method [14] J. Rooney, “A comparison of representations of general spatial screw
displacement,” Environ. Plan. B Plan. Des., vol. 5, no. 1, pp. 45–88,
is proved more effective than the Product of Exponential 1978.
formula as the number of the robot degrees of freedom
[15] F. Chinello, S. Scheggi, F. Morbidi, and D. Prattichizzo, “The KUKA
increases. Control Toolbox : motion control of kuka robot manipulators with
Unit Dual Quaternion offers a more compact and matlab,” IEEE Robot. Autom. Mag., pp. 1–10, 2010.
consistent way than the product of exponential formula for
determining the Jacobian Matrix and needs less
183