Professional Documents
Culture Documents
Kinematic Delta Robot
Kinematic Delta Robot
ARTICLE
1 Department of Mechanical Engineering, Chien Hsin University of Science and Technology, Zhongli District, Taoyuan City, Taiwan
*Corresponding author(s) E-mail: jlin@uch.edu.tw
DOI: 10.5772/61744
© 2015 Author(s). Licensee InTech. This is an open access article distributed under the terms of the Creative Commons Attribution License
(http://creativecommons.org/licenses/by/3.0), which permits unrestricted use, distribution, and reproduction in any medium, provided the
original work is properly cited.
where R is the radius of the fixed base’s circle. (Q2 - Q3 ) (Q32 - Q22 )
C= D=
Similarly, the coordinates of points Ci in the reference frame 3(r - R) 2 3(r - R)
related to the moving platform are given by
é r r ù E = r - R + B F = A2 + C 2 + 1
êr - 2 - ú
2 ú
ê
ê 3 3ú G = AE + CD - Q1 H = E2 + D 2 + Q12 - L2
éëC1C 2 C 3 ûù = ê0 r -r ú (2)
ê 2 2 ú
ê0 0 0 ú
ê ú 3.2 Workspace Definition
ë û
In this subsection, the workspace of the proposed DELTA
where r is the radius of the moving platform’s circle. robot will be discussed in detail. For a robot in the context
of industrial application and given parameters, it is
Hence, the constraint equations for the DELTA robot are
important to analyse the area and the shape of its work‐
generated by applying Pythagoras’ rule in three dimen‐
space. Calculation of the workspace and its boundaries
sions to each pair of arms [4, 7]. Noting that L 1 = L 2 = L 3, the
with perfect precision is crucial, because they influence the
equations define three spheres:
dimensional design, the manipulator’s positioning in the
work environment and the robot’s dexterity in executing
ì
ï tasks. The workspace is constrained by several conditions,
( r - R + X ) + Y 2 + (Z - Q1 )2 = L12
2
ï mainly the boundary that is obtained through solving
ï 2 2
inverse kinematics. Moreover, the workspace is limited
ïïì 1 ü ìï 3 üï
íí( R - r ) + X ý + í( r - R ) + Y ý + ( Z - Q2 ) = L2 2
2
(3) first by the accessibility of drives and joints, then by the
ïî 2 þ îï 2 þï
ï occurrence of singularities and finally by the link and
2 2
ïì 1 ü ïì 3 ïü platform collisions.
ï í( R - r ) + X ý + í( R - r ) + Y ý + ( Z - Q3 ) = L3 2
2
+ ( − ) = was
between 30° and
introduced. For
° . In order to generate a reachable
80the design of a DELTA robot, the
workspace (1000 mm × 700 mm × 400 mm) for the
(3)
+ ( − ) = determined.
kinematic parameters of the robot should be initially
proposed DELTA-robot system, a numerical algorithm
The design
was introduced. For theparameters
design of aare determined
DELTA robot, thefor a
ression of (3)desired workspace with the optimization techniques
kinematic parameters of the robot should be initially
determined.
described in [13].The design parameters are determined for a
h the expression of desired workspace with the optimization techniques
3 −
described in [13].
+ }
By analysing Eq. (4), we note that for each value of given
√3 Qi (Qi ∈ Qimin Qimax ), the workspace of each kinematic chain
{ − + }
2
60 °
is a sphere radius R, which is irregular in form. Obtaining
+ }√3
2
3 1540 mm 60 °
a workspace of regular form is possible by forming a circle
2{ − + }
1540 mm
2 equation X 2 + Y 2 = r 2 that is perpendicular to Z. The goal is
(4) 1220
1220mm
(4) mm to obtain the largest prescribed and regular dexterous
700
700 mmmm
workspace using the objective function
he
nt ofdirect
the direct
(3) with to
respect to r = (AZ + B)2 + (CZ + D)2. Here, the kinematic parameters
respect
tem: 1000 mm are the three variables to be determined: R=889 mm, r=49
1000 mm
mm and L=1540 mm.
60 °
60 °
(5) 4. System Implementation
Figure 3. Workspace
Figure definition
3. Workspace definition.
(5)
− − Figure 3. Workspace definition. The system implementation will consist of three parts:
− )
mechanism and hardware development, kinematics and
− )
6(
software development (Fig. 5).
√3( − )
+ + 1
+ + −
4.1 Mechanism and hardware development
θ
The design of the proposed DELTA robot includes a two-
− θ axis rotation of the wrist, a gripper and a six-axis robotic
e proposed DELTA θ arm. The proposed DELTA robot consists of a fixed base, a
or a robot in the travelling
kinematic plate and three
parameters kinematic
are chains
the three that connect
variables to be the
iven parameters, it fixed base to the travelling plate, which is the robot’s end-
( ∈ ೌೣ ), the workspace of each kinematic
ByFigure 4. DELTA-robot
analysing design
Eq. (4), we noteconcept.
that for each value of given determined: R=889 mm, r=49 mm and L=1540 mm.
d the shape of its
d DELTA θ effector. Each kinematic chain comprises an upper arm that
ot in the chain is a sphere radius R, which is irregular in form. is
4. actuated by a revolute, brushless DC servomotor and a
System Implementation
lower arm. Figure 6 displays the 3D-concept drawing and
equation + = that is
meters, it Obtaining a workspace of regular form is possible by
Figure 4. DELTA-robot design concept.
ape of its Figure 4. DELTA-robot
forming design concept
a circle the
Theconstructed system.
system implementation will consist of three parts:
perpendicular to Z. The goal is to obtain the largest mechanism and hardware development, kinematics and
120mm
77mm
The second
verify the
Figure 10 in
The drawin
of a robot.
and conver
the desired
(a) input work
and analys
discretized
Figure
Figure 8. Coordinates
8. Coordinates of thepoints
of the measured measured points for
for the repeatability testthe computed a
repeatability test. those that
selected for
5.1 Case I Domino Experimental Test
performanc
5.1 Case I Domino Experimental Test
Fig. 11. The
First, the pick-and-place operations in a domino test were
and the cor
used
First,tothe
verify the reliability
pick-and-place of the DELTA-robot
operations in a domino testsystem.were success rate
Pick-and-place operations involve a straight system.
used to verify the reliability of the DELTA-robot vertical
the DELTA
motion at the pick-up
Pick-and-place location
operations (from the
involve starting vertical
a straight point to
target even
the end point),
motion followed
at the pick-up by a straight
location (from thehorizontal
starting pointmotion
to
(b)
and
the another
end point), straight vertical
followed motion horizontal
by a straight at the placement
motion
location.
and anotherThe path-planning
straight vertical process
motion comprises searching
at the placement
for a motion
location. The that ensures the
path-planning accomplishment
process of these
comprises searching
assigned tasks. that
for a motion If theensures
desiredthe position of the end-effector
accomplishment of theseis
specified,
assignedthen theIfcorresponding
tasks. anglesofofthe
the desired position each of the three
end-effector
arms must bethen
is specified, determined. This experiment
the corresponding angles of each focuses on
of the
point-to-point
three arms must motions along specified
be determined. paths. After
This experiment the
focuses
hardware is initialized,
on point-to-point motions thealong
DELTA robotpaths.
specified is moved to a
After the
predefined
hardware position. Oncethe
is initialized, it has obtained
DELTA robota is
coordinate
moved toofa a
work piece, the
predefined system
position. starts
Once pathobtained
it has planning; it estimates
a coordinate of a
(c)
time when the DELTA robot can start the tracing process.
a work piece, the system starts path planning; it estimates
a time
Once when the
the desired DELTA
point robot have
coordinates can start
been the tracing
determined, Figure 10. D
the operator can use inverse kinematics to calculate the
control trajectory to be followed. The complete control
trajectory is divided into various sections. Each domino is
translated from a starting point to a target point. The
reference point of the pick-and-place path coincides with
each grid point to find the best position between the robot
and the task.
(b)
(c)
(d)
(e)
Figure 11. The desired drawing converted to a point-to-point picture
Figure 1
DELTA