Professional Documents
Culture Documents
Delta Robot Forward Kinematics Method With One Root: Igor Gritsenko Askar Seidakhmet
Delta Robot Forward Kinematics Method With One Root: Igor Gritsenko Askar Seidakhmet
Abay Bekbaganbetov
Kazakh-British Technical University
Almaty, Kazakhstan
e-mail: abay_b@bk.ru
Abstract—In this work we investigate forward kinematics of procedure for selecting one of them, the solution given in
Clavel’s parallel Delta robot. Authors introduce novel this paper has a single root. The analytical solution allows
alternative algorithm for delta robot forward kinematics solving the problem with low computational costs.
solution, which has only one root. We introduce numerical In this paper, we use the mechanism parameters shown in
verification with closed loop kinematics computation: inverse Figure 1.
kinematics – forward kinematics. Additionally authors
introduce their own implementation of inverse kinematics for
delta robot. Numerical implementation of proposed forward
kinematics algorithm showed computation time of 150
microseconds per iteration and computational error of 10-19, Lbr
that is could be considered as a microprocessor computation
error. Lb
Keywords-delta; parallel robot; kinematics
I. INTRODUCTION
The modern production of light industry is automated Le
and robotic. On these technological operations the
manipulation mechanisms of the traditional sequential
structure with different number of degrees of freedom are
used. The kinematics of a manipulator with a parallel Ler
structure - the Delta robot - is considered. The delta robot is a Figure 1. Delta robot mechanism parameters.
parallel robot, which means that there is more than one
kinematic chain from the base to the robot actuator. The key Vector from the center of the base to the center of the
feature is the use of parallelograms in the construction of the rotor of the drive – Lbr, length of the lever arm fixed to the
manipulator, which allows to preserve the spatial orientation drive – Lb, length of the passive shoulder – Le, vector from
of the robot actuator. the attachment point of the passive shoulder to the grip – Ler.
A distinctive feature of the delta robot is that its structure The design of the robot delta is such that the vectors Ler and
allows 3rd drives interconnected to form in space the Lbr are always parallel, which greatly simplifies the robot
position of the gripper, the gripper coordinate system is model, allowing you to move the origin of Lb along the
always parallel to the base coordinate system ([1]). vector Ler to the center of the base and the end of Le along
The analytical solution for calculating the forward the vector Ler to the center of gripper. Thus the gripper is not
kinematics of delta robot. In contrast to the conventional described by three points as a common three-point links
approach: the search for the intersection point of three available. And the coordinate system of the gripper is always
spheres having two alternative roots and requiring a parallel to the base coordinate system.
Figure 3. The geometric meaning of the above method - the section of the
sphere circle
40
S = U + N·d (6) The method of calculating inverse kinematics was used
standard - but the above implementation of the method is an
Point S is the desired point - delta robot’s gripper center author's development and is intuitively understandable.
and forward problem solution of delta robot kinematics. It In the case of inverse kinematics, we know the position
should be noted that if you change the sequence of vectors in of the point S and must determine the angles of the drives. In
the first step, then the point will be at the center of the sphere this case, the drives can be viewed independently.
on the other side of the circle of the section. This solution Consider a solution for one drive - A1. The structure of
does not depend on the shape of the motion of the points - the robot is such that the lever Lb moves along a circle in
they can move along a circle or along a linear trajectory or a one plane and we arrange the coordinate system in the center
complex trajectory, in any case the method will work if the of the rotor as in the figure below. We obtain the coordinates
solution exists. of the point S in terms of the coordinate frame m1:
41
We are interested will find the angle θ as follows: θ=φ-σ; efficiency and accuracy is created. The decision of direct
wherein θϵ[0 90]; φϵ(15 165); σϵ(15 165); φ – find kinematics to build a working area of the robot in a volume
coordinates using S1 ' and σ determine by the cosine theorem; of 30 ^ 3 points has taken, 3.939 sec, or 146 microseconds
φ=Ctg-1(y/z); we specifically use arccotangent, because the per calculation. In the future work, the authors are going to
§ 2
range of its values (0-180); V arccos ¨ Lb S1c Lec ¸ ,
2
2 · use the results obtained and investigate the calculations of
the dynamics and construction of regulators of the delta
¨ 2 Lb S1c ¸ robot, investigate the forms of working areas for various
© ¹
the arc cosine also has a range of values (0-180). topologies of delta manipulators.
Convenient is that to calculate angles 2 and 3, you need
REFERENCES
to change only the first step and get S2, S3, respectively.
[1] Clavel, R. (1988), Delta: a Fast Robot with Parallel Geometry,
IV. CONCLUSION Proceedings of the 18th Int. Symposium on Industrial Robot,
Lausanne.
A new method for solving the forward kinematics [2] Tremblay, A., Baron, L. (1999), Geometrical Synthesis of Parallel
problem is obtained, the method is realized and verified by Manipulators of Star-Like Topology with a Genetic Algorithm, IEEE
means of both an analytical substantiation and a numerical Int. Conf. on Robotics and Automation, Detroit, Michigan.
experiment. It should be noted that if you change the [3] Zsombor-Murray, P.J. (2001), Kinematic Analysis of Clavel’s
sequence of vectors in the first step, then the point will be at “Delta” Robot, CCToMM Symposium on Mechanisms, Machines and
Mechatronics, Saint-Hubert (Montréal).
the center of the sphere on the other side of the circle of the
section. This solution does not depend on the shape of the [4] André Olsson, Modeling and control of a Delta-3 robot, master thesis,
Department of Automatic Control, Lund University, 2009.
motion of points - they can move along a circle or along a
[5] Manuel Napoleon Cardona Gutierrez, “Kinematics Analysis of a
linear trajectory or a complex trajectory, in any case the Delta Parallel Robot”, IEEE, University of Sonsonate, Salvador,2010.
method will work if the solution exists. An implementation
of inverse kinematics for a robot with high numerical
42