Professional Documents
Culture Documents
Yyy PDF
Yyy PDF
Abstract
Drilling robot is a piece of large rock drilling equipment that integrates mechanical, electrical, and hydraulic technique, and
it is a significant device for drilling and blasting. The drilling robot arm is the core component of the robot. To get intuitive
and accurate modeling method to overcome the problem of the classic Denavit–Hartenberg method, for instance, the
model mismatches the entity. The coordinate system fixed on the entity of Denavit–Hartenberg notation that is named
coordinate-fixed Denavit–Hartenberg is creatively presented. The coordinate-fixed Denavit–Hartenberg method not
only improves the accuracy and operability of kinematic analysis but also solves the workspace of drilling robot arm
effectively. The drilling robot from an intelligent technology company in China is taken as the research example in this
article. The homogeneous coordinate transformation matrix of each link rod is established through reasonably simplifying
drilling robot arm as a multijoint structure. The coordinate-fixed Denavit–Hartenberg method is utilized for the first time
in determining and verifying the kinematics equation of drilling robot arm. The kinematics equation is employed to obtain
the effective workspace of drilling robot arm. The analysis results demonstrate that the design of drilling robot arm
reaches the need of workspace in the actual structure as well as meets the functional requirements of drilling robot.
Keywords
Drilling robot arm, CFDH method, workspace, kinematic analysis
Creative Commons CC BY: This article is distributed under the terms of the Creative Commons Attribution 4.0 License
(http://www.creativecommons.org/licenses/by/4.0/) which permits any use, reproduction and distribution of the work without
further permission provided the original work is attributed as specified on the SAGE and Open Access pages (https://us.sagepub.com/en-us/nam/
open-access-at-sage).
2 International Journal of Advanced Robotic Systems
construction requirements and improve the efficiency, sta- rods. In CFDH method, the parameters of the link rod are
bility, and safety performance of tunneling, it is imperative specified as follows.
to solve the effective workspace of drilling robot arm. Due
to the similarity between drilling robot arm and multijoint (1) Dimension parameters of link rod
robot, drilling robot arm is simplified as a multijoint
Length of link rod ai: The distance between the two axes
structure.11,12 The Denavit–Hartenberg (D-H) method is
of joints i and i 1 along the common perpendicular.
commonly applied in kinematic research of multijoint
Link rod twist angle ai: The angle between the two axes
structure.13 The application conditions of coordinate fixed
of joints i and i 1.
Denavit–Hartenberg (CFDH) method are consistent with
D-H method, and the CFDH method is more accurate and (2) Relation parameters of adjacent link rod
rational than the D-H method. Thus, the CFDH method is
adopted to solve the workspace of drilling robot arm in Axis distance di: The distance between two common
this article. perpendiculars in the axis i direction.
The structure of this article is organized as follows. The Joint rotation qi : The angle between two common
second section introduces the CFDH matrix transformation perpendiculars on the plane which are vertical to the axis
method, which includes two parts, one part is the CFDH of joint.
convention and link rod parameters and the other part is to
establish the coordinate system of link rod. The third sec-
tion compares several methods for solving the kinematic
Establishing coordinate system of link rod
equations of robot, and the CFDH method is applied to Owing to the drilling robot arm consisting of multiple
determine the kinematic equation of drilling robot arm and joints, it is necessary to establish coordinate system of each
verifies its correctness. The fourth section solves the work- link rod. The coordinate system of the link rod is shown in
space of drilling robot arm and analyzes the results. The Figure 1 and the regulation of parameters is set as follows.
fifth section makes a brief summary of the work done.
Coordinate axis Xi: Along the common perpendicular
of two joint axes of rod i 1 points to the joint i;
The CFDH matrix transformation method Coordinate axis Zi: Coincide with the axis of the
joint i;
CFDH convention and link rod parameters Coordinate axis Yi: Determined by the right-handed
A commonly utilized convention for selecting frames of Cartesian coordinates system;
reference in robotics applications is the D-H convention Origin of coordinate Oi: When the joint axis i 1
which was introduced by Jacques Denavit and Richard S intersects the joint axis i, the intersection point is
Hartenberg in 1955.14,15 The classic D-H method allows taken. When the axis of the joint is i 1 and the
the coordinate system to establish on the extension of axis of the joint is i, the intersection of the normal
axis, leading to the problems such as inapplicability for axis of the two axes and the axis of the joint is i.
all the joints modeling, the model mismatching the When the joint axis i 1 and the joint sweat axis i
entity, and wrong local joint position analysis. To get are parallel, Oi is the intersection point taken by
intuitive and accurate modeling method, the coordinate the axis i and the public vertical line of the axis i þ
system fixed on the entity of D-H notation, that is, 1 and the joint axis i.
CFDH is creatively presented. The coordinate system is established according to the
The CFDH convention is formulated by simplifying CFDH method, and the transformation matrix between the
robot as a multijoint structure and setting up a coordinate
two adjacent parts is converted from coordinate system
system on each link rod entity. Multijoint robot can be
fi 1g to coordinate system fig, which can be obtained
described kinematically using the four parameters for each
by four transformations.
link rod: length and twist angle describe the link rod itself;
axis distance and joint rotation describe the link rod’s con- (1) Rotating qi around Zi 1 axis:RotðZi1 ; qi Þ
nection to a neighboring link rod. In the usual case of a (2) Translocating di along Zi 1 axis:T ransðZi1 ; di Þ
revolute joint, qi is called the joint variable and the other (3) Translocating ai along Xi axis:T ransðXi ; ai Þ
three parameters of link rod are fixed. For prismatic joints, (4) Rotating ai around Xi axis:RotðXi ; ai Þ
di is the joint variable, and the other three parameters of
link rod are fixed. The definition of mechanisms by means The CFDH parameters of the rotating link rod are ai, ai,
of these parameters is a convention usually called the di, qi. The joint angle qi is the joint variable; length of link
CFDH method. ai, link twist angle ai, and link distance di are fixed. These
The structure of drilling robot arm conforms to the con- four parameters determine the position of the link rod fig
dition of using the CFDH method. The drilling robot arm relative to the link rod fi 1g.The coordinate transforma-
can be regarded as a mechanical arm with multiple link tion matrix is i1i T , as shown in Formula (1).
Ding and Liu 3
i1
¼ Rot ðZi1 ; qi Þ TransðZi1 ; di Þ TransðXi ; ai Þ RotðXi ; ai Þ complete motion model of the robot. Thus, this method is
iT
2 3 more used in the study of planar robots. In the application
cos qi sinqi cosai sinqi sinai ai cos qi
6 7 of Moving Frame method to determine the kinematics
6 sinqi cos qi cosai cos qi sinai ai sinqi 7 equation of the robot, in the first place, the recursive for-
6 7
¼6 7 mula of the moving frame should be gained according to
6 0 sina cosa d 7
4 i i i 5 the Bouquet formula of differential geometry. Then, the
0 0 0 1 relative component of the moving frame set up by each
2 3
cos qi sinqi cosai sinqi sinai 0 link rod is calculated. Finally, the position and posture of
6 7 the moving frame on the end link rod of the robot is calcu-
6 sinqi cos qi cosai cos qi sinai 07
6 7 lated on the basis of each relative component. Although this
¼6 7
6 0 sinai cosai di 7 representation method is meaningful to the trajectory plan-
4 5
0 0 0 1 ning of robot, it is more cumbersome to use and the amount
of calculation is too much for a multijoint robot.
ð1Þ
In summary, the Lie Group and Moving Frame methods
have their own advantages in determining the kinematic
equations of the robot. However, due to the limitations of
Determination and verification
their characteristics and the scope of application, they are not
of kinematic equation suitable for the drilling robot arm structure in this article.
Owing to the variety of robots, the methods applied in The CFDH method inherited the advantages of the classic
determining the kinematic equations of robot are different D-H method and improved it. It has solved the existing
on the basis of different structures; in addition to the D-H technical defects of D-H method, reduced the error,
method, Lie Group and Moving Frame methods are also improved the precision, and made it more suitable for the
commonly used. In the determination of the kinematic multijoint structure. Therefore, the CFDH method is applied
equation by applying the Lie Group method, there is no to determine the kinematic equation of drilling robot arm.
need to establish the corresponding coordinate system on Figure 2 shows the three-dimensional model of drilling
each link rod, and the rotation theory can be used to calcu- robot arm. It can be seen that the drilling robot arm has a lot
late directly. However, as a result of its lack of intuition, the of joints, thus applying CFDH method is more accurate to
Lie Group method is difficult to obtain a precise and determine its kinematic equation than other methods.
4 International Journal of Advanced Robotic Systems
8
> px ¼ 270 c1 s1 ð3100 s2 þ l 1 s2Þ þ 220 c5 ðc4 ðc1 s2 þ c2 s1Þ þ s4 ðc1 c2 s1 s2ÞÞ
>
>
>
>
>
> þ 460 c6 ðc4 ðc1 c2 s1 s2Þ s4 ðc1 s2 þ c2 s1ÞÞ 950 s6 ðc4 ðc1 c2 s1 s2Þ
>
>
>
>
>
> s4 ðc1 s2 þ c2 s1ÞÞ þ 545 c4 ðc1 s2 þ c2 s1Þ þ 1240 c4 ðc1 c2 s1 s2Þ
>
>
>
>
>
> 1240 s4 ðc1 s2 þ c2 s1Þ þ 545 s4 ðc1 c2 s1 s2Þ þ c1 ð3100 c2 þ l 1 c2Þ þ 220 c6 s5
>
>
>
>
>
> ðc4 ðc1 c2 s1 s2Þ s4 ðc1 s2 þ c2 s1ÞÞ d7 s6 ðc4 ðc1 c2 s1 s2Þ s4 ðc1 s2 þ c2 s1ÞÞ
>
<
py ¼ 270 s1 þ s1 ð3100 c2 þ l 1 c2Þ þ c1 ð3100 s2 þ l 1 s2Þ 220 c5 ðc4 ðc1 c2 s1 s2Þ
>
>
>
>
>
> s4 ðc1 s2 þ c2 s1ÞÞ þ 460 c6 ðc4 ðc1 s2 þ c2 s1Þ þ s4 ðc1 c2 s1 s2ÞÞ 950 s6
>
>
>
>
>
> ðc4 ðc1 s2 þ c2 s1Þ þ s4 ðc1 c2 s1 s2ÞÞ þ 1240 c4 ðc1 s2 þ c2 s1Þ 545 c4 ðc1 c2 s1 s2Þ
>
>
>
>
>
> þ 545 s4 ðc1 s2 þ c2 s1Þ þ 1240 s4 ðc1 c2 s1 s2Þ þ 220 c6 s5 ðc4 ðc1 s2 þ c2 s1Þ
>
>
>
>
>
> þ s4 ðc1 c2 s1 s2ÞÞ d7 s6 ðc4 ðc1 s2 þ c2 s1Þ þ s4 ðc1 c2 s1 s2ÞÞ
>
>
:
pz ¼ 950 c6 þ 460 s6 þ c6 d7 þ 220 s5 s6 þ 1280
ð10Þ
6 International Journal of Advanced Robotic Systems
by using “plot” function, and the workspace of the drilling are distributed in a sector. The data analysis shows that the
robot arm is obtained. By using the “for” cycle to select fan radius is 8000 mm. According to the design index, the
15,000 points randomly, the workspace diagram of drill- XOY surface of workspace is centered on the sector with a
ing robot arm can be formed. The graphs of workspace are radius of 6000 mm. Therefore, the drilling robot arm satis-
shown in Figures 4 and 5. fies the workplace requirement of drilling robot on the
Random joint variables are calculated as shown in the tunnel face.
formula (11). The XOZ and YOZ surfaces of workspace mainly
describe the drilling area that the drilling robot arm can
qi ¼ qi min þ ðqi max qi min Þ rand ð1Þ ð11Þ reach on the side, top, and bottom of the tunnel. As shown
In the formula (11), qimin is the minimum numerical in Figures 6 and 7, the projected points of workspace on the
value of rotation range of the joint i, qimax is the maximum XOZ and YOZ surfaces are similar to rectangles. The data
numerical value of rotation range of the joint i, rand (1) analysis shows that the drilling areas are 14,000
refers to the number of randomly selected 0*1. 9000 mm2 and 16,000 9000 mm2. On the basis of the design
The drilling rod end position is the workspace of drilling index, the drilling areas of XOZ and YOZ surfaces are the
robot arm, as shown in the Figure 4. It can be seen that the focus on 12,000 8000 mm2. Thus, the drilling robot arm
workspace of drilling robot arm is similar to a half hollow satisfies the workplace requirement of the drilling robot.
ellipsoid. The three-dimensional graph of workspace is basis In summary, through the solution and analysis of
of the graph on the XOY, XOZ, and YOZ surfaces. Therefore, workspace, it can be proved that the drilling robot arm
if we intend to gain the workspace on the rock face, the studied in this article meets the construction require-
three-dimensional graph of workspace must be obtained. ments of drilling robot.
The drilling robot arm is mainly working on the tunnel
face. Thus, in the actual construction, the XOY surface of
workspace is the most significant and the best reflect of its Conclusion
kinematic performance. In combination with the Figure 5, In this article, an improved method of solving workspace is
it can be seen that the projected points on the XOY surface developed to ameliorate drawbacks of the conventional
8 International Journal of Advanced Robotic Systems
method, while this method is still easy to operate and gen- 5. Wu Y, Yang Z, Fu Z, et al. Kinematics and dynamics analysis
eralize. The coordinate system of CFDH method is fixed on of a novel five-degrees-of-freedom hybrid robot. Int J Adv
the entity and therefore, the accuracy of workspace can be Robot Syst 2017; 14(3): 1–8.
improved. The drilling robot arm is simplified into a multi- 6. Shan XL and Cheng G. Kinematic analysis and parameter
joint structure and its coordinate system is established. The optimization for a novel 2(3HUSþS) parallel hip joint simu-
transformation matrix between components is obtained lator. Int J Robot Autom 2017; 32(4): 379–386.
using the CFDH method, and the kinematic equation of 7. Yong GF, Tao M, and Hai ZJ. Problems and improvement of
drilling robot arm is successfully determined and effec- D-H method for establishing connecting rod coordinate sys-
tively verified. Consequently, the end position of the drill- tem. China Mech Eng 2014; 25(3): 2710–2714.
ing rod and the workspace of drilling robot arm are gained, 8. Hsieh JF. Numerical analysis of displacements in spatial
and it is proved that the drilling robot arm satisfies the mechanisms with spherical joints utilizing an extended
construction requirements of drilling robot. The effective D-H notation. T Can Soc Mech Eng 2010; 38(3–4):
workspace of drilling robot arm is helpful to comprehend 417–431.
the relationship between the position, direction, and the 9. Craig JJ. Introduction to robotics: Mechanics and control.
displacement of each moving rod. Meanwhile, it is Pearson Education, Inc., 3rd ed. 2004.
the foundation of establishing the dynamic equation of 10. Bajrami X, Dermaku A, Shala A, et al. Kinematics and
the drilling robot arm. dynamics modelling of the biped robot. IFAC Proc Volume
2013; 46(3): 69–73.
Declaration of conflicting interests 11. Zhao L, Yen AKW, Coulombe J, et al. Kinematic analyses of
The authors declared no potential conflicts of interest with respect a new medical robot for 3D vascular ultrasound examination.
to research, authorship, and/or publication of this article. T Can Soc Mech Eng 2014; 38(2): 227–239.
12. Li ZJ and Schicho J. A technique for deriving equational
Funding
conditions on the Denavit–Hartenberg parameters of 6R lin-
The authors disclosed receipt of following financial support for
kages that are necessary for movability. Mech Mach Theory
the research, authorship, and/or publication of this article: This
research is financially supported by the National Science Founda- 2015; 94: 1–8.
tion of China (grant no. 51275374). 13. Dumas C, Boudelier A, Caro S, et al. Development of a
robotic cell for trimming of composite parts. Mech Ind
ORCID iD 2011; 12(6): 487–494.
Feng Ding http://orcid.org/0000-0002-0519-3329 14. Rocha CR, Tonetto CP, and Dias A. A comparison between
the Denavit–Hartenberg and the screw-based methods used in
References kinematic modeling of robot manipulators. Robot CIM 2011;
1. Booscariol P, Gasparetto A, Scalera L, et al. Efficient closed- 27(4): 723–728.
form solution of the kinematics of a tunnel digging machine. 15. Heidari O, Daniali H, and Fathi A. Searching for special
J Mech Robot 2017; 9(3): 1–13. cases of the 6R serial manipulators using mutable smart
2. Kim Y and Moon HK. Application of the guideline for over- bee optimization algorithm. Int J Robot Autom 2014;
break control in granitic rock masses in Korean tunnels. Tunn 29(4): 396–405.
Undergr Sp Tech 2013; 35: 67–77. 16. Corral J, Pinto C, Altuzarra O, et al. Characterisation of par-
3. Hu HQ. Tunnel rock drilling robot. Changsha: Central South allel kinematic machines based on structural workspaces.
University Press, 2004. Mech Ind 2013; 14(1): 43–51.
4. Lovitt MB and Collins AH. Improved tunneling perfor- 17. Guo WZ, Gao F, and Mekid S. A new analysis of workspace
mance through smarter drilling and design. Boca Raton, performances and orientation capability for 3-DOF planar
USA: CRC Press, 2013, pp. 7–14. manipulators. Int J Adv Robot Syst 2010; 25(2): 89–101.