A Geometric Approach for Real-Time Forward Kinematics of the General Stewart Platform
<p>The 6-SPS Stewart platform.</p> "> Figure 2
<p>A general serial robot with <span class="html-italic">n</span> joints.</p> "> Figure 3
<p>The Stewart platform: (<b>a</b>) the CAD model; (<b>b</b>) twist definitions and initial pose of the <span class="html-italic">i</span>-th chain.</p> "> Figure 4
<p>Geometric parameters for one chain: (<b>a</b>) top view of the mounting base; (<b>b</b>) side view of the linear actuator; (<b>c</b>) bottom view of the moving platform.</p> "> Figure 5
<p>Position and orientation error compared with chain 1; (<b>a</b>) position error; (<b>b</b>) orientation error.</p> "> Figure 6
<p>Joint displacements vs. time for all chains; (<b>a</b>) joint 1; (<b>b</b>) joint 2; (<b>c</b>) joint 3; (<b>d</b>) joint 4; (<b>e</b>) joint 5; (<b>f</b>) joint 6.</p> "> Figure 7
<p>Error vs. iteration of proposed algorithm of 100 randomly selected cases.</p> "> Figure 8
<p>The experiment set-up.</p> "> Figure 9
<p>Comparison of iteration count and execution time with the incremental method; (<b>a</b>) execution time; (<b>b</b>) iteration count.</p> ">
Abstract
:1. Introduction
- 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.
2. Notation and Terminology
2.1. Lie Group and Lie Algebra
2.2. Exponential Map
3. Forward Kinematics of the General Stewart Platform
3.1. Kinematics of General Serial Robot
3.2. The Proposed Algorithm
Algorithm 1 Forward kinematics of the general Stewart platform. |
Input:
|
4. Simulations and Experiments
4.1. Simulation Setups
4.2. Correctness of the Proposed Algorithm
4.3. Convergence and Robustness of Proposed Algorithm
4.4. On-Board Implementation for Real-Time Control
- 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 and 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 . Accordingly, the following initial end-effector displacement is usedFrom the second cycle and onwards, the last cycle pose is used as the initial value.
- 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 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
- 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
Funding
Institutional Review Board Statement
Informed Consent Statement
Data Availability Statement
Conflicts of Interest
References
- Stewart, D. A platform with six degrees of freedom. Proc. Inst. Mech. Eng. 1965, 180, 371–386. [Google Scholar] [CrossRef]
- Dasgupta, B.; Mruthyunjaya, T. The Stewart platform manipulator: A review. Mech. Mach. Theory 2000, 35, 15–40. [Google Scholar] [CrossRef]
- Griffis, M.; Duffy, J. A forward displacement analysis of a class of Stewart platforms. J. Robot. Syst. 1989, 6, 703–720. [Google Scholar] [CrossRef]
- 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]
- 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]
- 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]
- 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]
- Wen, F.; Liang, C. Displacement analysis of the 6–6 Stewart platform mechanisms. Mech. Mach. Theory 1994, 29, 547–557. [Google Scholar] [CrossRef]
- 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]
- 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]
- Faugère, J.; Lazard, D. Combinatorial classes of parallel manipulators. Mech. Mach. Theory 1995, 30, 765–776. [Google Scholar] [CrossRef] [Green Version]
- 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]
- 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]
- 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]
- 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]
- 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]
- 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]
- Raghavan, M. The Stewart platform of general geometry has 40 configurations. AMSE J. Mech. Des. 1993, 115, 277–282. [Google Scholar] [CrossRef]
- Merlet, J.P. Direct kinematics of parallel manipulators. IEEE Trans. Robot. Autom. 1993, 9, 842–846. [Google Scholar] [CrossRef]
- 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]
- 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]
- 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]
- 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]
- Wang, Y. A direct numerical solution to forward kinematics of general Stewart–Gough platforms. Robotica 2007, 25, 121–128. [Google Scholar] [CrossRef]
- 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]
- 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]
- 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]
- 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]
- 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]
- Haykin, S.; Network, N. A comprehensive foundation. Neural Netw. 2004, 2, 41. [Google Scholar]
- 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]
- 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]
- 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]
- 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]
- Stoughton, R.; Arai, T. A modified Stewart platform manipulator with improved dexterity. IEEE Trans. Robot. Autom. 1993, 9, 166–173. [Google Scholar] [CrossRef]
- Pittens, K.; Podhorodeski, R. A family of Stewart platforms with optimal dexterity. J. Robot. Syst. 1993, 10, 463–479. [Google Scholar] [CrossRef]
- 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]
- 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]
- Masory, O.; Wang, J.; Zhuang, H. Kinematic modeling and calibration of a Stewart platform. Adv. Robot. 1996, 11, 519–539. [Google Scholar] [CrossRef]
- Murray, R. A Mathematical Introduction to Robotic Manipulation; CRC Press: Boca Raton, FL, USA, 2017. [Google Scholar]
- Hall, B. Lie Groups, Lie Algebras, and Representations: An Elementary Introduction; Springer: New York, NY, USA, 2015; Volume 222. [Google Scholar]
- 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]
- 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]
- 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]
- 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]
(mm) | (deg) | (mm) | (mm) | (mm) | (mm) | (mm) | (mm) | (mm) | (deg) | (mm) | |
---|---|---|---|---|---|---|---|---|---|---|---|
chain 1 | 17.00 | 18.00 | 57.00 | −5.06 | 4.20 | 85.00 | 4.20 | 0.56 | 39.00 | 42.00 | 9.00 |
chain 2 | 17.00 | 102.00 | 57.00 | 5.06 | 4.20 | 85.00 | 4.20 | −0.56 | 39.00 | 78.00 | 9.00 |
chain 3 | 17.00 | 138.00 | 57.00 | −5.06 | 4.20 | 85.00 | 4.20 | 0.56 | 39.00 | 162.00 | 9.00 |
chain 4 | 17.00 | 222.00 | 57.00 | 5.06 | 4.20 | 85.00 | 4.20 | −0.56 | 39.00 | 198.00 | 9.00 |
chain 5 | 17.00 | 258.00 | 57.00 | −5.06 | 4.20 | 85.00 | 4.20 | 0.56 | 39.00 | 282.00 | 9.00 |
chain 6 | 17.00 | 342.00 | 57.00 | 5.06 | 4.20 | 85.00 | 4.20 | −0.56 | 39.00 | 318.00 | 9.00 |
Translation | Orientation | |||
---|---|---|---|---|
x (mm) | y (mm) | z (mm) | () | |
chain 1 | 18.51 | 1.28 | 119.40 | Rotz(−24.00) |
chain 2 | −8.14 | 16.67 | 119.40 | Rotz( 24.00) |
chain 3 | −10.37 | 15.39 | 119.40 | Rotz(−24.00) |
chain 4 | −10.37 | −15.39 | 119.40 | Rotz( 24.00) |
chain 5 | −8.14 | −16.67 | 119.40 | Rotz(−24.00) |
chain 6 | 18.51 | 1.28 | 119.40 | Rotz( 24.00) |
(mm) | (rad/s) | (rad) | (mm) | |
---|---|---|---|---|
chain 1 | 20.00 | 2.00 | 0.00 | 20.00 |
chain 2 | 20.00 | 2.10 | 0.00 | 20.00 |
chain 3 | 20.00 | 2.20 | 0.00 | 20.00 |
chain 4 | 20.00 | 2.30 | 0.00 | 20.00 |
chain 5 | 20.00 | 2.40 | 0.00 | 20.00 |
chain 6 | 20.00 | 2.50 | 0.00 | 20.00 |
Average Iteration Count | Max Iteration Count | Average Execution Time | Max Execution Time | |
---|---|---|---|---|
incremental method (all cases) | 5.12 | 20 | 0.38 | 1.54 |
incremental method (convergent cases) | 3.13 | 17 | 0.23 | 1.25 |
proposed method | 2.99 | 3 | 0.48 | 0.53 |
Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations. |
© 2022 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https://creativecommons.org/licenses/by/4.0/).
Share and Cite
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
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 StyleYang, 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