Abstract
This paper presents the kinematics and inverse dynamic analysis of a 6-SPS parallel mechanism based on the principle of Kane. The parameters of orientation and Euler angles of the moving platform are adopted as generalized coordinate. The gravity and inertial forces of all links and moving platform are considered in the mathematical model of inverse dynamics. Both kinematics and inverse dynamics equations are derived. Driving forces–time relation is derived form inverse dynamics model. The approach is verified by simulation results, which are consistent with the planned trajectory and kinematics parameters.
Similar content being viewed by others
Avoid common mistakes on your manuscript.
1 Introduction
Parallel mechanisms, closed-loop link structures, are receiving widespread attention because they provide much higher stiffness, payload capability, more accurate positioning, higher speed and acceleration operation compared with serial counterparts (Gosselin and Angeles 1998; Merlet 2000). Parallel mechanisms could be found in many practical applications, such as aircraft simulators (Stewart 1965; Tsai 1999), positional tracker and telescopes (Dunlop and Jones 1999; Carretero et al. 2000). Recently, they have been used by many companies in development of high precision machine tools (Huang et al. 2004), such as Giddings and Lewis, Hexel and Toyoda.
In recent years, many research works have been conducted on dynamics of the parallel mechanisms (Lebret et al. 1993; Zanganeh et al. 1997). In the context of real-time control, the relevant objective of the dynamics is to determine the input force, which must be exerted by actuators in order to produce a given trajectory of the end-effectors. Several methods such as Lagrange formulation (Xiuling et al. 2011; Lee and Geng 1993), Newton–Euler formulation (Dasgupta and Mruthyunjaya 1998a, b; Lu and Hu 2006) principle of virtual work (Tsai 2000; Sokolov and Xirouchakis 2007; Zhang and Song 1993) and other methods (Huang et al. 2002) are proposed to derive dynamic equations of parallel mechanisms.
Inverse dynamic analysis requires that the actuator of a parallel mechanism to be specified in terms of its input-force–time history, thus a motion path planning of the end-actuator is necessary.
In this paper, a simple and efficient method is proposed to derive inverse dynamics formulations of a 6 degree-of-freedom (6-DOF) parallel mechanism for dynamic simulation. The purpose of the paper is to analyze the inverse dynamics of a DOF parallel mechanism in which inertial forces of all links and moving platform are considered. In this paper, inverse dynamics formulation will be derived based on principle of Kane. By this method, we can avoid the explicit constraints and easily establish the dynamic formulation form each link of the parallel mechanism.
This paper is organized as follows: in Sect. 2, Kane formulation is introduced; next, the structure of 6-DOF parallel mechanism, inertial coordinate frame and moving coordinate frame are set forth in Sect. 3; kinematics analysis is introduced in Sect. 4; inverse dynamics equations are complete derived based on the principle of Kane in Sect. 5; in Sect. 6, the numerical simulation is implemented by utilizing of MATLAB and ADAMS.
2 Kane formulation
Based on the principle of Kane, the dynamics formulations of a multibody system with n bodies could be written as follows.
In Eq. 1, \( K_{\gamma } \) is generalized active force of the generalized velocity γ; \( K_{\gamma }^{*} \) is generalized inertial force of the generalized velocities γ. According to principle of Kane, the calculation of acceleration and partial acceleration, the partial velocities of mass centers, and partial angular velocities of all links are required.
3 Model description
The mechanism studied in this paper is a 6-DOF parallel mechanism, which is shown in Fig. 1, herein referred to as a 6-SPS (spherical-prismatic-spherical) parallel mechanism.
This parallel mechanism consists of a moving platform which is manipulated by six actuated links. Each link is connected with fixed platform and moving platform through spherical hinge. Since six links are identical, one link is choosed to derive dynamic equation. As shown in Fig. 2, it illustrates a link of parallel mechanism. Coordinate frames C um -X um Y um Z um and C bm -X bm Y bm Z bm are two moving coordinate frames that are located in up link and bottom link respectively. The origin of C um is located the in mass centre of up extensible link. The origin of C bm is located in the mass centre of bottom extensible link. Axis X um and axis X bm along with link A i B i (i = 1, 2,…,6). Axis Y um and axis Y bm are perpendicular to plane OA i B i (i = 1, 2,…,6). Axis Z um and axis Z bm comply with right hand rule.
O-XYZ is inertial coordinate frame that fixed on the fixed platform of parallel mechanism. O 1-X 1 Y 1 Z 1 is moving coordinate frame that fixed on the moving platform of parallel mechanism. The origin of the inertial coordinate frame O-XYZ locates in the mass center of the fixed platform. The original of the moving coordinate frame O 1-X 1 Y 1 Z 1 locates in the mass center of the moving platform.
4 Kinematics analysis
q = [x, y, z, α, β, γ]T is defined as generalized coordinate vector of the system. x, y and z denote orientation vector of the origin of the moving coordinate frame O 1-X 1 Y 1 Z 1 in inertial coordinate frame O-XYZ, and α, β and γ denote three Euler angles of moving coordinate frame O 1-X 1 Y 1 Z 1 in inertial coordinate frame O-XYZ. Thus, generalized velocity of the moving platform could be written as \( \mathop q\limits^{ \cdot } = \left[ {\begin{array}{*{20}c} {\mathop {x,}\limits^{ \cdot } } & {\mathop {y,}\limits^{ \cdot } } & {\mathop {z,}\limits^{ \cdot } } & {\mathop {\alpha ,}\limits^{ \cdot } } & {\mathop {\beta ,}\limits^{ \cdot } } & {\mathop \gamma \limits^{.} } \\ \end{array} } \right]^{T} = \left[ {\begin{array}{*{20}c} {v,} & \omega \\ \end{array} } \right]^{T} \) in inertial coordinate frame O-XYZ. v and ω denote line velocity and angular velocity of the moving platform respectively.
According to Fig. 2, vector equation of link A i B i could be written as follows.
where \( R = \left[ {\begin{array}{*{20}c} {c\beta c\gamma } & { - c\beta s\gamma } & {s\beta } \\ {s\alpha s\beta c\gamma + c\alpha s\gamma } & {c\alpha c\gamma - s\alpha s\beta s\gamma } & { - s\alpha c\beta } \\ {s\alpha s\gamma - c\alpha s\beta c\gamma } & {c\alpha s\beta s\gamma + s\alpha c\gamma } & {c\alpha c\beta } \\ \end{array} } \right]\), s denotes sine function and c denotes cosine function. In Eq. 2 S denotes the vector of link A i B i in inertial coordinate frame O-XYZ; P denotes orientation vectors of the origin of the moving coordinate frame O 1-X 1 Y 1 Z 1 in inertial coordinate frame O-XYZ; b i denotes the orientation vector of point B i in moving coordinate frame O 1-X 1 Y 1 Z 1; A i denotes the orientation vector of point A i in inertial coordinate frame O-XYZ; R denotes transformation matrix.
By differentiating Eq. 2, the equation could be written as follows
where c i = R b i . \( \mathop S\limits^{ \cdot } \) denotes the velocity of the point B i in inertial coordinate frame. \( \mathop P\limits^{ \cdot } \) denotes the velocity of the origin O 1 in the inertial coordinate frame. \( \omega \) denotes the angular velocity of the moving platform in inertial coordinate frame.
It is assumed that the length l and unit vector s of link A i B i are predefined. There exists the formulation s = S/l and Eq. 3 could be transformed as follows
where \( \mathop l\limits^{ \cdot } \) denotes relative line velocity between up link and bottom link; \( \omega_{l} \) denotes angular velocity of link A i B i .
Cross-producting with unit vector s on both sides of Eq. 4 yields
Mass centre velocity of moving platform v m could be written as follows
where r m denotes mass centre orientation vector of moving platform in moving coordinate frame.
Line velocity of point B i in moving platform could be obtained
where \( r_{{B_{i} }} \) denotes orientation vector of point B i in moving coordinate frame.
Mass centre velocity of bottom link v dm could be obtained
where l d denotes the length of the bottom link and l dm denotes the length from point A i to mass centre of bottom link.
Mass centre velocity of up link v um could be obtained
where l u denotes the length of the up link.
Relative line velocity between up link and bottom link could be obtained
Partial velocity \( v_{m}^{k} \) and partial angular velocity \( \omega_{m}^{k} \) of mass centre of the moving platform could be obtained (Huang et al. 2002)
where I 3 is 3 × 3 unit matrix.
where 0 3 is 3 × 3 zero matrix.
Partial angular velocity \( \omega_{l}^{k} \) of links could be obtained (Huang et al. 2002)
where c = [c i ]
Partial velocity \( v_{dm}^{k} \) of up links could be obtained
Partial velocity \( v_{um}^{k} \) of up links could be obtained
Partial velocity \( v_{r}^{k} \) of up link and bottom link corresponding to their relative velocity could be obtained
5 Dynamics analysis
Generalized active forces of constrains are zero, thus neglecting constrains in calculation of generalized active forces. F i denotes driving force in link A i B i , thus generalized active force corresponding to generalized velocity \( \mathop q\limits^{ \cdot } \) could be obtained
M is predefined mass of moving platform. M id and M iu are predefined the mass of bottom link and up link in link A i B i respectively. F W and m w denote external force and torque that exerted on the mass centre of the moving platform. g denotes gravity acceleration. Moving platform’s generalized active force F vx , F vy and F vz corresponding to generalized velocities v x , v y and v z could be obtained (Huang et al. 2002).
Moving platform’s generalized active forces F ωx , F ωy and F ωz of the generalized velocities ω x , ω y and ω z could be obtained (Huang et al. 2002)
Moving platform’s generalized inertial forces \( F_{vx}^{*} \), \( F_{vy}^{*} \) and \( F_{vz}^{*} \) of the generalized velocities v x , v y and v z could be obtained
where a id and a iu denote line acceleration of up link and bottom link in link A i B i respectively. i id and i iu denote rotary inertia of up link and bottom link in link A i B i respectively. \( \varepsilon_{i\tau } \) denotes angular acceleration of link A i B i .
Moving platform’s generalized inertial forces \( F_{\omega x}^{*} ,\;F_{\omega y}^{*} \) and \( F_{\omega z}^{*} \) of the generalized velocities ω x , ω y and ω z could be obtained
where \( \varepsilon_{m} \) denotes angular acceleration of the moving platform; \( \varepsilon_{i\tau } \) denotes tangential acceleration of the link; I m denotes rotary inertia of the moving platform; I id denotes rotary inertia of the bottom link; I iu denotes rotary inertia of the up link;
The transformation of Eq. 1 could be written as follows
Substituting Eqs. 18–29 into Eq. 30 and rearranging that a set of line equation could be obtained corresponding to external force F i (i = 1, 2,…,6)
where J is Jacobian matrix of the parallel mechanism, and C i (i = 1, 2,…,6) just as follows
where a m denotes acceleration of the moving platform.
6 Numerical example
In this section, simulations of the inverse dynamics are performed to study the inverse dynamic characteristics of the actuated forces in links. A line trajectory is utilized for the demonstration. Moving platform and fixed platform are both circle platform. The radius and mass of moving platform are 0.1 m and 1 kg respectively. Initial orientation vector of the moving platform mass center is [0, 0.2, 0.45]T m in inertial coordinate frame. Initial velocity vector of the moving platform mass centre is v = [0, 0.1, 0]T m/s, and initial acceleration vector of the moving platform mass centre is a = [0, 0.1, 0]T m/s2. External forces that exerted on the mass centre of moving platform is F w = [80, −50, −100]T N. Moving time of the moving platform is 2 s.
Inverse dynamics calculation program of 6-SPS parallel mechanism is programmed by using of MATLAB. Driving forces of six links is solved out by calculation program as shown in Fig. 3.
The software ADAMS is widely used for the mechanical system dynamic simulation. In this study, the ADAMS is used to verify the inverse dynamics analysis derived above (Wu and Wu 2008). Firstly, the model is imported into the ADAMS software by adding various constrains; secondly, the driving forces data is imported into motion of the ADAMS model, their driving functions as below:
-
SFORCE_1: AKISPL (time, 0, spline_F1, 0),
-
SFORCE_2: AKISPL (time, 0, spline_F2, 0),
-
SFORCE_3: AKISPL (time, 0, spline_F3, 0),
-
SFORCE_4: AKISPL (time, 0, spline_F4, 0),
-
SFORCE_5: AKISPL (time, 0, spline_F5, 0),
-
SFORCE_6: AKISPL (time, 0, spline_F6, 0),
Import the above six driving functions into the six forces driving respectively, we can get the parallel mechanism trajectory, shown as Fig. 4. The relationship of velocity, acceleration and displacement of mass centre of moving platform with time are shown in Figs. 5, 6 and 7.
From above Figs. 4, 5, 6 and 7, we can see that, the simulation trajectory and other kinds of motion parameters are consistent with the planned ones, which proves the correctness and feasibility of inverse dynamics mathematic model. Cross-producting and dot-producting are main computing means in dynamic model which are suitable for computer solving and with high speed. This method is suitable for the real-time control of parallel mechanisms in industrial field.
References
Carretero, J.A., Podhorodeski, R.P., Nahon, M.N., Gosselin, G.M.: Kinematic analysis and optimization of a new three-degree-of-freedom spatial parallel manipulator. J. Mech. Des. 122(1), 17–24 (2000)
Dasgupta, B., Mruthyunjaya, T.S.: A Newton–Euler formulation for inverse dynamics of the Stewart platform manipulator. Mech. Mach. Theory 33(8), 1135–1152 (1998a)
Dasgupta, B., Mruthyunjaya, T.S.: Closed-form dynamic equations of the general Stewart platform through the Newton–Euler approach. Mech. Mach. Theory 33(7), 993–1012 (1998b)
Dunlop, G.R., Jones, T.P.: Position analysis of a two DOF parallel mechanism-Canterbury tracker. Mech. Mach. Theory 34(4), 599–614 (1999)
Gosselin, C., Angeles, J.: The optimum kinematic design of a planar three degree of freedom parallel manipulator. J. Mech. Transm. Autom. Des. 110(1), 35–41 (1998)
Huang, Q., Hådeby, H., Sohlenius, G.: Connection method for dynamic modeling and simulation of parallel kinematic mechanism (PKM) machines. Int. J. Adv. Manuf. Tech. 19(3), 163–176 (2002)
Huang, T., Li, Z., Li, M., Chetwynd, D., Gosellin, G.M.: Conception design and dimensional synthesis of a novel 2-DOF translational parallel robot for pick-and-place operations. J. Mech. Des. 126(3), 449–455 (2004)
Lebret, G., Liu, K., Lewis, F.L.: Dynamic analysis and control of a Stewart platform manipulator. J. Robot. Syst. 10(5), 629–655 (1993)
Lee, J.D., Geng, Z.: A dynamic model of a flexible Stewart platform. J. Robot. Syst. 48(3), 367–374 (1993)
Lu, Y., Hu, B.: Analysis of kinematics and solution of active/constrained forces of asymmetric 2UPU + X parallel manipulator. J. Mech. Eng. Sci. Proc. IMechE Pt. C220 (2006). doi:10.1243/0954406JMES397
Merlet, J.P.: Parallel Robots, 1st edn. Kluwer Academic Publisher, Dordrecht (2000)
Qiu, B.Q.: Analysis Mechanics. Chinese Railway Press, Beijing (1998)
Sokolov, A., Xirouchakis, P.: Dynamic analysis of a 3-DOF parallel manipulator with R-P-S joint structure. Mech. Mach. Theory 42(5), 541–557 (2007)
Stewart, D.: A platform with six degree of freedom. Proc. Inst. Mech. Eng. 1 180(15), 371–386 (1965)
Tsai, L.W.: Robot Analysis: The Mechanics of Serial and Parallel Manipulators. Wiley, New York (1999)
Tsai, L.W.: Solving the inverse dynamics of a Stewart–Gough manipulator by the principle of virtual work. J. Mech. Des. 122(1), 3–9 (2000)
Wu, P., Wu, C.: Motion planning and coupling analysis based on 3-RRR(4R) parallel mechanism. Int. J. Mech. Mater. Des. 4(3), 325–331 (2008)
Xiuling, L., Qingquan, W., Alexander, M., Hongrui, W.: The design and dynamic analysis of a novel of 6-DOF parallel mechanism. Int. J. Mach. Learn. Cybern. 2 (2011). doi:10.1007/s13042-011-0040-1
Zanganeh, E., Sinatra, R., Angeles, J.: Kinematics and dynamics of a six-degree-of-freedom parallel manipulator with revolute legs. Robotica 15(4), 385–394 (1997)
Zhang, C.D., Song, S.M.: An efficient method for inverse dynamics of manipulators based on virtual work principle. J. Robot. Syst. 10(5), 605–627 (1993)
Acknowledgment
The author would like acknowledge Prof. Changlin Wu, Associate Prof. Lianqing Yu, and lady Jingjing Liu for their contribution to this paper.
Author information
Authors and Affiliations
Corresponding author
Rights and permissions
About this article
Cite this article
Wu, P., Xiong, H. & Kong, J. Dynamic analysis of 6-SPS parallel mechanism. Int J Mech Mater Des 8, 121–128 (2012). https://doi.org/10.1007/s10999-012-9181-y
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10999-012-9181-y