 Original Article
 Open access
 Published:
Inverse Dynamics of A 3DOF Parallel Mechanism Based on Analytical Forward Kinematics
Chinese Journal of Mechanical Engineering volume 35, Article number: 119 (2022)
Abstract
For the development of a parallel mechanism (PM), it is necessary to establish a dynamic model which can accurately meet the requirements of realtime control. Compared with the general dynamic analysis model based on the inverse kinematics, the dynamic analysis model based on the forward kinematics has the advantage of lowcomplexity. In this paper, a new type of 3DOF PM with analytical forward displacement analysis is proposed. Different from the general dynamic analysis based on the inverse kinematics, the displacement, velocity and acceleration equations of the PM are established and solved by forward kinematics. The inverse dynamic equation of the PM is constructed and solved by analyzing the forces on each link and based on NewtonEuler method. Then the theoretical results of an example are compared with the simulation results, which shows that the simulation results are basically consistent with the theoretical results. And the maximum error of the driving force of each pair is 1.32%, 5.8% and 5.2%, respectively, which verifies the correctness of the dynamic model. The PM has a potential application prospect in the grasping, spraying and picking of workpieces. The research results of this paper provide a theoretical basis for the design, manufacture and application of the PM.
1 Introduction
Compared with the series mechanism, the parallel mechanism (PM) has the advantages of compact structure, high rigidity and motion accuracy, etc. The topic has attracted extensive attention from the academic and industrial community for many years [1,2,3,4,5,6]. At present, research on PMs mainly focuses on the topology, kinematics, dynamics and control [7,8,9,10,11,12]. The dynamic analysis mainly studies the relationship between the input forces and the output forces. This is the determination of the maximum load carrying capacity and reasonable design of the driver during the development of parallel robots. According to this, the constraint reaction force of the motion pair solved during the analysis process plays an important role in the design, mechanical efficiency estimation, friction calculation, and mechanical vibration research of the various parts of the PM [13,14,15,16,17]. Therefore, for a PM to be developed, it is necessary to establish a dynamic model that can accurately meet the requirements of realtime control.
In terms of modeling methods, the commonly used dynamic modeling methods are Lagrangian method, universal equations of dynamics, NewtonEuler method, virtual work principle, Hamilton principle, Kane equation, etc. [18,19,20,21,22,23]. Among them, the universal equations of dynamics and Lagrange method are based on the system’s virtual displacement and kinetic and potential energy respectively to build a simple dynamic model. While the NewtonEuler method can obtain the force of each joint by analyzing each member separately, and then establishes a complete dynamic model by eliminating the interaction force of each member, it can also solve the support force and moment of force between members.
In terms of research objects, most of the dynamic analysis mainly focus on the 6DOF Stewart PM [24, 25]. For 5DOF PM, Chen et al. use the universal equations of dynamics to analyze the 4UPSUPU PM [26]. Li et al. used the NewtonEuler method to analyze the dynamics of the 5PSS/UPU PM [23]. For 4DOF PM, Geng used NewtonEuler to analyze the 4UPSUPR PM [27]. In terms of 3DOF, Li et al. used the NewtonEuler method to analyze the dynamics of a 3RPS PM [28]. Liu et al. performed a Lagrangian method to analyze the dynamics of a 3RRS PM [29].
In this paper, a 3DOF 2T1R PM [30] with a forward analytical position solution is proposed. Firstly, the kinematics of the PM is analyzed. Then, force analysis is carried out for each component, and the dynamic model is established by NewtonEuler method. Finally, the correctness of the modeling method is verified by comparing the results of MATLAB calculation and ADAMS simulation. When the three prismatic pairs of the PM move at different speeds, it can undergo twotranslation and onerotation in a small range, while the three prismatic pairs move at the same speed, it can undergo onetranslation DOF along the direction of the guide rail in a large range. Therefore, the PM has a potential application prospect in the grasping, spraying and picking of workpieces. The research results of this paper provide a theoretical basis for the design, manufacture and application of the PM.
2 Mechanism Architecture
The PM shown in Figure 1 consists of a moving platform, a base, and a complex branch chain and an unconstrained branch PSS (Prismatic pair  Spherical joint  Spherical joint) connecting the moving platform and the base. The subPM and an revolute pair are connected in series, where the two branches of the subPM are SOC_{1} {P⊥P^{(4R)}}, SOC_{2} {P⊥RR}, where P^{(4R)} indicates that a parallelogram composed of 4 revolute pairs that is equivalent to a prismatic pair P, while SOC means singleopenchain that consists of link and pair in serial way. This PM can generate two translations in the Y and Z directions and a rotation output about the Y axis. The PM is referred to as the 2T1R PM [30].
2.1 Kinematics Analysis
The coordinate system shown in Figure 2 is established. The base coordinate system OXYZ is established with the origin at the center point O of the guide rail where the driving pair A_{1}, A_{2} is located, the positive half of the Yaxis is from O to A_{2}, and the positive half of the Zaxis is vertical upward. The moving coordinate system oxyz is established with the origin at o point that is the center point O of the line C_{12}C_{2} on the submoving platform. The positive half of the yaxis is from the origin o to C_{2}, and the zaxis is perpendicular to the plane of the moving platform.While the X and x axis direction meet the righthand screw rule, the geometry parameters of each component are shown in Figure 2.
Establish the local coordinate system of each link B_{i}C_{i} (i=1, 2, 3). The x_{1} axis of the coordinate system B_{1}x_{1}y_{1}z_{1} is parallel to the X axis of the base coordinate system, and the positive half of the z_{1} axis is pointed from B_{1} to C_{1}; The x_{2} axis of the coordinate system B_{2}x_{2}y_{2}z_{2} is parallel to the X axis of the base coordinate system, and the positive half of the z_{2} axis is pointed from B_{2} to C_{2}, where the y axis of each coordinate system meets the righthand screw rule; The positive half of the z_{3} axis of the coordinate system B_{3}x_{3}y_{3}z_{3} is pointed from B_{3} to C_{3}, and the x_{3} axis lies in the XOZ plane and the angle with the X axis is \(\theta_{1}\), its Euler transformation relative to the base coordinate system is shown in Figure 3, from which the coordinate transformation matrix from the coordinate system {B_{3}} to the base coordinate system OXYZ is:
2.2 Forward Position Solution
The forward kinematics of PM is to solve the position and orientation of the moving platform when the structural parameters and input of the mechanism are given.
Based on the constrained length of the bars, we can get:
From Eq. (1), the coordinates of point o are:
Angle α of moving platform is:
where
2.3 Velocity and Acceleration Analysis
2.3.1 Velocity and Acceleration of the Moving Platform
Taking the time derivative of Eqs. (2), (3), the output velocity and acceleration of the moving platform can be obtained as
2.3.2 Velocity and Acceleration of Members

(1)
Velocity and acceleration of member B_{1}C_{1}
Because the movements of the B_{11}C_{11} and B_{12}C_{12} rods are the same, the two rods are equivalent to the rod B_{1}C_{1} for analysis.
The velocity of the point C_{1} is:
where \({\varvec{v}}_{o}\) is the linear velocity of point o;\({\varvec{v}}_{1}\) is the linear velocity of the driving pair A_{1};\({\varvec{c}}_{1}\) and \({{\varvec{\omega}}}_{{l_{1} }}\) are respectively the linear and angular velocity of the rod B_{1}C_{1}.
The angular velocity of the rod B_{1}C_{1} can be determined by taking the cross product of the two sides of Eq. (6) with \({\varvec{c}}_{1}\), which yields:
Substituting Eq. (7) into Eq. (8) to obtain the velocity of the center of mass of the rod B_{1}C_{1},
Taking the time derivative of Eq. (6), the acceleration of the C_{1} can be obtained as:
The angular acceleration of the rod B_{1}C_{1} can be determined by taking the cross product of the two sides of Eq. (9) with \({\varvec{c}}_{1}\), which yields:
where \({\tilde{\varvec{c}}}_{1}\) is the skew symmetric matrix associated with the vector c_{1}.
Taking the time derivative of Eq. (6), the centroid acceleration of rod B_{1}C_{1} can be obtained as:

(2) Velocity and acceleration of member B_{2}C_{2}
Similarly, using the same method as the velocity and acceleration of the rod B_{1}C_{1}, the angular velocity of the rod B_{2}C_{2} can be obtained as:
The centroid velocity of the rod B_{2}C_{2}:
Angular acceleration of rod B_{2}C_{2}:
Centroid acceleration of rod B_{2}C_{2}:

(3) Velocity and acceleration of rod B_{3}C_{3}
The velocity of the point C_{3} is
The angular velocity of the rod B_{3}C_{3} can be determined by taking the cross product of the two sides of Eq. (16) with c_{3}, which yields:
Substituting Eq. (17) into Eq. (18) gives the velocity at the centroid of rod B_{3}C_{3}:
Taking the time derivative of Eq. (16) , the acceleration of the c_{3} can be obtained as:
The angular acceleration of the rod B_{3}C_{3} can be determined by taking the cross product of the two sides of Eq. (19) with c_{3},which yields:
Taking the time derivative of Eq. (18) , the acceleration of the centroid of B_{3}C_{3} can be obtained as:
3 Dynamics Modeling of Mechanism
When using the NewtonEuler method, the friction of each moving pair is not considered, then the NewtonEuler equation of each member is established. Then the dynamic model of the PM is obtained by eliminating the internal forces between the members. Finally, the relationship between the driving force and the external forces of the moving platform is obtained, which is illustrated as follows.
3.1 Dynamic Equation of Moving Platform
As shown in Figure 4, the gravity of the moving platform is mg, the constraint force of the submoving platform is F_{a1}, and the constraint force of the PSS branch chain is F_{a2}. The external force and moment of the moving platform are F_{w} and M_{w} respectively.
The dynamic equation of the moving platform is:
where \({}^{o}{\varvec{I}}_{p} = {}^{o}{\varvec{R}}_{p} {\varvec{I}}_{p} {}^{o}{\varvec{R}}_{p}^{{\text{T}}} {;}\) \({}^{o}{\varvec{R}}_{p}\) is the transformation matrix of the moving coordinate system to the base coordinate system;\({}^{o}{\varvec{I}}_{p}\) is the inertia tensor of the moving platform in the base frame;\({\varvec{I}}_{p}\) is the inertia tensor of the moving platform in the local frame;\({\varvec{c}}_{p}\) is the position vector from the center of mass of the moving platform to the center of the spherical joint on the moving platform.
3.2 Dynamic Equation of the SubMoving Platform
As shown in Figure 5, the dynamic equation of the submoving platform can be written as follows:
where F_{c11}, F_{c12}, F_{c2} are constraint forces of the active link B_{i}C_{i} (i=1,2)in the submoving platform; m_{l} is mass of the submoving platform; −F_{a1} is the reaction force of the moving platform.
3.3 Dynamic Equation of Connecting Rod
The RRlink is subject to the constraint reaction force of the submoving platform −F_{ci} (i=1, 2), its own gravity m_{c}g, and the constraint force F_{bi} (i = 1, 2), and its force analysis is shown in Figure 6.
Therefore, the dynamic equations of the two parallel links in the parallelogram are as follows:
Dynamic equation of single link (B_{2}C_{2}) is as follows:
where \({}^{o}{\varvec{I}}_{li} = {}^{o}{\varvec{R}}_{li} {\varvec{I}}_{li} {}^{o}{\varvec{R}}_{li}^{{\text{T}}} {,}\;\left( {i = 1{,}\;2} \right)\),\({}^{o}{\varvec{I}}_{li}\) is the inertia tensor of the connecting rod in the base frame ;\({\varvec{I}}_{li}\) is the inertia tensor of the connecting rod in the local frame;\({}^{o}{\varvec{R}}_{li}\) is the transformation matrix from the local frames of the connecting rod to the base frame.
Further, SSlink (B_{3}C_{3}) is subject to the constraint reaction force of the moving platform−F_{a2}, the constraint force of the drive member F_{b3}, the selfgravity m_{c}′g, while m_{c}′ is the mass of SS connecting rod, and its stress is shown in Figure 7.
Then, the dynamic equations of the SS link are described as
where \({}^{o}{\varvec{I}}_{l3} = {}^{o}{\varvec{R}}_{l3} {\varvec{I}}_{l3} {}^{o}{\varvec{R}}_{l3}^{{\text{T}}} .\)
3.4 Dynamic Equation of Driving Sliders
The three driving sliders are subject to the constraint reaction forces of each link −F_{bi} (i = 1, 2, 3), its own gravity, and the driving force of the driving motor m_{i}g (i = 1,2, 3), and the force diagram of the slider is shown in Figure 8.
The dynamic equation of slider 1 is
The dynamic equations of slider 2 and slide 3 are as follows:
3.5 The Integrated Dynamic Model of the PM
The establishment of the integrated dynamic model is to eliminate the internal forces of members and to obtain the dynamic relationship between the input force, torque and output force.
Taking the dot product of the both sides of Eq. (31) with \({\varvec{e}}_{1}^{{\text{T}}}\)
where \(\tau_{i} \left( {i = 1,2,3} \right)\) is the driving force of the slider, \({\varvec{e}}_{i} \left( {i = 1,2,3} \right)\) is the unit vector for driving force.
Substituting Eq. (25) into Eq. (33), we can write:
According to Eq. (26),we can write:
Taking the cross product of the two sides of Eq. (35) with e_{1} gives:
Then, we can write:
According to Eq. (34), we can get:
Substituting Eq. (39) into Eq. (38) gives:
Similarly,
where
Substituting Eqs. (40) and (41) into Eq. (24), we can get
Substituting Eqs. (42) and (43) into Eq. (22) and Eq. (23), we have
where
According to Eq. (44), we can get:
When the motion law of the moving platform and the external force and torque are known, the driving force of each driving pair can be obtained from Eq. (45).
4 Dynamic Simulation
Firstly, the following motion laws of three driving pairs are given:
A threedimensional prototype of the PM is designed, as shown in Figure 9. The dimension parameters of the PM are shown in Table 1.
The above parameters are substituted into the dynamic Eqs. (22)‒(45), and the driving forces of the three driving pairs are calculated by MATLAB. The curves of the driving forces are shown in Figure 10(a).
Then, the threedimensional prototype is input into ADAMS, and the material properties of each part and the constraint types of the kinematic pairs are specified. The vertical downward gravity is applied, and the simulation step of 0.01 s and the simulation time of 10 s are selected for dynamic simulation of the virtual prototype.
As shown in Figure 10(b), the calculated value is compared with the simulation result of ADAMS, which shows that the simulation value is basically consistent with the theoretical value. The maximum error of the driving force of each pair is 1.32%, 5.8% and 5.2%, which verifies the correctness of the dynamic model.
In the same simulation duration, different steps are selected to record the calculation time of MATLAB, as shown in Table 2.
As shown in Table 2, only when the step size ≤0.005 s, the dynamic modeling analysis program is realtime.
5 Conclusions

(1)
A new type of 3DOF PM is proposed in this paper, and its analytical solution of forward kinematics is given, which is used to analyze its velocity and acceleration.

(2)
Based on NewtonEuler method, the dynamic model of the PM is established by the analysis of force on each component.

(3)
The dynamic simulation of the threedimensional prototype is carried out by ADAMS, and the simulation results are compared with the theoretical calculation results of the example. The results show that the simulation results are basically consistent with the theoretical results, which verifies the correctness of the dynamic model.
References
S Briot, I A Bonev. Pantoptern4: A new 3T1R decoupled parallel manipulator for pickandplace application. Mechanism and Machine Theory, 2010, 45(5): 707721.
H P Shen, M Lv, X R Zhu, et al. Topological design and kinematics of a singledegreeoffreedom 3T1R parallel mechanism. China Mechanical Engineering, 2019, 30(8): 961968.
J M Deng, K Xu, Y C Zhao, et al. Design and kinematics analysis of asymmetric 2T1Rtype spatial parallel mechanism without parasitic motion. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49(6): 408417.
T L Yang, A X Liu, H P Shen, et al. Topology design of robot mechanisms. Singapore: Springer, 2018.
B Y Chang, X N Li, G G Jin, et al. Kinematics analysis of a 3t1r parallel mechanism with fullcircle rotation capability. Journal of Agricultural Machinery, 2019, 50(7): 406416.
G L Yan, C C Wu, Q Y Chen, et al. Kinematics analysis and design optimization of novel 3t1r parallel manipulator. Transactions of the Chinese Society for Agricultural Machinery, 2017, 48(12): 386394, 420.
S F Yang, T Sun, T Huang. Type synthesis of parallel mechanisms having 3T1R motion with variable rotational axis. Mechanism and Machine Theory, 2017, 109: 220230.
M Bennehar, A Chemori, F Pierrot. A new revised desired compensation adaptive control for enhanced tracking: application to RAPKMs. Advanced Robotics, 2016, 30(1718): 11921214.
H P Shen, K Xu, T L Yang, et al. Design and kinematics of a new 3T1R parallel manipulator 2 (RPa3R) 3R with zero coupling and motion decoupling. Journal of Mechanical Engineering, 2019, 55(5): 5364.
W Liu, H Z Liu. Type synthesis of 3DOF parallel mechanism with both 2R1T and 3R motion mode. Journal of Mechanical Engineering, 2019, 55(3): 5363. (in Chinese)
Z M Chen, X M Liu, Y Zha, et al. Dynamics analysis of a symmetrical 2R1T 3UPU parallel mechanism. Journal of Mechanical Engineering, 2017, 53(21): 4653. (in Chinese)
X Y Wang, S Guo, H B Qu, et al. Optimal allocation method of parallel mechanism and its application. Journal of Mechanical Engineering, 2019, 55(1): 4453. (in Chinese)
Y L Xu, L Yang, Z Y Yang, et al. Dynamics property analysis of a novel PURU+RR+S spherical parallel humanoid robotic ankle mechanism. China Mechanical Engineering, 2017, 28(16): 19711976.
J T Yao, B Han, Y C Dou, et al. Influence of base motion on dynamic performance of parallel adjustment mechanism. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49(7): 410418.
X H Jia, Y L Tian, D W Zhang. Inverse dynamics of 3RRPR compliant precision positioning stage based on the principle of virtue work. Journal of Mechanical Engineering, 2011, 47(1): 68 74. (in Chinese)
S T Liu, T Huang, J P Mei, et al. Optimal design of a 4DOF SCARA type parallel robot using dynamic performance indices and angular constrains. Journal of Mechanisms and Robotics, 2012, 4(3): 031005.
J B Zhou, J J You, J Li, et al. Inverse dynamic of 2T1R parallel mechanism with symbolic positive position solution. Machine Design and Research, 2020, 36(3): 2329.
H Kalani, A Rezaei, A Akbarzadeh. Improved general solution for the dynamic modeling of Gough–Stewart platform based on principle of virtual work. Nonlinear Dynamics, 2016, 83(4): 23932418.
B Dasgupta, T S Mruthyunjaya. A NewtonEuler formulation for the inverse dynamics of the Stewart platform manipulator. Mechanism and Machine Theory, 1998, 33(8): 11351152.
M Naser, A Alireza, D Jaspreet, et al. A comprehensive inverse dynamics problem of a stewart platform by means of Lagrangian formulation. ASME 2017 Dynamic Systems and Control Conference, Virginia, USA, 2017: 20175098.
Y F Zhang, P Jin, J L Gong, et al. Dynamic modeling of viscous friction conditions of 3RPS parallel robot. Transactions of the Chinese Society of Agricultural Machinery, 2018, 49(9): 374381.
J J You, C G Li, H T Wu. Research on Hamiltonian dynamics of parallel type sixaxis accelerometer. Journal of Mechanical Engineering, 2012, 48(15): 917. (in Chinese)
Y B Li, H Zheng, P Sun. Dynamic modeling and coupling analysis of 5PSS/UPU parallel mechanism considering joint friction. Journal of Mechanical Engineering, 2019, 55(3): 4352. (in Chinese)
S W Fu, Y Yao, Y Q Wu. Comments on “A Newton–Euler formulation for the inverse dynamics of the Stewart platform manipulator”. Mechanism and Machine Theory, 2007, 42(12): 16681671.
S Pedrammehr, M Mahboubkhah, N Khani. Improved dynamic equations for the generally configured Stewart platform manipulator. Mechanical Science and Technology, 2012, 26(3): 711721.
X L Chen, W M Feng, Y S Zhao. Dynamic model of a 5DOF parallel robot mechanism. Transactions of the Chinese Society of Agricultural Machinery, 2013, 44(1): 236243.
M C Geng, T S Zhao, C Wang, et al. Dynamic analysis of 4UPS/UPR parallel mechanism. Transactions of the Chinese Society of Agricultural Machinery, 2014, 45(8): 299306.
Y G Li, Y M Song, Z Y Feng, et al. Inverse dynamics analysis of 3RPS parallel mechanism based on Newton’s Euler method. Acta Aeronautica, 2007, (5): 12101215.
S Z Liu, Y Q Yu, G N Tong, et al. Kinematics and dynamics analysis of a 3 degrees of freedom parallel robot. Journal of Mechanical Engineering, 2009, 45(8): 11 17. (in Chinese)
H P Shen, J M Deng, K Wang. A two translation and one rotation parallel mechanism with zero coupling and positive solution of analytical position: China, 201961623865x. 20190611.
Funding
Supported by National Natural Science Foundation of China (Grant Nos. 51975062, 51475050).
Author information
Authors and Affiliations
Contributions
JL was in charge of the paper; KW wrote the manuscript; HS conceived the parallel mechanism. JY suggested the method of dynamic analysis; TY discussed the structure of the paper. All authors read and approved the final manuscript.
Authors’ Information
Ke Wang, born in 1994, is currently an engineer at Black & Decker(Suzhou) Technology Limited Company, China. He received his master degree from Changzhou University, China, in 2020.
Ju Li, born in 1981, is currently a vice professor at Changzhou University, China. Her main research interests include parallel mechanism, kinematics.
Huiping Shen, born in 1965, is currently a professor and a PhD candidate supervisor at Changzhou University, China. His main research interests include parallel mechanism, kinematics, topology.
Jingjing You, born in 1985, is currently a vice professor and a master supervisor at College of Mechanical and Electronic Engineering, Nanjing Forestry University, China.
Tingli Yang, born in 1940, is currently a guest professor at Changzhou University, China. His main research interest include modern mechanisms, basic theory of robotic mechanisms.
Corresponding author
Ethics declarations
Competing Interests
The authors declare no competing financial interests.
Rights and permissions
Open Access This article is licensed under a Creative Commons Attribution 4.0 International License, which permits use, sharing, adaptation, distribution and reproduction in any medium or format, as long as you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons licence, and indicate if changes were made. The images or other third party material in this article are included in the article's Creative Commons licence, unless indicated otherwise in a credit line to the material. If material is not included in the article's Creative Commons licence and your intended use is not permitted by statutory regulation or exceeds the permitted use, you will need to obtain permission directly from the copyright holder. To view a copy of this licence, visit http://creativecommons.org/licenses/by/4.0/.
About this article
Cite this article
Wang, K., Li, J., Shen, H. et al. Inverse Dynamics of A 3DOF Parallel Mechanism Based on Analytical Forward Kinematics. Chin. J. Mech. Eng. 35, 119 (2022). https://doi.org/10.1186/s10033022007816
Received:
Revised:
Accepted:
Published:
DOI: https://doi.org/10.1186/s10033022007816