D2005033945
D2005033945
e-ISSN: 2278-1684,p-ISSN: 2320-334X, Volume 20, Issue 5 Ser. III (Sept. – Oct. 2023), PP 39-45
www.iosrjournals.org
Abstract:
This article mainly introduces the structure and degree of freedom analysis of Delta parallel robot. Using space
geometry and vector algebra methods to establish a simplified kinematics model of a parallel robot .Use
geometric solution method to perform forward kinematic solution, the inverse solution is relatively simple,
which is to calculate the joint angle based on the position of the end platform. Finally, the workspace is
simulated and analyzed through Matlab software to verify that the parallel robot meets the needs of actual
engineering applications.
Key Word: Delta parallel robot; Kinematics analysis; Workspace; Matlab.
----------------------------------------------------------------------------------------------------------------------------- ----------
Date of Submission: 18-10-2023 Date of Acceptance: 28-10-2023
----------------------------------------------------------------------------------------------------------------------------- ----------
I. Introduction
The Delta parallel robot was invented by Dr. R. Clavel in 1985. It is the most commonly used type of
parallel robot today[1,2]. As people's understanding of the nature of robots deepens, parallel mechanisms that
meet the definition of robots are called parallel robots. It means that the moving platform and the static platform
are connected through at least two independent branch chains and have two or more degrees of freedom. , a
closed-loop mechanism driven in parallel[3,4,5,6].
Compared with series mechanisms, parallel robots have greater stiffness, compact and stable structure,
large load-bearing capacity, fast movement speed, and high positioning accuracy. Therefore, their applications
are becoming more and more widespread, and their development and research are becoming more and more in-
depth[7,8,9,10,11].
𝐹 = 𝑑(𝑛 − 𝑔 − 1) + ∑ 𝑓𝑖 (1)
𝑖=1
In Eq.1, F is the total number of degrees of freedom; n is the total number of components; g is the total
number of kinematic pairs, 𝑓𝑖 is the number of degrees of freedom of the i-th kinematic pair; d is the mechanism
order, d=6 for space mechanisms, and d=3 for planar mechanisms. The Delta robot has a static platform, a
moving platform, three active arms and three driven arms. The total number of components is n=8; the
mechanism has 3 rotating pairs and 6 Hooke hinges, and the total number of kinematic pairs is g=9. Each
rotating pair has only one degree of freedom, and each Hooke joint has two degrees of freedom [15,16].
Substituting the above parameters into Eq.1.
𝑔
𝐹 = 𝑑(𝑛 − 𝑔 − 1) + ∑ 𝑓𝑖 = 6 × (8 − 9 − 1) + 3 + 6 × 2 = 3
𝑖=1
Therefore, the Delta robot studied in this article is a three-degree-of-freedom parallel robot.
Forward kinematics solution
Given the rotation angles of the three active arms of the parallel robot, finding the position of the center
point of the moving platform is called the forward kinematics solution. For the forward solution of parallel robot
kinematics, the commonly used solution is to use a numerical solution method based on algebraic equations.
The advantage is that the mathematical model is simple and convenient for programming and calculation, but
the disadvantage is that the calculation amount is large and the solution speed is slow, during the solution
process, it is necessary to make trade-offs between multiple solutions, and appropriate initial values must be
given during calculation, otherwise it will easily cause the iteration to fail to converge. The geometric analysis
method used in this article can obtain the correct solutions to the positive solutions of all positions, avoiding the
problem of choosing between multiple solutions. When solving the three-degree-of-freedom parallel robot, the
derivation process is simple and clear[17].
Schematic diagram of the simplified model of the Delta robot, as shown in Fig.2. The slave arm BiCi
(i=1,2,3) is translated along the vector ⃗⃗⃗⃗⃗⃗
𝐵𝑖 𝑃 (i=1,2,3) respectively. After translation, we obtain DiP, three vectors
intersect at point P. The triangle △A1A2A3 formed by the static platform is an equilateral triangle, and the radius
of the circumscribed circle is known, the coordinates of point A in the coordinate system {O} can be obtained.
When the rod lengths and rotation angles of the three input rods are given, the coordinates of B in the base
coordinate system {O} can be obtained, and the translation vector CiP can be obtained, then the coordinates of
Di after Bi is translated can be obtained. In this way, the forward kinematics problem of the parallel robot
mechanism is ultimately equivalent to the problem of obtaining the vertex coordinate P of the triangular vertebra
P-D1D2D3. Under the condition that all side lengths and three vertex coordinates of the triangular vertebra are
known, it is easy to obtain The coordinates of vertex P in the base coordinate system {O}.
𝑥𝐴𝑖 𝑅 𝑐𝑜𝑠 𝜔𝑖
[𝑦𝐴𝑖 ] = [ 𝑅 𝑠𝑖𝑛 𝜔𝑖 ] (2)
𝑧𝐴𝑖 0
2 2
⃗⃗⃗⃗⃗ | = √|𝐷
|𝐹𝐸 ⃗⃗⃗⃗⃗⃗⃗ ⃗⃗⃗⃗⃗⃗⃗
1 𝐸 | − |𝐷1 𝐹 | (10)
⃗⃗⃗⃗⃗⃗⃗
The radius |𝐷 1 𝐸 | of the circumcircle of triangle △D1D2D3 is expressed as:
⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
|𝐷 1 𝐷3 |
⃗⃗⃗⃗⃗⃗⃗
|𝐷 ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗ ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
1 𝐸 | = |𝐷1 𝐷2 | ∙ |𝐷2 𝐷3 | ∙
4𝑆
⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
𝑆 = √𝑝(𝑝 − |𝐷 ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗ ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
1 𝐷2 |)(𝑝 − |𝐷1 𝐷3 |)(𝑝 − |𝐷2 𝐷3 |)
(11)
⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
(|𝐷 ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗ ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
1 𝐷2 | + |𝐷1 𝐷3 | + |𝐷2 𝐷3 |)
{𝑝 = 2
The unit vector ⃗⃗⃗⃗⃗⃗
𝑒𝐹𝐸 is expressed as:
⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
𝐷1 𝐷2 × ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
𝐷2 𝐷3 × ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
𝐷1 𝐷3
𝑒𝐹𝐸 =
⃗⃗⃗⃗⃗⃗ (12)
|𝐷1 𝐷2 × 𝐷2 𝐷3 × ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗ ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗ 𝐷1 𝐷3 |
The vertical vector ⃗⃗⃗⃗⃗
𝐸𝑃 can be expressed as:
⃗⃗⃗⃗⃗ ⃗⃗⃗⃗⃗ | ∙ ⃗⃗⃗⃗⃗⃗
𝐸𝑃 = |𝐸𝑃 𝑒𝐸𝑃 (13)
The module of vector (EP) can be expressed as:
2 2
⃗⃗⃗⃗⃗ | = √|𝐷
|𝐸𝑃 ⃗⃗⃗⃗⃗⃗⃗ ⃗⃗⃗⃗⃗⃗⃗
1 𝑃 | − |𝐷1 𝐸 | (14)
The unit vector ⃗⃗⃗⃗⃗⃗
𝑒𝐸𝑃 can be expressed as:
⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
𝐷1 𝐷2 × ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
𝐷2 𝐷3
𝑒𝐸𝑃 =
⃗⃗⃗⃗⃗⃗ (15)
|𝐷1 𝐷2 × ⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗
⃗⃗⃗⃗⃗⃗⃗⃗⃗⃗ 𝐷2 𝐷3 |
After the above calculation and derivation, the forward solution to the kinematics of the parallel robot
is obtained. According to the rotation angle θi (i=1, 2, 3) between the active arm and the static platform, the
position of the center of the moving platform can be obtained.
[(𝑅 − 𝑟 + 𝐿𝐴𝐵 𝑐𝑜𝑠𝜃𝑖 )𝑐𝑜𝑠ωi − 𝑥]2 + [(𝑅 − 𝑟 + 𝐿𝐴𝐵 𝑐𝑜𝑠𝜃𝑖 )𝑠𝑖𝑛ωi − 𝑦]2 + (𝐿𝐴𝐵 𝑠𝑖𝑛𝜃𝑖 + 𝑧)2 = 𝐿2 𝐵𝐶 (19)
𝜃
Let, tan 𝑖 = 𝑡 , equation 19 can be simplified to equation 20
2
𝐴𝑖 𝑡 2 𝑖 + 𝐵𝑖 𝑡𝑖 + 𝐶𝑖 = 0 (20)
𝐴𝑖 = (𝑅 − 𝑟)2 + 𝑥 2 + 𝑦 2 + 𝑧 2 + 𝐿2𝐴𝐵 − 𝐿2 𝐵𝐶 + 2(𝐿𝐴𝐵 − 𝑅 + 𝑟)(𝑥𝑐𝑜𝑠𝛼𝑖 + 𝑦𝑠𝑖𝑛𝛼𝑖 ) − 2(𝑅 − 𝑟)𝐿𝐴𝐵 ;
𝐵𝑖 =4z𝐿𝐴𝐵 ;
𝐶𝑖 = (𝑅 − 𝑟)2 + 𝑥 2 + 𝑦 2 + 𝑧 2 + 𝐿2𝐴𝐵 − 𝐿2 𝐵𝐶 + 2(𝑟 − 𝐿𝐴𝐵 − 𝑅)(𝑥𝑐𝑜𝑠ωi + 𝑦𝑠𝑖𝑛ωi) + 2(𝑅 − 𝑟)𝐿𝐴𝐵 ;
Equation 20 is a quadratic equation about 𝑡𝑖 . Solving for 𝑡𝑖 , we can get equation 21,
Figure 4. 3D view of the reachable workspace Figure 5. XOZ Plane projection diagram
Figure 6. XOY Plane projection diagram Figure 7. YOZ Plane projection diagram
From the generated outline of the workspace, Fig 5,6,7, it can be seen that the reachable range of the
parallel robot in the X-axis direction is -680~680mm, the reachable range in the Y-axis direction is -
680~680mm, and the reachable range in the Z-axis direction is -1230 ~ -410mm.
Under actual working conditions, the parallel robot mainly completes the grasping-translation-
placement operation task. Its movement range is approximate to a cylinder. As shown in the figure 8, the
effective working space ranges from -560 to 560mm in the X-axis and Y-axis range, and in the Z-axis range is -
780~-620mm, which forms a cylinder with a diameter D=1120mm and a height h=260mm. This effective
working space can meet the trajectory operation needs in actual engineering applications.
IV. Conclusion
Through the kinematics analysis of the robot in this article, we have obtained the methods for solving
forward and inverse kinematics, and in subsequent research, we can use matlab programming to solve the results
of the forward and inverse position solutions faster. Drawing a workspace diagram through matlab allows us to
observe the effective workspace of the robot more intuitively and meet the design needs of the project. Position
analysis is the prerequisite for studying robot workspace and trajectory planning, and also lays the foundation
for subsequent speed and acceleration calculations of parallel robots[24].
References
[1]. Clavel R. Dispositif pour le déplacement et le positionnement d'un élément dans l'espace[P]. 1987-6-18.
[2]. Zhang Ketao, Fang Yuefa. Kinematics and workspace analysis of a new type of spatial three-degree-of-freedom parallel robot [J].
Progress in Natural Science, 2008(04):432-440.
[3]. Feng Lihang, Zhang Weigong, Gong Zongyang, etc. Research progress and current situation of Delta series parallel robots [J].
Robot, 2014, 36(03): 375-384.
[4]. Cai Zixing. Fundamentals of Robotics [M]. Beijing: Machinery Industry Press,2009.
[5]. Merlet J P. Parallel robots[M]. Dordrecht, Netherlands:Springer Press, 2006.
[6]. Chen X S, Chen Z L, Kong X M. Recent development and current status of Stewart platform research[J]. Robot, 2002, 24(5): 464-
470.
[7]. Clavel R. Device for displacing and positioning an element in space, Europe: EP0250470 B1[P]. 1991-07-17.
[8]. Brogårdh T. Present and future robot control development—An industrial perspective[J]. Annual Reviews in Control, 2007, 31(1):
69-79.
[9]. Poppeová V, Uríček J, Bulej V, et al. Delta Robots -Robots for high speed manipulation[J]. Tehnicki vjesnik/Technical Gazette,
2011, 18(3):435-445.
[10]. Bouri M, Clavel R.The linear Delta: Developments and applications[C].The 41st International Symposium on Robotics. Frankfurt,
Germany: VDE, 2010: 1198-1205.
[11]. Milutinovic D, Slavkovic N, Kokotovic B, et al. Kinematic modeling of reconfigurable parallel robots based on Delta concept[J].
Journal of Production Engineering, 2012, 15(2): 71-74.
[12]. Pierrot F, Nabat V, Company O, et al. Optimal design of a 4-DOF parallel manipulator: From academia to industry[J]. IEEE
Transactions on Robotics, 2009, 25(2): 213-224
[13]. Nabat V, de la Rodriguez M, Company O, et al. Par4: Very high speed parallel robot for pick-and-place[C].IEEE International
Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2005: 553-558.
[14]. Huang Zhen, Kong Lingfu, Fang Yuefa. Parallel robot mechanism theory and control Machinery Industry Press [M]. 1997.
[15]. Liang Xiangning. Delta robot kinematics modeling and simulation[D]. Taiyuan University of Technology, 2008.
[16]. Mao Hongguo. Research on motion control of DELTA robot based on dynamic model[D]. Harbin Institute of Technology, 2015.
[17]. Zhao Jie, Zhu Yanhe, Cai Hegao. Geometric solution of forward kinematics of Delta type parallel robot [J]. Journal of Harbin
Institute of Technology, 2003(01):25-27.
[18]. Xu Guannan, Zhang Zhonghui, Xia Qingguan. Kinematic analysis of delta parallel robot [J]. Mechanical Manufacturing and
Automation, 2015, 44(06): 160-162+192.
[19]. Huang Chenhua. Geometric solution method for the inverse solution of kinematics of industrial robots [J]. Manufacturing
Automation, 2014, 36(15):109-112.
[20]. Zhao Yanjiang, Zhang Yongde, Jiang Jingang et al. Robot workspace solution method based on Matlab [J]. Mechanical Science and
Technology, 2009, 28(12): 1657-1661+1666.
[21]. Liu Shanzeng, Yu Yueqing, Jian Guoning, et al. Kinematics and dynamics analysis of 3-degree-of-freedom parallel robot [J].
Transactions of the Chinese Society of Mechanical Engineering, 2009, 45(08): 11-17.
[22]. Li Baofeng, Sun Hanxu, Jia Qingxuan, etc. Space robot workspace calculation based on Monte Carlo method [J]. Spacecraft
Engineering, 2011, 20(04):79-85.
[23]. Wang Xinghai, Zhou Yu. Numerical calculation of robot workspace [J]. Robot, 1988(01):50-
53+49.DOI:10.13973/j.cnki.robot.1988.01.011.
[24]. Fang Yuefa, Huang Zhen. Motion analysis of three-degree-of-freedom 3-RPS parallel robot mechanism [J]. Mechanical Science and
Technology, 1997(01):86-92.