2017 14th International Conference on Ubiquitous Robots and Ambient Intelligence (URAI)

June 28 - July 1, 2017 at Maison Glad Jeju, Jeju, Korea

Analytical Inverse Kinematic Solution Using the

D-H Method for a 6-DOF Robot
Jun-Di Sun, Guang-Zhong Cao*, Wen-Bo Li, Yu-Xin Liang and Su-Dan Huang
Shenzhen Key Laboratory of Electromagnetic Control, Shenzhen University, Shenzhen, 518060, China
(Tel : +86-755-2653-4865; E-mail: [email protected], [email protected])

Abstract - This paper proposes an analytical approach to position of the robot. Figure 1 shows the zero position of
solve inverse kinematics of a 6-DOF robot. The robot the welding robot. Local reference coordinate of each joint
discussed here is designed with 6R configuration.‫ٻ‬The is created according to the zero position as show in figure
D-H model of the six-axis robot is built. The forward 2. The D-H parameters of the 6-DOF robot are shown in
analytical solution is deduced using the D-H method. Then, table 1. As can be seen from the table, a1, a4, a5, a6, d2, d3 of
analysis of inverse kinematics for the robot is presented. this kind of robot is equal to zero.
And finally, the validity of the inverse kinematic equations
is verified. Forward kinematic equations and inverse
kinematic equations are suitable for all kinds of robots
with configuration similar to those of the robot in this
paper.

Keywords - Analytical solution, D-H Coordinates, inverse

kinematic, 6-DOF Robot.

‫ٻ‬
1. Introduction
Fig. 1. Zero position of the robot
Inverse kinematics of 6-DOFs (degrees of freedom)
‫ٻ‬
manipulators is to solve the joints position according to the
d4
relative position and orientation between the base and the a2 a3
end effector. It is the base of trajectory planning and x4 y4

motion control [1]. In fact, computing based on position y1 y2 y3 z4

z1 z2 z3 y6
level is solving the nonlinear equations [2, 3]. According x1
x2
x3 z6
x6
to Pieper's law, analytic solutions exist only in
manipulators with three adjacent axes intersect at one d1
y5
point or parallel to each other) [4, 5]. Manipulators with z0
d5
z5
other structure can only be solved using numerical x0 x5
d6

methods, while the methods are computationally intensive y0

and unsuitable for real-time control [6].

Analytical solution can obtain all feasible solutions, and
Fig. 2. Local reference coordinate of each joint
many algorithms are developed to solve inverse
kinematics. Ahuactzin, J. built the kinematic roadmap and
Table 1 The D-H parameters of the 6-DOF robot
obtained the closed-form solution [7]. The neural
networks such as the LRNNs [8], the MDNN [4], and Link ș d a Į
screw theory [8, 9] are all applied for solving inverse 1 ș1 d1 0 ʌ/2
kinematics of manipulators, but the specific algorithms 2 ș2 0 a2 0
depend on the configuration of robot [10, 11]. 3 ș3 0 a3 0
This paper proposes one methodology for deriving the 4 ș4 d4 0 ʌ/2
closed form inverse kinematic solutions of the 6-DOF 5 ș5 d5 0 -ʌ/2
robot on position level. Forward kinematic equations and 6 ș6 d6 0 0
inverse kinematic equations are suitable for all kinds of
robots with structure similar to those of the robot in this After the linkage coordinate system was established by
paper. D-H rules, then, combined with the table of D-H
parameters, homogeneous transformation matrices
2. The D-H Model of the 6-DOF Robot between adjacent link coordinate system were given:
The D-H model of the six-axis robot is given in this part.
The forward solution on the position is carried out utilizing
the D-H method.
It is more concise to build the D-H model in zero

978-1-5090-3056-9/17/$31.00 ©2017 IEEE 714

 ªCθ n − Sθ nCα n Sθ n Sα n anCθ n º According to
‫ٻ‬
« Sθ Cθ n Cα n −Cθ n Sα n an Sθ n »»
An = « n
A2 A3 A4 A5 A6 = A1-1 BTH ‫(ٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻ‬11)
« 0 Sα n Cα n dn » (1)
« »
¬ 0 0 0 1 ¼ it can be extracted from equation (9):

where: nx S1 − ny C1 = C6 S5
(12)
ox S1 − oy C1 = − S5 S6 ‫ٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻ‬
Cșn= cos (ș‫)ۉ‬, CĮn = cosĮ (2)

Sșn= sin(ș‫)ۉ‬, SĮn = sinĮ (3) Simplify equation (10),

B
TH is the homogeneous transformation matrix between S5 = ± ( nx S1 − n y C1 ) 2 + (ox S1 − o y C1 ) 2 (13)
‫ٻٻٻٻٻٻٻٻٻٻٻٻٻ‬
the base and the end axis:
ªn o a p º C5 = Ax S1 − Ay C1 (14)
« x x x x» ‫ٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻ‬
«n o a p »
B
TH = A1 A2 A3 " A6 = « y y y y
» Then the angle of joint 5 can be calculated from
«n o a p » (4)
« z z z z» θ5 = Atan2 ( S5 , C5 ) ‫(ٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻ‬15)
¬« 0 0 0 1 ¼»
ª n x ox ax º Thus
b
Rt = « n y o y ay »
« »‫ٻ‬ (5) nx S1 − n y C1
«¬ nz oz C6 =
az »¼ S5 (16)
‫ٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻ‬
ª px º ox S1 − o y C1
S6 =
b
Pt = « p y » − S5
« » (6)
«¬ pz »¼
‫ٻ‬ § ox S1 − oy C1 nx S1 − n y C1 · (17)
θ6 = Atan2 ¨ , ¸
b b
Rt and Pt is the position matrix and attitude matrix of © − S5 S5 ¹ ‫ٻٻٻٻٻٻٻٻٻٻٻٻٻٻ‬
the end coordinate in robot base respectively.‫ٻ‬When
‫ٻٻٻٻٻٻٻٻٻٻٻٻٻ‬all ș
are known, these two matrices can be obtained according Similarly, find the corresponding terms on both sides of
to equation (4). equation (18):

3. Inverse kinematic equations A2 A3 A4 = A1−1 BTH A6 −1 A5 −1 ‫(ٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻ‬18)

‫ٻ‬
The second, third and fourth joints of the robot parallel then ș234 (=ș2+ș3+ș4) is calculated from
to each other, which satisfies the second condition of the
Pieper's law, so the inverse solution can be obtained by θ 234 = Atan2 ( S234 , C234 )
analytic method. The specific derivation process is as
follows. C234 = C5 ª¬C6 ( C1nx + n y S1 ) − S 6 ( C1ox + o y S1 ) º¼ − S5 ( Ay S1 + AxC1 )
According to S 234 = C5 ( C6 nz − oz S 6 ) − a z S5
(19)
A 2 A 3 A 4 A 5 = A1−1 BTH A 6 −1 ‫(ٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻ‬7)
ș3 is given by
it can be obtained:
θ3 = A tan 2 ( S3 , C3 ) (20)
(P − d A ) C −(P − d A ) S
y 6 y 1 x 6 x 1 = −d 4
‫ٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻ‬
(8) ‫ٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻ‬
ș2 is given by
§ §d ·
2
d · §b a·
θ1 =Atan2 ¨ ± 1 − ¨ 4 ¸ , − 4 ¸ − Atan2 ¨ , ¸ (9) § y x ·
¨ ρ ρ ¸ ρ ρ ‫ٻ‬ θ 2 = A tan 2 ¨ , ¸ - A tan 2 ( a3 S3 , a2 + a3C3 )
© © ¹ ¹ © ¹ ¨ k 2 +k 2 k12 + k2 2 ¸¹
‫ٻٻٻٻٻٻ‬ © 1 2
‫ٻ‬
(21)
where
a = Py − d6 Ayˈb = Px − d6 Axˈρ = a 2 + b2 (10)
‫ٻٻٻٻ‬

715
 References
Finally, ș4 is given by
[1] J. D. Sun, G. Z. Cao, S. D. Huang, K. Chen and J. J.
Yang, “Welding seam detection and feature point
θ 4 =θ234 − θ2 − θ3 (22) extraction for robotic arc welding using laser-vision,”
13th International Conference on Ubiquitous Robots
Then the analytical inverse solution of the six joint is all and Ambient Intelligence (URAI), Xi'an, pp. 644-647,
given out. 2016.
[2]‫ٻ‬T. Kagawa, H. Ishikawa, T. Kato, C. Sung and Y. Uno,
4. Verification of Inverse Kinematic Equations “Optimization-Based Motion Planning in Joint Space
for Walking Assistance With Wearable Robot,” IEEE
In order to verify the correctness of the analytical Transactions on Robotics, Vol. 31, No. 2, pp. 415-424,
inverse solution. 2015.
When ș is [3] F. A. Leban, J. Díaz-Gonzalez, G. G. Parker and W.
Zhao, “Inverse Kinematic Control of a Dual Crane
π π π π π π (23) System Experiencing Base Motion,” IEEE
θ =[ , , , , , ]
6 6 6 6 6 6 ‫ٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻٻ‬ Transactions on Control Systems Technology, Vol. 23,
No. 1, pp. 331-339, 2015.
[4] M. Lukic, A. Barnawi and I. Stojmenovic, “Robot
Take it into equation (4) to caculate the forward
Coordination for Energy-Balanced Matching and
solution : Sequence Dispatch of Robots to Events,” in IEEE
Transactions on Computers, Vol. 64, No. 5, pp.
ª -0.2165 -0.8750 0.4330 -0.4850 º
« -0.6250 -0.2165 -0.7500 -0.5614 » 1416-1428, 2015.
(24) [5] Q. Jiang and V. Kumar, “The Inverse Kinematics of
T= « »
« 0.7500 -0.4330 -0.5000 -0.7195 » Cooperative Transport With Multiple Aerial Robots,”
« » IEEE Transactions on Robotics, Vol. 29, No. 1, pp.
¬ 0 0 0 1.0000 ¼ ‫ٻٻٻٻٻٻٻٻٻٻٻٻ‬
136-145, 2013.
Inverse solutions are computed by the inverse [6] Z. Ye, S. Régnier and M. Sitti, “Rotating Magnetic
kinematic equations above, specific value is show in table Miniature Swimming Robots With Multiple Flexible
2.‫ٻ‬As can be seen from Table 2, the first group solution is Flagella,” IEEE Transactions on Robotics, Vol. 30, No.
the right one, and the other seven groups are other possible 1, pp. 3-13, 2014.
poses in the workspace of the robot. [7] Ahuactzin, J. M. and K. K. Gupta. “The kinematic
roadmap: A motion planning based global approach
Table 2 The result of inverse solution for inverse kinematics of redundant robots,” IEEE
Transactions on Robotics and Automation, Vol. 15, No.
i ș1(rad) ș2(rad) ș3(rad) ș4(rad) ș5(rad) ș6(rad) 4, pp. 653-669, 1999.
1 0.5236 0.5236 0.5236 0.5236 0.5236 0.5236 [8] Y. Yun, J. Ko and A. D. Deshpande, “Control in the
2 0.5236 1.0286 -0.5236 1.0658 0.5236 0.5236 Reliable Region of a Statistical Model,” IEEE
3 0.5236 0.3849 1.1560 -3.1116 0.5236 -2.6180 Transactions on Robotics, Vol. 32, No. 4, pp.
4 0.5236 1.4956 -1.1560 -1.9104 0.5236 -2.6180
1017-1025, 2016.
[9] Sariyildiz, E., E. Cakiray, et al. “A Comparative Study
5 -2.1584 1.7416 0.9119 -0.4276 2.4594 -1.8377
of Three Inverse Kinematic Methods of Serial
6 -2.1584 2.6194 -0.9119 0.5183 2.4594 -1.8377
Industrial Robot Manipulators in the Screw Theory
7 -2.1584 1.9853 0.8542 2.5280 -2.4594 1.3039 Framework,” International Journal of Advanced
8 -2.1584 2.8079 -0.8542 -2.8694 2.4594 1.3039 Robotic Systems Vol. 8, No. 5, pp. 9-24, 2011.
[10]‫ٻ‬Shimizu, M., H. Kakuya, et al. “Analytical Inverse
5. Conclusion Kinematic Computation for 7-DOF Redundant
Manipulators with Joint Limits and Its Application to
This paper has derived the closed form inverse
Redundancy Resolution,” IEEE Transactions on
kinematic solutions of the 6-DOF robot on position level.
Robotics Vol. 24, No. 5, pp. 1131-1142, 2008.
Forward kinematic equations and inverse kinematic
[11] C. H. Chen, T. K. Liu and J. H. Chou, “A Novel
equations are suitable for all kinds of robots with
Crowding Genetic Algorithm and Its Applications to
configuration similar to those of the robot in this paper. ‫ٻ‬
Manufacturing Robots,” IEEE Transactions on
Finally, the validity of the analytical inverse solutions is
Industrial Informatics, Vol. 10, No. 3, pp. 1705-1716,
verified.
2014.
Acknowledgement
This work was supported by the National Natural
Science Foundation of China under Grant NSFC
51677120, and Shenzhen government fund under Grant
KJYY20160428170944786.

716