Abstract
A geometric modeling and solution procedure for direct kinematic analysis of 6-4 Stewart platforms with any link parameters is proposed based on conformal geometric algebra (CGA). Firstly, the positions of the two single spherical joints on the moving platform are formulated by the intersection, dissection, and dual of the basic entities under the frame of CGA. Secondly, a coordinate-invariant equation is derived via CGA operation in the positions of the other two pairwise spherical joints. Thirdly, the other five equations are formulated in terms of geometric constraints. Fourthly, a 32-degree univariate polynomial equation is reduced from a constructed 7 by 7 matrix which is relatively small in size by using a Gröbner-Sylvester hybrid method. Finally, a numerical example is employed to verify the solution procedure. The novelty of the paper lies in that the formulation is concise and coordinate-invariant and has intrinsic geometric intuition due to the use of CGA and the size of the resultant matrix is smaller than those existed.
1. Introduction
The Stewart platform [1] is a fully parallel, six-degree-of-freedom manipulator that generally consists of a base platform, a moving platform, and six limbs connected to each other in parallel. Stewart platforms have been successfully used in a wide variety of fields and industries, ranging from astronomy to flight simulators and are becoming increasingly popular in the machine-tool industry [2]. From the 1980s, Stewart platforms have attracted wide interests from researchers and engineers due to their advantages of simplicity, high stiffness, large load capacity, quick dynamic response, and excellent accuracy.
The direct kinematic analysis of Stewart platforms has been considered a challenging problem, which leads naturally to a system of highly nonlinear algebraic equations with multiple solutions. There are two main approaches to solve these equations: numerical schemes and closed-form solutions. A closed-form solution provides more information about the geometric and kinematic behavior over a numerical solution, and the closed-form univariate polynomial equation has significant theoretical values as it is fundamental to many other kinematic problems. Hence obtaining a closed-form solution to the direct kinematic analysis is clearly preferred in most cases.
In this paper, we will revisit the direct kinematic analysis of 6-4 Stewart platforms, four of which meet the platform pairwise, while the remaining two meet both base and platform singly. Numerous researchers [3–6] have worked on this problem. Hunt (1983) [3] wrongly stated that the maximum number of assembly modes for the problem was 24 by geometrical proof. Innocenti (1995) [4] derived a suitable set of five closure equations and solved the problem by a specifically developed elimination scheme, that is, a constructed 10 by 10 matrix. The number of the solutions is 36 in view of resultant form; however, the numerical result leads to a 32-degree polynomial equation in a single variable. Liao et al. (1995) [5] formulated this problem based on the vector method from equivalent mechanisms and obtained all the 32 solutions by constructed 10 by 10 resultant matrix. The solution procedure is complex due to numerous vector computations. Zhang et al. (2012) [6] also modeled this problem based on the trilateration method and vector method from equivalent mechanisms and the solution procedure is the same as [5]. It is concluded from the above-mentioned literature that the modeling and the solution procedure either are formulated algebraically from the equivalent mechanisms or require resultant elimination. The size of the constructed resultant matrix is all 10 by 10.
Conformal geometric algebra (CGA) [7–10] is a relatively new mathematical tool for geometric representation and computation. Essentially, CGA represents various geometric entities of points, spheres, lines, planes, circles, and point pairs in a systematical hierarchy of multiple grades. More importantly, CGA provides direct algebraic operations on these geometric entities which typically lead to simple, compact, coordinate-invariant formulations and enables complicated symbolic geometric computations. The above-mentioned properties are two superior characteristics of CGA. Hence it is very efficient for geometric modeling and computation for kinematic problem of mechanisms and robotics. In recent decades, CGA has been mostly applied to solve the inverse kinematics problem of the serial mechanisms [11–14] via CGA operation of the geometric entities. In addition, Tanev [15, 16], Kim et al. [17], and Huo et al. [18] employed CGA to study the singularity analysis of PMs. Huo et al. [18] and Li et al. [19] proposed a mobility analysis approach for PMs based on geometric algebra. Zhang et al. [20, 21] and Wei et al. [22] applied CGA to solve the direct kinematics of parallel mechanisms.
In this paper, we will formulate the direct kinematic analysis problem of 6-4 Stewart platform using CGA and then construct a 7 by 7 resultant using Gröbner-Sylvester hybrid method [23, 24] which finally leads to a 32-degree univariate polynomial equation without extraneous roots. The derived coordinate-invariant equation is also applicable to other Stewart platforms or parallel mechanisms whose number of spherical joints on the moving platform is equal to 4.
The rest of the paper is organized as follows: In Section 2, the fundamentals of CGA are introduced. In Section 3, the geometric modeling for the direct kinematic analysis of 6-4 Stewart platforms is formulated based on CGA. Section 4 proposes the elimination procedure and finally reduces a 32-degree univariate polynomial equation from a constructed 7 by 7 matrix by Gröbner-Sylvester hybrid method. In Section 5, a numerical example is provided to verify our solution procedure. Finally, conclusions and future work will be given in Section 6.
2. Fundamentals of Conformal Geometric Algebra
In geometric algebra, the fundamental algebraic operators are the inner product (), the outer product (), and the geometric product ().
The 5-dimensional (5D) CGA is derived from a 3D Euclidean space and a 2D Minkowski space . CGA has five orthonormal basis vectors given by with the following properties:where are the three orthonormal basis vectors in the Euclidean space and are the two orthogonal basis vectors in Minkowski space.
In addition, two null bases can now be introduced by the vectorswith the propertieswhere is the conformal origin and is the conformal infinity.
Blades are the basic computational elements and the basic geometric entities of the geometric algebra. The grade of a blade is simply the number of linearly independent vectors that are “wedged” together. The 5D CGA consists of blades with grades 0, 1, 2, 3, 4, and 5. A linear combination of the -blades is called a k-vector, and a linear combination of blades with different grades is called a multivector. The blades with the maximum grade in CGA, that is, 5-blades, are called pseudoscalars and denoted by .
According to (1)–(3), the inner () and outer () products of two 1-vectors are defined as
As extension, the inner product of an -blade with an -blade can be defined recursively bywith
We define the dual of a multivector bywhere is the inverse of and is equal to .
CGA provides the representation of primitive geometric entities for intuitive expression. The primitive geometric entities in CGA consist of spheres, points, lines, planes, circles, and point pairs. The representation of the geometric entities with respect to the inner product null space (IPNS) and the one with respect to the outer product null space are, respectively, listed in Table 1. These two representations are dual to each other and therefore can be converted by dual operator. In Table 1, the small bold character represents the point or vector in the Euclidean space, while the bold underlined character represents the basic geometric entity in the conformal space. For more information, please refer to [9, 10].
According to (1)–(3), the inner product between two conformal points is calculated aswhere denotes the Euclidean distance between the two points.
From (8), we have .
In the next section, we will formulate the direct kinematics of 6-4 Stewart platforms via CGA operation and derive the univariate polynomial equation.
3. Geometric Modeling for Direct Kinematics of 6-4 Stewart Platforms Based on CGA
A 6-4 Stewart platform , shown in Figure 1, has six SPS (S: spherical joint, P: prismatic joint) legs, four of which meet the moving platform pairwise, while the remaining two meet both the base and the moving platform singly. The six limb lengths provided by P-joint in every limb are six inputs to control the position and orientation of the moving platform. For the general 6-4 Stewart platforms, the six S-joints on the base and the four S-joints on the moving platform are not restricted to lie in a plane, respectively. Let and denote the coordinates of the center of the S-joints and in the Euclidean space, respectively; let denote the distance of the two S-joints on the moving platform, where the coordinates are unknown. Next, we will formulate the two single S-joints and on the moving platform by the intersection, dissection, and dual of the basic geometric entities under the frame of CGA.
3.1. The CGA Representation of the Positions of Two Spherical Joints and
As seen from Figure 1, in the tetrahedron , the S-joint must be located on a sphere of radius with its center at point , a sphere of the radius with the center at point , and a sphere of the radius with the center at point . Thus, the actual locus of point must be located on the intersection of the three spheres , , and . From the knowledge of geometry, it is known that the locus of this intersection will be a point pair . And therefore, according to Table 1, the point pair can be formulated in CGA aswhere the three spheres , , and can be represented in CGA as
According to Table 1, the three centers of S-joints , , and can be represented in CGA as
According to (7), the dual of the point pair is represented as
Point is dissected from the dual of the point pair in the conformal space as [21, 22]where , , , and . Please note that the expression of point in (13) is in its standard and normalized form; that is, the magnitude is equal to 1.
For the S-joint on the moving platform, it can be seen from Figure 1 that, in the pentahedron , point is the intersection point of four spheres , , , and , that is, the sphere of the radius with its center at point , the sphere of the radius with the center at point , the sphere of the radius with the center at point , and the sphere of the radius with the center at point . Therefore according to Table 1, the dual of point is represented in CGA aswhere the four spheres , , , and can be represented in CGA as
According to Table 1, the centers of S-joint can be represented in CGA as .
Point is reduced from (7) and (14) aswhere and is dual to the point pair , which is generated by the intersection of three spheres , , and .
Please note the expression of point is not in its standard and normalized form; that is, the magnitude is not equal to 1 and we can obtain its standard and normalized form by dividing (16) using its magnitude .
3.2. The Derivation of the Coordinate-Invariant Polynomial Equation
According to (8), we can readily obtain
However, due to the volume sign of the tetrahedron , it will lead to the symmetric extraneous roots with respect to the plane if we obtain the coordinate-invariant equation only from (17). In order to avoid the extraneous roots, we will use its volume of the tetrahedron to geometrically model the direct kinematics of 6-4 Stewart platforms.
The volume of the tetrahedron is expressed in CGA as [7]where is a known scalar and in fact is six times the volume of the tetrahedron . When four points on the moving platform lie in the same plane, ; if not, may be positive or negative depending on point locating above or below the plane .
Multiplying both sides of (18) with a scalar and then expanding it according to (5), we obtainwhere
By transposing and combining the terms in (19), we havewhere .
Substituting (13) into (21) and then expanding (21), we have
Taking the square of both sides of (22) and combining terms, we obtain
Simplifying (23) by using (1)–(5) and taking only the numerator, we havewhere , , and The detailed expansion of the term is given in the appendix.
The derivation of (24) is coordinate-invariant due to the use of CGA, and (24) depends on only the design parameters, the inputs, and the positions of points and .
3.3. The Derivation of the Other Five Constraint Equations
Equation (24) is the first constraint equation in the positions of two pairwise S-joints and on the moving platform. According to the limb length and (8), the other five constraint equations can be formulated as
Equations (24)–(29) are the six constraint equations for direct kinematics of 6-4 Stewart platforms. In next section, we will derive a univariate high-degree polynomial equation for this problem by using Gröbner-Sylvester hybrid method [23, 24].
4. Solution Procedure
4.1. An Univariate Equation by Using the Gröbner-Sylvester Hybrid Method
In this section, the main aim is to obtain the univariate high-degree polynomial equation, from which the solutions of direct kinematics of 6-4 Stewart platforms can be obtained. In order to get the position of the four S-joints on the moving platform, first of all, we attach a reference coordinate frame with its origin anywhere, and let denote the coordinate of the S-joint and denote the coordinate of the S-joint in the reference frame. And therefore, (24)–(29) are six constraint equations in variables , , , , , .
For (24)–(29), changing the exponent of the three variables , , and four times the original one and using the Gröbner basis theory under the degree reverse lexicographic term ordering with yield a Gröbner basis with 15 polynomials with the suppressed variable as follows:where means the polynomial of the product terms in the bracket, of which the coefficients are comprised of products of power in the variable and real constants depending on the link parameters and inputs only.
By analyzing the bases in (30), we will notice that in , the product terms underlined only exist in their own bases, and their coefficients are real constants depending on the link parameters and inputs only. And therefore when we set up the matrix form equation, we only need other 7 polynomials to construct the following equation due to no effect on the solution procedure after deleting :where is a 7 by 7 matrix, of which the elements are polynomials in .
The vanishing of the determinant of the coefficient matrix gives necessary condition for polynomials (30) to have common solutions; that is, (24)–(29) have common solutions, so we can get an equation in :where is the determinant of the matrix .
By expanding each element of the matrix , we can get the degrees in as shown below:
Therefore expanding (32), we can obtain an equation of the highest degree in as follows:where are real constants depending on the link parameters and inputs only.
4.2. Back Substitution
Solving (34), all the 32 solutions for can be gotten. In (31), we choose any 6 of 7 equations and substitute the 32 solutions of into the linear system; using the Cramer’s rule, we can obtain the corresponding values of , , and by solving the system linearly. And substitute the 32 solutions of into and , we can obtain the values of and , respectively. Now the coordinates of two S-joints and are all obtained.
For the coordinates of S-joint , it cannot be determined only in terms of (13) after substituting the coordinates of two S-joint and . The choice of the positive or negative sign can be obtained from the ratio of two terms and . If the ratio is equal to 1, we choose the positive sign and vice versa. If both the two terms are equal to 0, we choose the sign depending on whether the term equals 0. If the term equals 0, we can choose any sign and it will reduce to the same results. If the term is not equal to 0, we determine the sign by making sure that the value of is not equal to 0. After we choose the right sign in (13), we can obtain the coordinates of point . The coordinates of the S-joint can be obtained from (16) by dividing its magnitude after substituting the coordinates of the joints , , and .
5. Numerical Example
In order to validate the solution procedure, the link parameters and inputs of the numerical example are given in Table 2 and are the same as [6]. Due to the space limitation, the real solutions are only given in Table 3. The computation time of the closed-form solution is just about 0.3 s in Mathematica 11.0 running on a PC with Intel Core i7-6700 CPU @ 3.4 GHz and 8 GB RAM. The approach is very efficient.
6. Conclusion
The paper has proposed a CGA-based formulation and solution procedure for the direct kinematic analysis of 6-4 Stewart platforms with any link parameters. Thanks to the intuitiveness of CGA, the representations of the positions of two single spherical joints have explicit geometric meaning. A coordinate-invariant polynomial equation was derived via CGA operation and it is feasible to other Stewart platforms or parallel mechanisms whose number of spherical joints on the moving platform is equal to 4. The univariate polynomial equation has been derived by constructing a 7 by 7 resultant matrix which is more compact and smaller than those published in the literature. Compared with the previous methods in the literature, the main contribution of the paper lies in that the formulation has geometric meaning due to the intuitiveness of CGA and, in addition, the size of the matrix is smaller than those existed. In future, we will extend this approach to the direct kinematics of other Stewart platforms or complicated parallel mechanisms.
Appendix
Derivation of the Term
The expansion of is expressed aswhere , and .
During the process of expansion, we use the following expressions:and according to , we obtain
Conflicts of Interest
The authors declare that there are no conflicts of interest regarding the publication of this paper.
Acknowledgments
The authors acknowledge funding provided by the National Natural Science Foundation of China (no. 51605036), Beijing Natural Science Foundation (no. L172031), and the Fundamental Research Funds for the Central Universities for this research.