[go: up one dir, main page]

Next Article in Journal
The Effects of Psychophysical Methods on Spectral and Spatial TOJ Thresholds
Next Article in Special Issue
Real Depth-Correction in Ground Penetrating RADAR Data Analysis for Bridge Deck Evaluation
Previous Article in Journal
Blockchain-Based Peer-to-Peer Transactive Energy Management Scheme for Smart Grid System
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

A Geometric Approach for Real-Time Forward Kinematics of the General Stewart Platform

1
School of Intelligent Systems Engineering, Sun Yat-sen University, Guangzhou 510275, China
2
Department of Advanced Design and Systems Engineering, City University of Hong Kong, Hong Kong
*
Author to whom correspondence should be addressed.
Sensors 2022, 22(13), 4829; https://doi.org/10.3390/s22134829
Submission received: 27 May 2022 / Revised: 19 June 2022 / Accepted: 23 June 2022 / Published: 26 June 2022

Abstract

:
This paper presents a geometric approach for real-time forward kinematics of the general Stewart platform, which consists of two rigid bodies connected by six general serial manipulators. By describing the rigid-body motion as exponential of twist, and taking advantage of the product of exponentials formula, a step-by-step derivation of the proposed algorithm is presented. As the algorithm naturally solves all passive joint displacements, the correctness is then verified by comparing the forward-kinematic solutions from all chains. The convergence ability and robustness of the proposed algorithm are demonstrated with large amounts of numerical simulations. In all test cases, the proposed algorithm terminates within four iterations, converging with near-quadratic speed. Finally, the proposed algorithm is also implemented on a mainstream embedded motion controller. Compared with the incremental method, the proposed algorithm is more robust, with an average execution time of 0.48 ms, meeting the requirements of most applications, such as kinematic calibration, motion simulation, and real-time control.

1. Introduction

The Stewart platform, originally proposed by D. Stewart in 1965 [1], is one of the most celebrated parallel manipulators. As illustrated in  Figure 1, it has a mounting base B and a moving platform P, connected by six linear actuators via spherical/universal joints. The Stewart platform has wide applications in flight simulation, animatronics, crane technology, underwater research, robotics and so on. Compared with its serial counterparts, the Stewart platform has higher force/torque capacity, greater structure rigidity and superior positioning accuracy. However, the complex coupling of chains also greatly increases the difficulties in forward kinematics, which is essential for both theoretical analysis and practical applications.
For the real-time control of the general Stewart platform, either with optimized design or after kinematic calibration, a fast forward kinematics algorithm must be developed. Denoting b i and p i as the center points of the spherical joints corresponding to the i-th chain, the forward kinematics of the Stewart platform is equivalent to solving the following equations [2]:
R p i + T b i = L i , for i = 1 , 2 , 6 ,
where R and T are the rotation matrix and translation vector of the moving platform to be solved, L i is the given length of i-th leg.
Existing methods can be generally divided into four categories, analytical methods, numerical methods, extra-sensor methods, and intelligent algorithms. Initially, most researchers focused on finding all possible closed forms by considering special configurations where some of the base or platform spherical joints coincide. Griffis et al. [3] considered the forward kinematics of a 3–3 Stewart platform and obtained an eighth degree polynomial. Lin et al. [4] solved the forward kinematics of the 4–4 case. More difficult cases, such as 5–4 [5,6] and 6–4 [7] Stewart platforms were also solved analytically. The final 6–6 case was independently analysed and solved, such as in Wen et al. [8], Sreenivasan et al. [9], and Dasgupta et al. [10]. Further study of Equation (1) showed that the forward kinematics eventually boiled down to a univariate polynomial of 40-th order [11,12,13]. To actually compute these solutions, a number of root-finding methods were then proposed, including algebraic elimination [14,15,16], interval analysis [17], and continuation [12,18].
Although analytical methods can obtain all possible solutions to forward kinematics, they are sensitive to numerical errors. Moreover, in real applications, an extra procedure must be presented to determine a unique actual pose from all possible solutions. Numerical methods and extra-sensor methods are two common schemes for this purpose. Since forward kinematics essentially boils down to solving non-linear equations, Newton–Raphson iterative algorithms [19,20,21] were adopted extensively for their high computational efficiency and fast convergence speed. Xie et al. [22] formulated the forward kinematics as an unconstrained optimization problem on SE ( 3 ) and compared their results with the Euler angle and quaternion parametrization schemes. However, the convergence of Newton–Raphson method depends heavily on the selection of initial values. Yang et al. [23] proposed the global Newton–Raphson method with monotonic descent algorithm to achieve global convergence regardless of the initial guess. Wang [24] tackled the issue by adopting a series of small leg length changes to finally obtain a unique forward kinematic solution. Pratik et al. [25] proposed a hybrid strategy that used a neural network as a bootstrap for the standard Newton–Raphson algorithm to yield a unique solution. The forward kinematics can also be settled with auxillary sensors. To simplify the sophisticated forward kinematics, as well as obtain a unique solution simultaneously, Bonev et al. [26] used three linear sensors connecting the moving platform and the base, Chiu et al. [27] used two rotatory sensors and one displacement sensor, and Cheng et al. [28] used one linear sensor to measure the distance of the moving platform. Although the extra-sensor method is proven effective, it comes with extra economic cost as well as assembly and measurement errors, which significantly limits the application range.
Recently, some researchers had also used machine learning techniques, such as support vector machines [29] and artificial neural network [30,31], to solve the problem. Chauhan et al. [32] proposed soft-computing-based schemes to resolve the forward kinematics of the Stewart platform, in which a neural-network-based function estimator was proposed for the forward kinematics and then trained the network with meta-heuristic optimization procedures to revise the weights and bias values of the neural network. The major problem with learning techniques is that the training process requires an abundant amount of data and usually takes hours for fine-tuning. Moreover, if kinematic calibration is present, the training process has to be done for every machine.
Although a lot of research has been done on the forward kinematics of the 6-SPS, the forward kinematics of the general Stewart platform has not yet been fully explored. Most existing works focused on the standard 6-SPS structure, very few authors considered other variants of the Stewart platform such as 6-RUS [33] and 6-RSS [34]. The so-called general Stewart platform studied in existing works is actually a 6-SPS type platform with non-planar base and moving platform, which is inadequate for applications such as geometric calibration. For the general Stewart platform considered herein, every chain is essentially a general 6-degrees-of-freedom serial manipulator, with planar or non-planar mounting base and moving platform. By general serial manipulator, each joint can be prismatic, revolute, or helical, with no presumed geometric constraints between joints, such as perpendicularity, parallelism, and intersection. From here onwards, the general Stewart platform, if not otherwise stated, adheres to the above definition. Such generalization allows the control of a wide range of modified Stewart platforms designed to fulfil specific optimization criteria or special task requirements, such as in [35,36], where the modified Stewart platform was designed for better dexterity. In [37], a special Stewart platform with non-intersecting U-joint was considered for precision surgery, which clearly violates Equation (1). Moreover, such generation enables the kinematic calibration of the Stewart platform. Wang et al. [38] showed that the accuracy of the Stewart platform can be of the same level as a serial manipulator with the same nominal dimensions owing to manufacturing tolerances. Later, Masory et al. [39] showed that the accuracy of the Stewart platform can be enhanced by at least one order of magnitude after kinematic calibration, for which purpose, an error model of the Stewart platform, which can be regarded as the general Stewart platform, was established.
In this paper, we intend to develop a numerical algorithm for real-time forward kinematics of the general Stewart platform. For this purpose, a geometric approach is adopted for describing rigid body motion. Different from Denavit–Hartenberg and dual-quaternion parametrization, the geometric approach describes rigid body motion via exponential mapping of twist. The product of exponentials (POE) formula is utilized for the forward kinematics of the general serial manipulator. Using a loop closure condition, a very nice and neat differential relationship between task space and joint space are then established, based on which an iterative algorithm is presented. Simulation studies are then carried out to verify the effectiveness and convergence ability of the proposed algorithm. Finally, the algorithm is implemented on an embedded controller to demonstrate its capability in real applications.
The major contributions of this paper are summarized as follows.
  • A geometric algorithm is proposed for real-time forward kinematics of the general Stewart platform, with no geometric constraints, such as perpendicularity, parallelism, and intersection, are presumed between joints. The proposed method is derived with regard to a general Stewart platform, and can be readily applied to other existing spatial manipulators, including but not limited to 6-RUS and 6-RSS manipulators.
  • The proposed algorithm is successfully implemented on an embedded controller. Compared with the incremental method, which only applies to 6-SPS method, the proposed algorithm is more robust, with a comparative execution time of 0.48 ms, which is sufficient for most real-time applications.
The rest of this paper is organized as follows. In Section 2, an introduction to the mathematical foundation of the proposed geometric method is presented, based on which the details of the proposed forward kinematics algorithm is presented in Section 3. To demonstrate the effectiveness of the proposed algorithm, simulations and experiments are presented in Section 4. Finally, Section 5 concludes this paper.

2. Notation and Terminology

In this section, we present the mathematical tools for modelling a general serial robot, the notation and motivation presented herein basically follow [40].

2.1. Lie Group and Lie Algebra

Mathematically, a Lie group is a group that is also a differentiable manifold. To every Lie group we can associate a Lie algebra whose underlying vector space is the tangent space of the Lie group at the identity element. An elementary introduction to Lie group and Lie algebra can be found in [41].
The collection of all rotation matrices, known as the special orthogonal group SO ( 3 ) , is a Lie Group. The corresponding Lie algebra, denoted as so ( 3 ) , is the set of all screw-symmetric 3 × 3 matrices. so ( 3 ) and R 3 are isomorphic via the hat operator ( · ) : R 3 so ( 3 ) , defined as follows:
( · ) : ω 1 ω 2 ω 3 0 ω 3 ω 2 ω 3 0 ω 1 ω 2 ω 1 0 .
Additionally, the inverse of the hat operator is defined as the vee operator ( · ) : so ( 3 ) R 3 .
The set of all the rigid body transformations, known as the special Euclidean group SE ( 3 ) , is also a Lie group. An element g SE ( 3 ) can be completely described by a 4 × 4 homogeneous matrix:
g = R P 0 1 R 4 × 4 ,
where R SO ( 3 ) denotes the rotation between the two coordinate frames and P R 3 denotes the spatial displacement of the origin. The corresponding Lie algebra se ( 3 ) is isomorphic to R 6 , with the hat operator ( · ) : R 6 se ( 3 ) defined as
( · ) : v ω ω ^ v 0 0 .
Likewise, the inverse of the hat operator is defined as the vee operator ( · ) : se ( 3 ) R 6 .
Given a rigid body motion g ( t ) SE ( 3 ) , the spatial velocity and body velocity are defined as
V s = ( g ˙ g 1 )
V b = ( g 1 g ˙ ) .
The spatial velocity and body velocity are essentially the same thing expressed in different frames, their relationship can be conveniently expressed using the adjoint map associated with g, A d g ( · ) : se ( 3 ) se ( 3 ) defined as
Ad g ( · ) : ξ g · ξ ^ · g 1 .

2.2. Exponential Map

For a vector field X in tangent space T e G at group identity e, there exists a smooth one-parameter subgroup γ X ( t ) of a Lie group G parametrized by a scalar t R . There also exists an exponential map defined as
exp : T e G × R G , ( X , t ) exp ( t X ) .
For SO ( 3 ) and SE ( 3 ) , the exponential map corresponds to the usual matrix exponentiation exp ( · ) : R n × n R n × n ,
exp ( · ) : M n = 0 1 n ! M n .

3. Forward Kinematics of the General Stewart Platform

In this section, armed with the tools presented in Section 2, an algorithm is proposed for the forward kinematics of the general Stewart platform.

3.1. Kinematics of General Serial Robot

For a general serial robot with any number of helical joints, as shown in  Figure 2, usually a spatial frame S and a tool frame T are attached at the base and the end-effector, respectively. The transformation of tool frame with respect to the spatial frame can be expressed via the POE formula [40]:
g s t ( Θ ) = e ξ ^ 1 θ 1 e ξ ^ n θ n g s t ( 0 ) ,
where ξ i and θ i are the twist and displacement corresponding to the i-th joint, respectively; g s t ( 0 ) is the initial rigid displacement between the tool frame and the spatial frame.
The spatial velocity of the tool frame is defined as
V s t = g ˙ s t g s t 1 = ξ 1 ξ 2 ξ n θ ˙ 1 θ ˙ 2 θ ˙ n T ,
where
ξ i = ξ 1 i = 1 , k = 1 i 1 Ad e ξ ^ k θ k ξ i otherwise .
The spatial Jacobian matrix is defined as
J s t = ξ 1 ξ 2 ξ n .
At this point, it is worth mentioning that when d Θ is small enough,
g s t ( Θ + d Θ ) g s t ( Θ ) J s t d Θ g s t ( Θ ) .
The relation follows directly from the definition of V s t , and shall be useful in the following derivations.

3.2. The Proposed Algorithm

First of all, consider the i-th chain of the general Stewart platform, denote ξ i j and θ i j twist and joint displacement of the j-th joint. According to Equation (10), the forward kinematics can be written as:
g i = j = 1 6 e ξ ^ i j θ i j g i ( 0 ) ,
where g i ( 0 ) is the initial rigid body displacement. It is shown that the minimal number of parameters needed to determine the initial position of joint twists and rigid body displacements is 5 h + 4 r + 2 t + 6  [42,43], where h is the number of helical joints, r is the number of revolute joints, t is the number of prismatic joints, and the constant 6 refers to the number of parameters needed to determine the initial rigid displacement. For instance, the Stewart platform considered later in Section 4 contains 1 helical joint, 4 revolute joints, and 1 prismatic joint in each chain, hence 29 geometric parameters are needed. Subsequently, a set of 174 geometric parameters are needed for all six chains.
At this point, the forward kinematics of the general Stewart platform is equivalent to solving the following equations:
g i = g s t , for i = 1 , 6 ,
where g s t is the 4 × 4 homogeneous matrix representing the configuration of tool frame at a given input to solve. Excluding the actuator of each chain, there are a total of 30 unknown passive joint displacements, meanwhile there are 6 unknowns in g s t . Hence, a total of 36 unknowns are present. On the other hand, each of the equations provides essentially 6 constraints, so the number of constraints is 36 in general (degenerate in case of singularities). Hence, the system of equations is complete as the number of variables agrees with the number of constraints. To solve the forward kinematics, consider the m-th and the n-th chains of the general Stewart platform, immediately we have
g m = g s t = g n ,
where g m and g n denote the forward kinematics of m-th and n-th chains, respectively. Generally, Equation (17) does not hold at initial joint values. Nonetheless, according to Equation (14), if the joint deviations are small enough, the following approximation holds:
( J m δ Θ m ) + I 4 g m ( J n δ Θ n ) + I 4 g n ,
where J m and J n are the spatial Jacobians corresponding to m-th chain and n-th chain, respectively; δ Θ m and δ Θ n are the joint deviations corresponding to m-th chain and n-th chain, respectively. Multiplying both sides with g m 1 , the following approximation is obtained with some re-arrangements:
( J m Θ m ) ( J n Θ n ) ( g n g m 1 ) g n g m 1 I 4 .
In case the joint deviations are small enough, the following approximation can be safely used:
( J n Θ n ) g n g m 1 ( J n Θ n ) .
Substitution back into Equation (19) yields
( J m Θ m ) ( J n Θ n ) g n g m 1 I 4 ,
which up to the first order is equivalent to
J m δ Θ m J n δ Θ n log ( g n g m 1 ) ,
where log : SE ( 3 ) se ( 3 ) is the inverse operator of exp ( · ) , and log ( g n g m 1 ) abbreviates for log ( g n g m 1 ) . To this point, a differential relationship between joint space and task space for any two chains has been established. To discriminate the active and passive joints, notice that
J m δ Θ m = J a m δ Θ a m + J p m δ Θ p m ,
where Θ a m and Θ p m are the active and passive joint displacements of the m-th chain, respectively; J a m and J p m are the Jacobian matrices corresponding to the active and passive joints of the m-th chain, respectively. In the case of the forward kinematics, the joint displacements of the actuators are known a priori, namely, δ Θ a m = 0 . Hence Equation (22) is equivalent to
J p m δ Θ p m J p n δ Θ p n log ( g n g m 1 ) .
While Equation (24) holds for any two chains, it can be shown that only 5 of which are linearly independent. For a start, it is feasible to fix m = 1 and let n iterate over the remaining chains. Alternatively, it is also possible to use the information of adjacent chains, which in matrix form is written as
J p δ Θ p δ P ,
where
J p = J p 1 J p 2 0 0 0 0 0 J p 2 J p 3 0 0 0 0 0 J p 3 J p 4 0 0 0 0 0 J p 4 J p 5 0 0 0 0 0 J p 5 J p 6 ,
δ Θ p = δ Θ p 1 T δ Θ p 2 T δ Θ p 3 T δ Θ p 4 T δ Θ p 5 T δ Θ p 6 T T ,
δ P = log ( g 2 g 1 1 ) T log ( g 3 g 2 1 ) T log ( g 4 g 3 1 ) T log ( g 5 g 4 1 ) T log ( g 6 g 5 1 ) T T .
Based on Equation (25), an algorithm for solving the forward kinematics of the general Stewart platform is summarized in Algorithm 1. When the Stewart platform is close to singularity, the small deviation in task space amounts to great joint movement, which is undesirable for real applications. To increase the robustness in the case of singularities, the algorithm uses damped least-square method in step 3. The damped least squares method, also known as the Levenberg–Marquardt method, avoids many of the pseudo-inverse method’s problems with singularities and can give a numerically stable solution. It was first used for inverse kinematics by Wampler [44] and Nakamura and Hanafusa [45].
Algorithm 1 Forward kinematics of the general Stewart platform.
Input:
  • Twist coordinates of all chains, ξ i j , i , j = 1 6 ;
  • Initial rigid displacements of all chains, g i ( 0 ) , i = 1 6 ;
  • Initial joint displacements of all joints for all chains, θ i j ( 0 ) , i , j = 1 6 ;
  • Absolute tolerance, ε ;
  • Damping factor, λ .
Output:
 
 Tool displacement g s t ;
1:
Calculate tool frame pose g i and spatial Jacobian J i of each chain according to Equations (10) and (13);
2:
Calculate J p and δ P according to Equations (26)–(28);
3:
Solve Equation (25), δ Θ p = ( J p T J p + λ 2 ) 1 δ P ;
4:
Update passive joint values, Θ p = Θ p + δ Θ p ;
5:
If δ Θ p > ε , go to step 1;
6:
return  g s t as arbitrary g i , i = 1 , 2 , 6 .

4. Simulations and Experiments

In this section, simulations and experiments are conducted to demonstrate the performance of the proposed algorithm in terms of correctness, robustness, convergence ability, and execution time.

4.1. Simulation Setups

Figure 3a shows the CAD model of the general Stewart platform used in the simulation. For each chain shown in Figure 3b, six joints can be identified, where (a) ξ i 1 and ξ i 2 are two revolute joints corresponding to the lower U-joint; (b) ξ i 3 is the linear actuation joint; (c) ξ i 4 is a screw joint; and (d) ξ i 5 and ξ i 6 are two revolute joints corresponding to the upper U-joint. Different from the traditional U-joint, the two shafts of both the lower and the upper U-joints do not intersect with each other.
The home position of the i-th chain is also defined in Figure 3b, where (a) ξ i 2 is parallel to the base plane; (b) ξ i 3 and ξ i 4 are perpendicular to ξ i 1 and ξ i 2 ; (c) ξ i 5 is parallel to ξ i 2 ; and (d) ξ i 6 is parallel to ξ i 1 . The moving platform is determined such that it is parallel to the base. As in Figure 4, to describe the initial twist coordinates and rigid displacement of the i-th chain, a set of 11 geometric parameters are needed. These parameters are tabulated in Table 1. The twist coordinates can then be calculated with respect to the chain kinematic parameters. The initial rigid displacement of each chain can be determined in a similar way, as in Table 2.

4.2. Correctness of the Proposed Algorithm

The proposed algorithm naturally solves the displacements of all passive joints, the correctness of which can therefore be verified by comparing the forward kinematics of all six chains. If the results from all chains differ within an acceptable range, the forward kinematics solution along with all the passive joint displacements constitute a valid configuration of the general Stewart platform. As there exists no bi-invariant distance between two elements g 0 , g 1 of SE ( 3 ) , the spatial distance and rotational distance shall be treated separately. For any two rigid body displacements g 0 and g 1 ,
δ g = 0 δ z δ y δ α δ z 0 δ x δ β δ y δ x 0 δ γ 0 0 0 0 = log ( g 0 g 1 1 ) .
The position error vector is identified as v = δ x δ y δ z T , whose norm will be adopted as the position error. Similarly, the orientation error vector is identified as ω = δ α δ β δ γ T , whose norm will be used as the orientation error.
The standard sine wave trajectory is imposed on each actuator, i.e., L i = A i sin ( ω i t + ϕ i ) + B i . To simulate varying poses, different angular velocities are specified for each chain, as in Table 3. The motion profile lasts 10 s, with forward kinematics evaluated every 10 ms. The stopping threshold is set to 10 6 , such that the maximum error will be less than 10 6 mm or 10 6 rad in all directions. Forward kinematics from the first chain is used as the return value of our algorithm, with which the results from every other chain will be compared. The resulting position and orientation errors are shown in Figure 5, where the position errors and the orientation errors are on the order of 10 12 mm and 10 8 rad, respectively, far less than the specified threshold. Hence the forward kinematic solution is accurate.
If the above solution is feasible for real applications, the trajectories of all joints should also be smooth. Figure 6 shows the trajectories of all joints during the simulation. For better visualization, joints are grouped by their orders in each chain. For example, Figure 6a plots the first joint, which is passive, of each chain, and Figure 6c corresponds to the trajectories of the active joint of each chain. Clearly, all the joint trajectories are smooth, therefore the Stewart platform transits to the final configuration smoothly.

4.3. Convergence and Robustness of Proposed Algorithm

To test the convergence ability and robustness of the proposed algorithm, random actuator commands are sent to the Stewart platform at home position. The maximum allowed speed of the linear actuator is around 30 mm/s, which means the joint deviation from last pose is less than 0.3 mm, assuming the cycle time being 10 ms. To test the robustness of proposed algorithm, this deviation is enlarged by a factor of 10. Randomly generated deviations uniformly distributed over [−3, 3] mm are set to all the actuators for one million times. The threshold for termination is 10 6 , the same as that in the previous simulation.
In all test cases, the algorithm converges with maximum iteration being 4. To visualize the convergence speed, Figure 7 shows the errors at each iteration for 100 randomly selected cases. As can be seen from the figure, the error magnitude almost squared after each iteration and terminated with a maximum of 4 iterations. Therefore, the proposed algorithm possesses a near-quadratic convergence speed, which is not surprising for Levenberg–Marquardt algorithms.

4.4. On-Board Implementation for Real-Time Control

To test the execution time in real applications, the proposed algorithm is implemented on a motion controller platform (iDEABOX 3 Pro intelligent controller), equipped with an Intel Bay Trail J1900 processor at 2.0 GHz. The cycle time of the controller is set to 10 ms. Figure 8 shows the hardware setup for our experiment. The same joint trajectory as in Section 4.2 is commanded to the controller, with termination threshold ε set to 10 6 and damping factor λ set to 10 8 . The incremental method proposed in Wang [24] is implemented here as a comparison, using the same termination threshold. The maximum iteration counts for both algorithms are set to 20. There are some clarification to be made clear
  • The testing Stewart platform violates Equation (1), as it has non-intersecting upper and lower universal joints. Therefore the incremental method can’t be used. However, since P 5 and P 7 in Table 1 are quite small, in our implementation we manually set them to 0 such that the incremental method become feasible. Although such modification changes the kinematic model and is not applicable in practise, the results should still provide insights regarding the robustness and speed of the proposed algorithm.
  • To address the initial value problem, the Stewart platform is set to start at home pose for the first control cycle, namely Θ = 0 0 0 0 0 0 T . Accordingly, the following initial end-effector displacement is used
    g ( 0 ) = 1 0 0 0 0 1 0 0 0 0 1 114.75 0 0 0 1 .
    From the second cycle and onwards, the last cycle pose is used as the initial value.
Figure 9 plots the execution times and iteration counts of both algorithms, and Table 4 summarizes some key statistics. Since the incremental method doesn’t always converge, the statistics of convergent cases are also listed.
From the results we can see that compared with the incremental method, which only applies to the 6-SPS model, the proposed algorithm is more robust, with a comparative execution time of 0.48 ms. Specifically,
  • The proposed algorithm converges at all command points, while the incremental method fails in multiple cases. Further experiment shows that the incremental method converges in all points if the magnitude of all joint trajectories decreases to 15 mm. In other words, the proposed algorithm has a larger convergent area than the incremental method, and thus is more robust. One reason that might account for the difference is that the incremental method is a Newton–Raphson method, and the proposed method belongs to Levenberg–Marquardt, which is generally considered more robust.
  • In cases where both algorithms converge, average iteration counts are 3.13 and 2.99, respectively, indicating that the two algorithms share basically the same convergence ability. This can be explained as the Levenberg–Marquardt degenerating to a Newton–Raphson when using a very small damping factor.
  • In case the incremental method converges, the execution time is around half of the proposed method’s. Since the iteration counts for two algorithms are almost identical, we conclude that the complexity of the iteration equation leads to the difference. Indeed, although J p is quite sparse, it is a 30-by-30 matrix, whereas the counterpart in the incremental method is 6-by-6. To this point, we would like to mention that the extra complexity is not for nothing. For one thing, the incremental method is constructed for the ideal 6-SPS platform, so it can’t be applied directly to other variants such as the 6-RSS. Moreover, subject to manufacturing ability, a calibration process is usually needed to increase the accuracy. For this purpose, an error model is indispensable, which might break Equation (1) by considering imperfect ball joints. The incremental method is infeasible in both cases. Whereas the proposed method can still be adopted by simply modifying the corresponding twist coordinates.

5. Conclusions

In this paper, a geometric algorithm was proposed for real-time forward kinematics of the general Stewart platform, where no geometric constraints, such as perpendicularity, parallelism, and intersection, are presumed between joints. Specifically, a geometric approach, which describes the rigid body motion as exponential mapping of twist was used to formulate the problem. A very neat and simple differential relationship between task space and joint space was therefore established. The proposed algorithm is derived for the general Stewart platform, and can work for other existing spatial manipulators, including but not limited to 6-RUS and 6-RSS. Experiments and simulations were carried out to demonstrate the effectiveness of the proposed algorithm. The results showed that the proposed algorithm is accurate, robust, and fast. In all test cases, the proposed algorithm terminates with maximum iteration being 4 and converges with near-quadratic speed. The proposed algorithm is also implemented on an embedded controller. Compared with the incremental method, which only applies to the 6-SPS model, the proposed algorithm is more robust, with a comparative execution time of 0.48 ms. Overall, the efficiency of proposed algorithm meets the requirements of most applications, such as kinematic calibration, motion simulation, and real-time control. Some of the future work are summarized as follows.
  • As the damping factor λ has great influence on the efficiency of the Levenberg–Marquardt method, instead of using a fixed damping factor, a more effective strategy can be explored considering manipulability and other factors.
  • Calibration can greatly increase the accuracy of the end-effector. Most existing algorithms considered the errors from actuator lengths, ball joint location, and motion errors; developing a calibration model that applies to the general Stewart platform is necessary.

Author Contributions

F.Y.: conceptualization, investigation, methodology, writing—original draft, writing—review & editing; X.T.: conceptualization, methodology, writing—review & editing; Z.W.: investigation, software, validation; Z.L.: data interpretation, writing—review & editing; T.H.: methodology, writing—review & editing, funding acquisition. All authors have read and agreed to the published version of the manuscript.

Funding

This work was supported by the Key-Area Research and Development Program of Guangdong Province under Grant 2020B0909030005, Guangdong Basic and Applied Basic Research Foundation (2021A1515110354, 2021A1515110576), and the Fundamental Research Funds for the Central Universities, Sun Yat-sen University (22qntd1704, 22qntd1708).

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Stewart, D. A platform with six degrees of freedom. Proc. Inst. Mech. Eng. 1965, 180, 371–386. [Google Scholar] [CrossRef]
  2. Dasgupta, B.; Mruthyunjaya, T. The Stewart platform manipulator: A review. Mech. Mach. Theory 2000, 35, 15–40. [Google Scholar] [CrossRef]
  3. Griffis, M.; Duffy, J. A forward displacement analysis of a class of Stewart platforms. J. Robot. Syst. 1989, 6, 703–720. [Google Scholar] [CrossRef]
  4. Lin, W.; Griffis, M.; Duffy, J. Forward displacement analyses of the 4–4 Stewart platforms. J. Mech. Des. 1992, 114, 444–450. [Google Scholar] [CrossRef]
  5. Lin, W.; Crane, C.; Duffy, J. Closed-form forward displacement analysis of the 4–5 in-parallel platforms. J. Mech. Des. 1994, 116, 47–53. [Google Scholar] [CrossRef]
  6. Innocenti, C.; Parenti-Castelli, V. Direct Kinematics in Analytical Form of a General Geometry 5–4 Fully-Parallel Manipulator. In Computational Kinematics; Springer: Berlin/Heidelberg, Germany, 1993; pp. 141–152. [Google Scholar]
  7. Innocenti, C.; Parenti-Castelli, V. Direct kinematics of the 6–4 fully parallel manipulator with position and orientation uncoupled. In Robotic Systems; Springer: Berlin/Heidelberg, Germany, 1992; pp. 3–10. [Google Scholar]
  8. Wen, F.; Liang, C. Displacement analysis of the 6–6 Stewart platform mechanisms. Mech. Mach. Theory 1994, 29, 547–557. [Google Scholar] [CrossRef]
  9. Sreenivasan, S.; Waldron, K.; Nanua, P. Closed-form direct displacement analysis of a 6–6 Stewart platform. Mech. Mach. Theory 1994, 29, 855–864. [Google Scholar] [CrossRef]
  10. Mruthyunjaya, B.D.T. A canonical formulation of the direct position kinematics problem for a general 6–6 Stewart platform. Mech. Mach. Theory 1994, 29, 819–827. [Google Scholar]
  11. Faugère, J.; Lazard, D. Combinatorial classes of parallel manipulators. Mech. Mach. Theory 1995, 30, 765–776. [Google Scholar] [CrossRef] [Green Version]
  12. Wampler, C. Forward displacement analysis of general six-in-parallel SPS (Stewart) platform manipulators using soma coordinates. Mech. Mach. Theory 1996, 31, 331–337. [Google Scholar] [CrossRef]
  13. Nag, A.; Safar, V.; Bandyopadhyay, S. A uniform geometric-algebraic framework for the forward kinematic analysis of 6–6 Stewart platform manipulators of various architectures and other related 6-6 spatial manipulators. Mech. Mach. Theory 2021, 155, 104090. [Google Scholar] [CrossRef]
  14. Innocenti, C. Forward kinematics in polynomial form of the general Stewart platform. In Proceedings of the International Design Engineering Technical Conferences and Computers and Information in Engineering Conference, American Society of Mechanical Engineers, New York, NY, USA, 13–16 September 1998; Volume 80302, p. V01AT01A013. [Google Scholar]
  15. Huang, X.; Liao, Q.; Wei, S. Closed-form forward kinematics for a symmetrical 6–6 Stewart platform using algebraic elimination. Mech. Mach. Theory 2010, 45, 327–334. [Google Scholar] [CrossRef]
  16. Zhou, W.; Chen, W.; Liu, H.; Li, X. A new forward kinematic algorithm for a general Stewart platform. Mech. Mach. Theory 2015, 87, 177–190. [Google Scholar] [CrossRef]
  17. Merlet, J.P. Solving the forward kinematics of a Gough-type parallel manipulator with interval analysis. Int. J. Robot. Res. 2004, 23, 221–235. [Google Scholar] [CrossRef]
  18. Raghavan, M. The Stewart platform of general geometry has 40 configurations. AMSE J. Mech. Des. 1993, 115, 277–282. [Google Scholar] [CrossRef]
  19. Merlet, J.P. Direct kinematics of parallel manipulators. IEEE Trans. Robot. Autom. 1993, 9, 842–846. [Google Scholar] [CrossRef]
  20. Yang, C.F.; Zheng, S.T.; Jin, J.; Zhu, S.B.; Han, J.W. Forward kinematics analysis of parallel manipulator using modified global Newton-Raphson method. J. Cent. South Univ. Technol. 2010, 17, 1264–1270. [Google Scholar] [CrossRef]
  21. Puglisi, L.J.; Saltaren, R.; Garcia, C.; Cardenas, P.; Moreno, H. Implementation of a generic constraint function to solve the direct kinematics of parallel manipulators using Newton-Raphson approach. J. Control. Eng. Appl. Inf. 2017, 19, 71–79. [Google Scholar]
  22. Xie, B.; Dai, S.; Liu, F. A Lie Group-Based Iterative Algorithm Framework for Numerically Solving Forward Kinematics of Gough–Stewart Platform. Mathematics 2021, 9, 757. [Google Scholar] [CrossRef]
  23. Yang, C.; He, J.; Han, J.; Liu, X. Real-time state estimation for spatial six-degree-of-freedom linearly actuated parallel robots. Mechatronics 2009, 19, 1026–1033. [Google Scholar] [CrossRef]
  24. Wang, Y. A direct numerical solution to forward kinematics of general Stewart–Gough platforms. Robotica 2007, 25, 121–128. [Google Scholar] [CrossRef]
  25. Parikh, P.J.; Lam, S.S. A hybrid strategy to solve the forward kinematics problem in parallel manipulators. IEEE Trans. Robot. 2005, 21, 18–25. [Google Scholar] [CrossRef]
  26. Bonev, I.A.; Ryu, J. A new method for solving the direct kinematics of general 6–6 Stewart platforms using three linear extra sensors. Mech. Mach. Theory 2000, 35, 423–436. [Google Scholar] [CrossRef]
  27. Chiu, Y.J.; Perng, M.H. Forward kinematics of a general fully parallel manipulator with auxiliary sensors. Int. J. Robot. Res. 2001, 20, 401–414. [Google Scholar] [CrossRef]
  28. Cheng, S.; Liu, Y.; Wu, H. A new approach for the forward kinematics of nearly general Stewart platform with an extra sensor. J. Adv. Mech. Des. Syst. Manuf. 2017, 11, JAMDSM0032. [Google Scholar] [CrossRef] [Green Version]
  29. Morell, A.; Acosta, L.; Toledo, J. An artificial intelligence approach to forward kinematics of Stewart platforms. In Proceedings of the 2012 20th Mediterranean Conference on Control & Automation (MED), Barcelona, Spain, 3–6 July 2012; pp. 433–438. [Google Scholar]
  30. Haykin, S.; Network, N. A comprehensive foundation. Neural Netw. 2004, 2, 41. [Google Scholar]
  31. Parikh, P.J.; Lam, S.S. Solving the forward kinematics problem in parallel manipulators using an iterative artificial neural network strategy. Int. J. Adv. Manuf. Technol. 2009, 40, 595–606. [Google Scholar] [CrossRef]
  32. Chauhan, D.K.S.; Vundavilli, P.R. Forward Kinematics of the Stewart Parallel Manipulator Using Machine Learning. Int. J. Comput. Methods 2022, 214, 2009. [Google Scholar] [CrossRef]
  33. Joumah, A.A.; Albitar, C. Design optimization of 6-RUS parallel manipulator using hybrid algorithm. Int. J. Inf. Technol. Comput. Sci. (IJITCS) 2018, 10, 83–95. [Google Scholar] [CrossRef] [Green Version]
  34. Lau, T.; Zhang, Y. New design of 6-RSS parallel manipulator with large rotation workspace. Int. J. Mech. Robot. Syst. 2013, 1, 221–239. [Google Scholar] [CrossRef]
  35. Stoughton, R.; Arai, T. A modified Stewart platform manipulator with improved dexterity. IEEE Trans. Robot. Autom. 1993, 9, 166–173. [Google Scholar] [CrossRef]
  36. Pittens, K.; Podhorodeski, R. A family of Stewart platforms with optimal dexterity. J. Robot. Syst. 1993, 10, 463–479. [Google Scholar] [CrossRef]
  37. Wapler, M.; Urban, V.; Weisener, T.; Stallkamp, J.; Dürr, M.; Hiller, A. A Stewart platform for precision surgery. Trans. Inst. Meas. Control. 2003, 25, 329–334. [Google Scholar] [CrossRef]
  38. Wang, J.; Masory, O. On the accuracy of a Stewart platform. I. The effect of manufacturing tolerances. In Proceedings of the IEEE International Conference on Robotics and Automation, Atlanta, GA, USA, 2–6 May 1993; pp. 114–120. [Google Scholar]
  39. Masory, O.; Wang, J.; Zhuang, H. Kinematic modeling and calibration of a Stewart platform. Adv. Robot. 1996, 11, 519–539. [Google Scholar] [CrossRef]
  40. Murray, R. A Mathematical Introduction to Robotic Manipulation; CRC Press: Boca Raton, FL, USA, 2017. [Google Scholar]
  41. Hall, B. Lie Groups, Lie Algebras, and Representations: An Elementary Introduction; Springer: New York, NY, USA, 2015; Volume 222. [Google Scholar]
  42. Yang, X.; Wu, L.; Li, J.; Chen, K. A minimal kinematic model for serial robot calibration using POE formula. Robot.-Comput.-Integr. Manuf. 2014, 30, 326–334. [Google Scholar] [CrossRef]
  43. Li, C.; Wu, Y.; Li, Z. Identifiability and improvement of adjoint error approach for serial robot calibration. In Proceedings of the 2014 IEEE International Conference on Robotics and Automation (ICRA), Hong Kong, 31 May–5 June 2014; pp. 1361–1366. [Google Scholar]
  44. Wampler, C.W. Manipulator inverse kinematic solutions based on vector formulations and damped least-squares methods. IEEE Trans. Syst. Man Cybern. 1986, 16, 93–101. [Google Scholar] [CrossRef]
  45. Nakamura, Y.; Hanafusa, H. Inverse kinematic solutions with singularity robustness for robot manipulator control. J. Dyn. Syst. Meas. Control. 1986, 109, 163–171. [Google Scholar] [CrossRef]
Figure 1. The 6-SPS Stewart platform.
Figure 1. The 6-SPS Stewart platform.
Sensors 22 04829 g001
Figure 2. A general serial robot with n joints.
Figure 2. A general serial robot with n joints.
Sensors 22 04829 g002
Figure 3. The Stewart platform: (a) the CAD model; (b) twist definitions and initial pose of the i-th chain.
Figure 3. The Stewart platform: (a) the CAD model; (b) twist definitions and initial pose of the i-th chain.
Sensors 22 04829 g003
Figure 4. Geometric parameters for one chain: (a) top view of the mounting base; (b) side view of the linear actuator; (c) bottom view of the moving platform.
Figure 4. Geometric parameters for one chain: (a) top view of the mounting base; (b) side view of the linear actuator; (c) bottom view of the moving platform.
Sensors 22 04829 g004
Figure 5. Position and orientation error compared with chain 1; (a) position error; (b) orientation error.
Figure 5. Position and orientation error compared with chain 1; (a) position error; (b) orientation error.
Sensors 22 04829 g005
Figure 6. Joint displacements vs. time for all chains; (a) joint 1; (b) joint 2; (c) joint 3; (d) joint 4; (e) joint 5; (f) joint 6.
Figure 6. Joint displacements vs. time for all chains; (a) joint 1; (b) joint 2; (c) joint 3; (d) joint 4; (e) joint 5; (f) joint 6.
Sensors 22 04829 g006
Figure 7. Error vs. iteration of proposed algorithm of 100 randomly selected cases.
Figure 7. Error vs. iteration of proposed algorithm of 100 randomly selected cases.
Sensors 22 04829 g007
Figure 8. The experiment set-up.
Figure 8. The experiment set-up.
Sensors 22 04829 g008
Figure 9. Comparison of iteration count and execution time with the incremental method; (a) execution time; (b) iteration count.
Figure 9. Comparison of iteration count and execution time with the incremental method; (a) execution time; (b) iteration count.
Sensors 22 04829 g009
Table 1. Geometric parameters of all chains.
Table 1. Geometric parameters of all chains.
P 1 P 2 P 3 P 4 P 5 P 6 P 7 P 8 P 9 P 10 P 11
(mm)(deg)(mm)(mm)(mm)(mm)(mm)(mm)(mm)(deg)(mm)
chain 117.0018.0057.00−5.064.2085.004.200.5639.0042.009.00
chain 217.00102.0057.005.064.2085.004.20−0.5639.0078.009.00
chain 317.00138.0057.00−5.064.2085.004.200.5639.00162.009.00
chain 417.00222.0057.005.064.2085.004.20−0.5639.00198.009.00
chain 517.00258.0057.00−5.064.2085.004.200.5639.00282.009.00
chain 617.00342.0057.005.064.2085.004.20−0.5639.00318.009.00
Table 2. Initial rigid displacement of each chain.
Table 2. Initial rigid displacement of each chain.
TranslationOrientation
x (mm)y (mm)z (mm)( deg )
chain 118.511.28119.40Rotz(−24.00)
chain 2−8.1416.67119.40Rotz( 24.00)
chain 3−10.3715.39119.40Rotz(−24.00)
chain 4−10.37−15.39119.40Rotz( 24.00)
chain 5−8.14−16.67119.40Rotz(−24.00)
chain 618.511.28119.40Rotz( 24.00)
Table 3. Sine trajectory parameters of each chain.
Table 3. Sine trajectory parameters of each chain.
A i ω i ϕ B i
(mm)(rad/s)(rad)(mm)
chain 120.002.000.0020.00
chain 220.002.100.0020.00
chain 320.002.200.0020.00
chain 420.002.300.0020.00
chain 520.002.400.0020.00
chain 620.002.500.0020.00
Table 4. Statistics of forward kinematics of two methods.
Table 4. Statistics of forward kinematics of two methods.
Average Iteration CountMax Iteration CountAverage Execution TimeMax Execution Time
incremental method (all cases)5.12200.381.54
incremental method (convergent cases)3.13170.231.25
proposed method2.9930.480.53
Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Share and Cite

MDPI and ACS Style

Yang, F.; Tan, X.; Wang, Z.; Lu, Z.; He, T. A Geometric Approach for Real-Time Forward Kinematics of the General Stewart Platform. Sensors 2022, 22, 4829. https://doi.org/10.3390/s22134829

AMA Style

Yang F, Tan X, Wang Z, Lu Z, He T. A Geometric Approach for Real-Time Forward Kinematics of the General Stewart Platform. Sensors. 2022; 22(13):4829. https://doi.org/10.3390/s22134829

Chicago/Turabian Style

Yang, Fangfang, Xiaojun Tan, Zhe Wang, Zhenfeng Lu, and Tao He. 2022. "A Geometric Approach for Real-Time Forward Kinematics of the General Stewart Platform" Sensors 22, no. 13: 4829. https://doi.org/10.3390/s22134829

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop