Research Article | Open Access
An Application of the Newton-Homotopy Continuation Method for Solving the Forward Kinematic Problem of the 3-RRS Parallel Manipulator
The forward kinematic problem (FKP) of the 3-RRS parallel manipulator is solved by means of the Newton-homotopy continuation method. The closure equations are formulated in the three-dimensional Euclidean spaces considering the coordinates of the centers of the spherical joints as unknown variables. The method is easy to follow and unlike the classical Newton-Raphson method it allows finding all the solutions of the FKP. A case study is included in the contribution in order to confirm the correctness of the method. In that concern, the numerical results obtained by means of the proposed method are verified with the aid of two different approaches such as the application of commercially available software like Maple16™ and the application of the PHCpack, a general purpose solver for polynomial systems based on homotopy continuation.
A parallel manipulator is a mechanical device composed of a moving platform and a fixed platform connected each other by means of at least two kinematic chains or legs. Compared with their serial counterparts, parallel manipulators bring us interesting advantages like higher accuracy and stiffness as well as the possibility to place the servo motors near to the fixed platform. Owing these features, parallel manipulators allow for potential applications such as flight simulators, automobile simulators, mining machines, medical fields, machine tools with multiaxis, cable-actuated cameras, and haptic devices, in work processes. However, the complex forward kinematics of parallel manipulators is one of their major drawbacks.
This work deals with the forward kinematic problem of the 3-RRS parallel manipulator where R and S stand for revolute and spherical joint, respectively, which is a robot able to perform the 2R1T motion. In order to perform the kinematic analysis of parallel manipulators, a comprehension of their mobility is a crucial issue in order to select the motive joints. According to Liu and Bonev , the three degrees of freedom of the robot at hand may be understood as two independent freedoms: two rotations and one translation. As occurs for the tangential 3-RPS parallel manipulator , the axes of the two rotations belong to the plane formed by the centers of the spherical mounted on the moving platform. The performance of the 3-RRS parallel manipulator, as well as its applications, has been well studied; consider, for instance, that Liu  investigated the dynamics of the 3-RRS parallel manipulator considering flexible links. Khajepour et al.  developed a 3-RRS parallel manipulator whose main advantage is that the torques produced by the servomotors are decreased by using a mass compensator. Zhao et al.  developed a family of metamorphic parallel manipulators based on the topology of the 3-RRS parallel manipulator in which the substitution of spherical joints by different kinematic devices plays a central role in order to modify their mobility. Tetik and Kiper  reported the inverse and forward singularity manifolds of the 3-RRS parallel manipulator. In order to overcome the limitations of the 3-RRS parallel manipulator, it can be used as a module of a serial-paralell manipulator  or provided with a reconfigurable fixed platform . On the other hand it is interesting to note that if the topology of the 3-RRS parallel manipulator is modified in such a way that its revolute joints intersect at a common point, and then it is transformed into a spherical parallel manipulator [9–11].
This work is focused on the FKP of the 3-RRS parallel manipulator generator of the 2R1T motion. The rest of the contribution is organized as follows. In Section 2 the mathematical resource employed in the contribution, namely, the Newton-homotopy method, is explained. In Section 3, the architecture of the 3-RRS parallel manipulator is briefly outlined. In Section 4 the FKM is formally presented. With the purpose to exemplify the method, in Section 5 a numerical example is solved and verified by means of two different approaches: (i) the application of the library Homotopy of Maple16™ and (ii) the application of the free available software PHCpack . Finally, some conclusions are given at the end of the contribution.
2. Mathematical Background
There are many problems in kinematics involving interrogates dealing with mappings between algebraic spaces. Prominent amongst them the analytic solution of the forward kinematics of parallel manipulators is one of the most challengers problems in modern kinematics. In that concern, elegant methods to solve the forward kinematics of the Gough-Stewart platform  have been developed by resorting to the so-called Algebraic geometry [14–18] as a mean to overcome heavy manipulations of complex algebraic expressions. Naturally trend can be also implemented for solving the FKP of parallel manipulators having limited mobility  and the 3-RRS robot is not the exception. The mathematical tool chosen for approaching the issue at hand is the Newton-homotopy continuation method , a kind of perturbation technique, and in what follows the method is briefly explained. The method is focused on solving a square system of polynomials in the unknowns given by
In the method, the equations are modified by omitting some terms and adding new ones in such a way that a new system of equations emerges with the characteristic that the start system may be guessed avoiding divergence. Afterwards, the coefficients are deformed/perturbed into coefficients of the original system by a series of small increments; e.g., assuming that we need to solve , then the auxiliary homotopy function may be chosen as follows:
The functions may be freely selected; e.g., an option would be simple linear combinations of the involved variables:
Then, one defines as the multiple homotopy continuation function given by where is an arbitrary parameter given in the interval confined to . Hence, it is evident that we have two boundary conditions as follows: These conditions are the basis of the homotopy continuation method.
The idea fundamental consists of solving instead of considering small variations of parameter t and resorting to the usual Newton-Raphson method. The iterations are performed according to where is the Jacobian matrix of the modified/perturbed system. Of course, in order to guarantee convergence of the algorithm avoiding divergence, is selected in such a way that .
Finally, it is interesting to quote that the method explained in this section to solve higher nonlinear equations although requires proper guess start values; the solution, if any, usually is found in a few iterations. In that regard, other effective methods like the Sylvester dialytic method of elimination could produce spurious solutions or heavy polynomial equations depending on the expected degree of the involved polynomials.
3. Geometry of the Parallel Manipulator
In this section the topology and geometry of the parallel manipulator are outlined.
With reference to Figure 1, the 3-RRS parallel manipulator consists of two triangular platforms, one fixed and the other movable, connected by means of three identical limbs. The th limb is composed of a lower link having a length and an upper link having a length , and it is articulated with three joints: (i) an active revolute joint R located at point connecting the lower link to the fixed platform which is related with the th generalized coordinate , (ii) a passive revolute joint R located at point articulating the two links in the same limb, and (iii) a spherical joint S located at point connecting the upper link to the moving platform. The revolute joints in the same limb have parallel axes along the unit vector . Furthermore, the moving and fixed platforms are in the shape of equilateral triangles of side length and of side length , respectively. With this topology the moving platform is able to perform the 2R1T motion. Finally, with the purpose to formulate the FKP, let us consider that is a reference frame with associated unit vectors attached to the moving platform with the origin O located at the center of the triangle and the -axis normal to the plane of the fixed platform.
4. Formulation of the Forward Kinematic Problem
The FKP consists of finding the reachable poses of the moving platform meeting a prescribed set of generalized coordinates . To this end, consider that points are composed of unknown coordinates as follows: , , and .
Owing the parallelism between the axes of the two revolute joints in the same limb, three closure equations may be written as follows: (8) where and are the position vectors of points and while the dot denotes the usual inner product of three-dimensional vectorial algebra. On the other hand, the Euclidean distance between points and gives us three quadratic equations as follows: where denotes the position vector of the th point . In that regard it is straightforward to show that points Bi are obtained directly upon the generalized coordinates. Finally, other three quadratic equations are generated taking into account the Euclidean norm between points . In fact from the geometry of the moving platform it follows that
After a few computations, a system of nine equations in the unknown coordinates of points is generated. This kind of equations may be reduced into a univariate order polynomial . In the contribution, taking into account that (3) are linear equations then expressions (8)-(10) are reduced into a nonlinear system of six quadratic equations that are solved by means of the Newton-homotopy continuation method. Once the coordinates of points Ci are calculated, the position of the moving platform is characterized by the coordinates of the center C of the moving platform. Indeed Meanwhile, the rotation matrix Rot between the moving and the fixed platforms may be obtained as follows: where is a unit vector pointed from to and is a unit vector located in the plane of the moving platform perpendicular to . Furthermore, with the purpose to determine the orientation angles and , the rotation matrix may be also written as follows:
5. Case Study
With the purpose to illustrate the method, in this section a numerical example is provided. To this end the parameters of the parallel manipulator, using SI units, are given in Table 1.
The numerical example consists of finding all the poses that the moving platform can reach given the generalized coordinates , , and . Firstly, the closure equations are obtained according to the method introduced in Section 4. The application of (8) leads to Meanwhile based on (9) we have On the other hand, from (10) one obtains
The application of the Newton-homotopy method allows finding six real solutions for the FKP, one of them is shown in Table 2. In that regard the auxiliary homotopy function was selected as suggested in expression (3).
Furthermore, the six reachable poses of the moving platform are provided in compact form, e.g., through the computations of the center C of the moving platform and their orientation angles, in Table 3.
The numerical results obtained by means of the Newton-homotopy method were verified with the aid of special software such as the Homotopy library of Maple16™ and the free available software for general purpose solver for polynomial systems by homotopy continuation of Prof. Verschelde . For brevity, only the results obtained for the variable w9 are listed in Table 4.
It is worth noting that the numerical results obtained by means of the Newton-homotopy continuation method are in excellent agreement with those generated with Maple16™ and the PHCpack solver .
Finally, it is opportune to mention that, for limited-dof parallel manipulators, the Sylvester dialytic method of elimination is an effective option to solve the forward kinematic problem, see for instance [21–23]. However, when the number of variables is increased, the possibility of spurious or strange solutions is increased, which does not occur with the homotopy continuation method.
This work is devoted to solve the forward kinematic problem of the 3-RRS parallel manipulator, a robot with the ability to perform the 2R1T motion. The closure equations of the robot are formulated based on the unknown coordinates of the centers of the spherical joints. To the best knowledge of the author this procedure has not been employed in previous works for the robot at hand and is a genuine alternative to the classical method of kinematic analysis based on the rotation matrix, avoiding, among others drawbacks, the handling of orientation angles. Thereafter, three linear equations are generated taking into account the limited mobility imposed to the moving platform by the legs due to the parallel assembly of the revolute joints in the same limbs; e.g., the coordinates of the spherical joints are projected in the planes of the corresponding legs. On the other hand, six quadratic equations are formulated by computing the Euclidean norm between selected points of the robot manipulator; e.g., three quadratic equations are obtained upon the geometry of the moving platform while the remaining quadratic equations are obtained based on the link lengths. Afterwards, the system of equations is solved by means of the Newton-homotopy continuation method. The method is easy to follow and allows finding all the reachable poses of the moving platform. Furthermore the Newton-homotopy method guarantees convergence and the generation of spurious solutions can be avoided. A numerical example is provided with the purpose to illustrate the correctness and simplicity of the method. Finally, the numerical results are successfully compared with results generated with special software like Maple16™ and the free available software PHCpack of Prof. Verschelde .
|:||Arm and forearm of a limb|
|:||Nominal coordinates of the lower ith revolute joint|
|:||Position vector of point Ai|
|:||Nominal coordinates of the intermediate ith revolute joint|
|:||Position vector of point Bi|
|:||Center of the moving platform|
|:||Nominal coordinates of the ith spherical joint|
|:||Position vector of point Ci|
|:||Side length of the moving triangular platform|
|:||Side length of the fixed triangular platform|
|FKP:||Forward Kinematic Problem|
|:||ith generalized coordinate|
|SI:||International System of Units|
|:||Arbitrary parameter of homotopy|
|:||Unit vector denoting the orientation of the ith revolute joint|
|:||Unit vectors associated to the rotation matrix|
|:||Set of n variables|
|:||Square system of n polynomials|
|:||Auxiliary homotopy function|
|:||Multiple homotopy continuation function|
|:||Fixed reference frame with associated unit vectors|
|:||Orientation angles of the moving platform.|
The Maplesheet data used to support the findings of this study are available from the corresponding author upon request.
Conflicts of Interest
The author declares that they have no conflicts of interest.
The author gratefully acknowledges with thanks the support of the National Council of Science and Technology of Mexico (CONACYT) through the National Network of Researchers fellowship, Grant number 7903.
- X.-J. Liu and I. A. Bonev, “Orientation capability, error analysis, and dimensional optimization of two articulated tool heads with parallel kinematics,” Journal of Manufacturing Science and Engineering, vol. 130, no. 1, pp. 0110151–0110159, 2008.
- C. Shen, L. Hang, and T. Yang, “Position and orientation characteristics of robot mechanisms based on geometric algebra,” Mechanism and Machine Theory, vol. 108, pp. 231–243, 2017.
- S. Liu, Y. Yu, Z. Zhu, L. Su, and Q. Liu, “Dynamic modeling and analysis of 3-RRS parallel manipulator with flexible links,” Journal of Central South University of Technology, vol. 17, no. 2, pp. 323–331, 2010.
- R. Khajepour, H. Khajvand, H. Daniali et al., “Explicit dynamic and MTJ Control of a 3-RRS Parallel Manipulator with mass Compensator,” in Proceedings of the 2017 5th RSI International Conference on Robotics and Mechatronics (ICRoM), pp. 552–557, Tehran, Iran, 2017.
- C. Zhao, H. Guo, R. Liu, Z. Deng, and B. Li, “Design and Kinematic Analysis of a 3RRlS Metamorphic Parallel Mechanism for Large-Scale Reconfigurable Space Multifingered Hand,” Journal of Mechanisms and Robotics, vol. 10, no. 4, 12 pages, 2018.
- H. Tetik and G. Kiper, “A geometrical approach for the singularity analysis of a 3-RRS parallel manipulator,” in Computational Kinematics, Mechanisms and Machine Science, S. Zeghloul, Ed., vol. 50, pp. 349–356, Springer International Publishing, 2018.
- B. Hu, L. Zhang, and J. Yu, “Kinematics and dynamics analysis of a novel serial-parallel dynamic simulator,” Journal of Mechanical Science and Technology, vol. 30, no. 11, pp. 5183–5195, 2016.
- J. Sun, X. Zhang, G. Wei, and J. S. Dai, “Geometry and kinematics for a spherical-base integrated parallel mechanism,” Meccanica, vol. 51, no. 7, pp. 1607–1621, 2016.
- R. Di Gregorio, “The 3-RRS wrist: A new, simple and non-overconstrained spherical parallel manipulator,” Journal of Mechanical Design, vol. 126, no. 5, pp. 850–855, 2004.
- A. A. Moshaii, M. T. Masouleh, E. Zarezadeh, and K. Farajzadeh, “Static analysis of a 3-RRS and a 3-RSR Spherical Parallel Robots,” in Proceedings of the 3rd RSI/ISM International Conference on Robotics and Mechatronics, ICROM 2015, pp. 800–804, Tehran, Iran, October 2015.
- Y. Du, R. Li, D. Li, and S. Bai, “An ankle rehabilitation robot based on 3-RRS spherical parallel mechanism,” Advances in Mechanical Engineering, vol. 9, no. 8, pp. 1–8, 2017.
- J. Verschelde, “Algorithm 795: PHCpack: A general-purpose solver for polynomial systems by homotopy continuation,” ACM Transactions on Mathematical Software, vol. 25, no. 2, pp. 251–276, 1999.
- E. F. Fichter, D. R. Kerr, and J. Rees-Jones, “The Gough-Stewart platform parallel manipulator: A retrospective appreciation,” Proceedings of the Institution of Mechanical Engineers, Part C: Journal of Mechanical Engineering Science, vol. 223, no. 1, pp. 243–281, 2009.
- M. Raghavan and B. Roth, “Solwing polynomial systems for the kinematic analysis and synthesis of mechanisms and robot manipulators,” Journal of Mechanical Design, vol. 117, pp. 71–79, 1995.
- M. L. Husty, “An algorithm for solving the direct kinematics of general Stewart-Gough platforms,” Mechanism and Machine Theory, vol. 31, no. 4, pp. 365–379, 1996.
- C. Innocenti, “Forward kinematics in polynomial form of the general stewart platform,” Journal of Mechanical Design, vol. 123, no. 2, pp. 254–260, 2001.
- J.-P. Merlet, “Solving the forward kinematics of a gough-type parallel manipulator with interval analysis,” International Journal of Robotics Research, vol. 23, no. 3, pp. 221–235, 2004.
- L. Rolland, “Certified solving of the forward kinematics problem with an exact algebraic method for the general parallel manipulator,” Advanced Robotics, vol. 19, no. 9, pp. 995–1025, 2005.
- J. Schadlbauer, D. R. Walter, and M. L. Husty, “The 3-RPS parallel manipulator from an algebraic viewpoint,” Mechanism and Machine Theory, vol. 75, pp. 161–176, 2014.
- T.-M. Wu, “A study of convergence on the Newton-homotopy continuation method,” Applied Mathematics and Computation, vol. 168, no. 2, pp. 1169–1174, 2005.
- J. Gallardo-Alvarado, R. Rodríguez-Castro, and M. N. Islam, “Analytical solution of the forward position analysis of parallel manipulators that generate 3-RS structures,” Advanced Robotics, vol. 22, no. 2-3, pp. 215–234, 2008.
- B. Hu, “Formulation of unified Jacobian for serial-parallel manipulators,” Robotics and Computer-Integrated Manufacturing, vol. 30, no. 5, pp. 460–467, 2014.
- B. Hu, B. Li, and H. Cui, “Design and kinematics analysis of a novel serial-parallel kinematic machine,” Proceedings of the Institution of Mechanical Engineers, Part C: Journal of Mechanical Engineering Science, vol. 230, no. 18, pp. 3331–3346, 2016.
Copyright © 2019 Jaime Gallardo-Alvarado. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.