Next Article in Journal
Expansion of MK Circle Theory for Dyads and Triads
Previous Article in Journal
Numerical Investigation of Background Noise in a Circulating Water Tunnel
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Kinematics and Dynamics Analysis of a 3UPS-UPU-S Parallel Mechanism

State Key Laboratory of Tribology in Advanced Equipment, Department of Mechanical Engineering, Tsinghua University, Beijing 100084, China
*
Author to whom correspondence should be addressed.
Machines 2023, 11(8), 840; https://doi.org/10.3390/machines11080840
Submission received: 12 June 2023 / Revised: 26 July 2023 / Accepted: 31 July 2023 / Published: 18 August 2023
(This article belongs to the Section Automation and Control Systems)

Abstract

:
In this paper, a two-rotational degrees of freedom parallel mechanism with five kinematic subchains (3UPS-UPU-S) (U, P, and S stand for universal joints, prismatic joints, and spherical joints) for an aerospace product is introduced, and its kinematic and dynamic characteristics are subsequently analyzed. The kinematic and dynamic analyses of this mechanism are carried out in screw coordinates. Firstly, the inverse kinematics is performed through the kinematic equations established by the velocity screws of each joint to obtain the position, posture, and velocity of each joint within the mechanism. Then, a dynamic modeling method with screw theory for multi-body systems is proposed. In this method, the momentum screws are established by the momentum and moment of momentum according to the fundamentals of screws. By using the kinematic parameters of joints, the dynamic analysis can be carried out through the dynamic equations formed by momentum screws and force screws. This method unifies the kinematic and dynamic analyses by expressing all parameters in screw form. The approach can be employed in the development of computational dynamics because of its simplified and straightforward analysis procedure and its high adaptability for different kinds of multi-body systems.

1. Introduction

Multi-body systems offer multiple advantages over single-body systems, including improved load distribution, enhanced flexibility, and increased adaptability to diverse operating conditions. These systems find extensive applications in various fields, such as robotics, aerospace, automotive, and manufacturing industries. Among them, parallel mechanisms have garnered significant attention due to their high rigidity, accuracy, and ability to perform precise, complex motion tasks. Despite their inherent complexity and non-linearity, redundantly actuated parallel mechanisms are extensively designed to overcome singularity issues and enhance structural stiffness and load capacity.
Understanding the kinematics and dynamics of parallel platforms is crucial for their practical implementation. Kinematic analysis reveals the motion characteristics of parallel mechanisms by solving the kinematic parameters such as posture, position, and velocity of individual joints within the system. By using conventional kinematic modeling approaches to describe both rotational and translational motions, a suitable mathematical framework in a relatively general way is required. Screw coordinates have been proposed as a valuable tool to simplify the kinematic analysis of parallel mechanisms [1].
Dynamics analysis plays a significant role in achieving robot control, motion stability, and structural optimization. However, redundantly actuated parallel mechanisms present challenges in dynamic modeling due to their complexity and computational requirements. Several methods have been proposed to analyze the dynamics of multi-rigid-body systems, including Lagrange equations [2,3], Newton–Euler equations [4,5,6], virtual work principles [7,8,9,10], Kane equations [11,12], and Gibbs–Appell equations [13,14]. The analysis of multi-rigid-body systems often relies on mathematical methods from classical mechanics and vector equations [7,15]. Additionally, the screw theory has been extensively used for dynamic analysis, providing efficient modeling of mechanisms based on kinematic formulations through screw theory [16,17,18]. As Pennock has discussed the geometric relationship between velocity screws and momentum screws [19], researchers such as Gallardo [17,20] have presented kinematic and dynamic models for parallel mechanisms utilizing screw coordinates. Müller has pointed out that besides the contribution to the kinematic analysis made by screw theory, screw theory and the Lie group can also be applied to the dynamic analysis of multi-body systems with high efficiency [21,22]. Zhao [5] has investigated an approach to dynamic analysis of multi-body systems by expressing acceleration in screw form using screw and Lie products, but the dynamic equations are established using the velocity expressed in screw coordinates as a global variable according to the Newton–Euler method. Dynamic analysis is rarely carried out systematically by screw theory. Therefore, this paper focuses on dynamic modeling by combining momentum screws and force screws. And a novel procedure to obtain dynamic equations through differential equations based on the theorem of the momentum screw is proposed and applied to the dynamics of various mechanisms.
In this paper, we present the design of a parallel mechanism with five kinematic chains to achieve two rotational degrees of freedom (DoFs) according to the task demands and propose a novel dynamic modeling process by establishing the dynamic equations derived from the theorem of momentum to simplify the dynamic analysis in a concise manner.
The main contributions of this paper are as follows:
(1)
The dynamic equations of the differential momentum screw and force screw are deduced in detail. There is no acceleration needed in dynamic modeling. It shows that utilizing momentum and the moment of momentum screws offers a clearer physical interpretation of the dynamics analysis and facilitates computation in programming.
(2)
The forces and torques of each joint can be simultaneously solved in the absolute coordinate system.
(3)
The programming code of this algorithm is compact and easy to structure and debug. This method can be applied not only to the analysis of parallel mechanisms but also to planar and spatial mechanisms.

2. Geometry Design of the Parallel Mechanism

A parallel mechanism incorporating five kinematic subchains has been designed to fill a task demand with two rotational DoFs, and the overall size, occupation of the parts within the mechanism, some designated structure, and other factors have been considered. Five kinematic subchains are assembled and connect the base and the moving platform to achieve continuous swiveling on two axes, and the DoFs are computed and verified in Section 3.2. As illustrated in Figure 1, this parallel platform consists of a base and a mobile platform, which is formed with a spherical joint to obtain a kinematic chain denoted as {S}. Additionally, the mechanism consists of three kinematic chains denoted as {UPS} and one kinematic chain denoted as {UPU}, where the letters U, P, and S signify universal joint, prismatic pair, and spherical joint, respectively. The primary U joints of four side kinematic chains are distributed and assembled uniformly along the edge of the base at points A 1 , A 2 , A 3 , and A 4 , while four last joints including one U joint and three S joints are assembled on the edge of moving platform at points C 1 , C 2 , C 3 , and C 4 . The radii of circumcircle of A 1 A 2 A 3 A 4 and C 1 C 2 C 3 C 4 are R and r , respectively. The fifth kinematic chain {S} has only one spherical joint, its revolute center is coincided with the geometrical center of the base, and here is the origin of the coordinate system: O . The first rotary aches of the primary U joints in chains {UPU} and {UPS} fixed on the base are coplanar and intersect at the origin O . On the initial assembly configuration, the universal joint planes of all universal joints and the moving platform plane are parallel to the base plane.
As the origin O is chosen at the geometrical center of the base, and the z -axis is perpendicular to the base and points to the moving platform, the x -axis points to A 3 , then, the y -axis can be settled through right-hand rule.

3. Kinematics Analysis

3.1. Fundamentals of Screw Theory

To describe the rotational motion of a free rigid body in the reference coordinate frame, the angular velocity ω can be expressed through:
ω = ω 1 e 1 + ω 2 e 2 + ω 3 e 3
where e 1 ,     e 2 ,   e 3 are unit direction vectors and ω 1 ,   ω 2 ,   ω 3 are the amplitude of the components of ω in e 1 ,   e 2 ,   e 3 . Therefore, the expression of angular velocity of the free rigid body can be simplified as
ω = [ ω 1 ω 2 ω 3 ] T
Then, with r = x e 1 + y e 2 + z e 3 presenting the position vector of the point attached on this rigid body, the linear velocity of this point passing through the origin is
v = d r d t = ω × r
The kinematics of a joint in a serial kinematic chain are relative to the kinematics of the fore joints. Based on the addition theorem for angular velocities, the angular velocity and the linear velocity of joint J m in a serial kinematic chain with respect to the absolute coordinate frame O can be obtained as follows:
{ ω O m = ω O 1 + ω 1 2 + ω 2 3 + + ω m 2 m 1 + ω m 1 m v O m = d r O m d t = ω O m × r
According to the screw theory, the velocity of joint J m can be specified by dual 3-dimensional vectors ω O m and v O m . Therefore, in the following, the relative velocity screw m 1 m S V of joint J m in screw coordinate is defined as:
S m 1 m V = [ ω m 1 m r 0 m × ω m 1 m ] = ω m 1 m [ e m 1 m r 0 m × e m 1 m ] = ω m 1 m S m 1 m u
where ω m 1 m is the magnitude of the relative angular velocity of joint J m with respect to joint J m 1 and the unit vector along the rotary axis is e m , which norm is e m = 1 , S m 1 m u represents the unit relative velocity screw of joint J m .
From Equations (4) and (5), the forward kinematics of the kinematic chain having n joints in serial can be derived through:
0 n S V = i = 1 n i 1 i S V = S V ω V
where S V = [ 0 1 S u 1 2 S u n 1 n S u ] 6 × n represents the unit velocity screw matrix of a serial chain with n joints and ω V = [ 0 1 ω 1 2 ω n 1 n ω ] n × 1 T expressing the angular velocity vector containing all relative angular velocities of every joint in this chain relative to its fore joint, with 0 referring to the origin of the coordinate frame.
On the other hand, when the kinematics of the end effector in the absolute coordinate frame are known, the angular velocity vector can be solved by
ω V = [ S V T S V ] 1 S V T ( 0 n S V )
If the mechanism is neither redundantly actuated nor in a singularity configuration, it meets | S V T S V | 0 . [ S V T S V ] 1 S V T is called the pseudo-inverse of the unit velocity screw matrix S V . Through the velocity parameters from Equation (7), the displacement and acceleration can be gained by first-order numerical integration and first-order numerical differential interpolation, respectively.
During verse kinematics analysis process, at t = 0 , the initial conditions of the angular displacement vector θ ( 0 ) is given in form:
θ ( 0 ) = [ 0 1 θ ( 0 ) 1 2 θ ( 0 ) n 2 n 1 θ ( 0 ) n 1 n θ ( 0 ) ] n × 1 T
Equation (8) is then substituted into unit screw matrix S V in Equation (5) to calculate the solution of ω V ( 1 ) for the first-time segment. Afterwards, the successive parameters of S V ( k ) at t = k Δ t can be updated by:
θ ( k + 1 ) = θ ( k ) + Δ t ω V ( k )
with k = 1 , 2 , presenting the steps of iteration.
Within the S V ( k ) , the position vector r 0 m and posture e m 1 m of m -th joints with m = 1 , 2 , , n can be obtained.

3.2. Workspace and Mobility Analysis of the 3 U P S - U P U - S Parallel Mechanism

This parallel mechanism is designed based on a specified application. It is required to have two rotational degrees of freedom around the x - and y -axis as shown in Figure 1. The demanded swing angles of the moving platform, as illustrated in Figure 2 are 10°. As universal joints and spherical joints in kinematic chains have only a little effect on the workspace regarding the designated swing angles, the workspace is limited mainly by the effective length of subchains with the prismatic joints. The design of the chain length and the selection of prismatic joints are determined by the required swing angles.
Figure 3 depicts the unit vector of all kinematic joints in each chain. As the velocities, positions, and postures of each joint are expressed in screw coordinates, the reciprocal screw theory is employed here to compute the mobility of this parallel mechanism. In accordance with the reciprocal screw theory, there is:
S V T S r = 0
where = [ 0 I 3 × 3 I 3 × 3 0 ] and the 3rd-order identity matrix I 3 × 3 = [ 1 0 0 0 1 0 0 0 1 ] .
The kinematic screws of the 1st subchain {UPU} can be expressed by five joints as:
S U P U 1 = [ 1 0 0 0 0 0 ] T S U P U 2 = [ 0 1 0 0 0 R ] T S U P U 3 = [ 0 0 0 sin θ 0 cos θ ] T S U P U 4 = [ cos θ 0 sin θ 0 R sin θ L 0 ] T S U P U 5 = [ 0 1 0 L cos θ 0 R L sin θ ] T
where L U P U is the total length of the {UPU} chain and θ represents the angle between {UPU} chain and z -axis.
From Equation (11), the screw matrix of {UPU} chain can be obtained:
S 1 = [ S U P U 1 S U P U 2 S U P U 3 S U P U 4 S U P U 5 ]
Therefore, the inverse screw of {UPU} chain can be derived based on Equation (12):
S U P U r = [ 0 1 0 0 0 R + L sin θ ] T
Through the definition of a screw, Equation (13) denotes a force parallel to y -axis and passing through point ( R + L sin θ y 0 ) , where y can be any significant real number.
Similarly, the inverse screws of three {UPS} chains and {S} chain can be obtained as:
S U P S r = [ 0 0 0 0 0 0 ] T
and
S S r = [ 1 0 0 0 0 0 0 1 0 0 0 0 0 0 1 0 0 0 ] T
From Equations (13)–(15), the terminal constraints of the moving platform can be obtained as
S P C = [ 0 1 0 0 1 0 1 0 0 0 0 1 0 0 0 0 0 0 0 0 R + L sin θ 0 0 0 ]
The free velocity screws of the moving platform can also be computed from the reciprocal screw method, which is:
( S P C ) T S P = 0
Therefore, the mobility of this parallel mechanism can be derived as
S P = [ 1 0 0 0 0 0 0 1 0 0 0 0 ] T
Equation (19) indicates that the mechanism has two rotational degrees of freedom around x - and y -axis of the coordinate frame illustrated in Figure 2. From the calculation above, it can be seen that with one {UPU} chain, one {UPS} chain, and one {S} can also satisfy the mobility requirements. The two additional {UPS} subchains are designed to achieve better load distribution and stability.

3.3. Kinematic Modeling of the 3 U P S - U P U - S Parallel Mechanism

Through the fundamentals of screws, the velocity screw matrix of each serial kinematic subchain could be obtained through Equations (5) and (6).
As shown in Figure 2, the velocity screw matrix of the 1st {UPU} chain can be expressed as:
S V 1 = [ 1 e 1 r A 1 × 1 e 1 1 e 2 r A 1 × 1 e 2 0 1 e 3 1 e 4 r C 1 × 1 e 4 1 e 5 r C 1 × 1 e 5 ] 6 × 5
where 1 S 1 = [ 1 e 1 1 r U 1 × 1 e 1 ] is the unit velocity screw of a revolute joint and 1 S 3 = [ 0 1 e 3 ] denotes the unit velocity screw of a prismatic pair, and the subscript 6 × 5 of the matrix represents the dimensions of the matrix.
Through the same procedure, the velocity screw matrix of 2nd to 4th {UPS} chains and 5th {S} chain can be gained as
S V i = [ i e 1 r A i × i e 1 i e 2 r A i × i e 2 0 i e 3 i e 4 r C i × 1 e 4 i e 5 r C i × 1 e 5 i e 6 r C i × 1 e 5 ] 6 × 6 ,   i = 2 ,   3 ,   4 S V 5 = [ 5 e 1 r A 5 × 5 e 1 5 e 2 r A 5 × 5 e 2 5 e 3 r A 5 × 5 e 3 ] 6 × 3
The kinematic screw equation of parallel mechanisms with multi kinematic chains can be written as:
S ω = S V
where
S = diag [ [ S V 1 ] 6 × 5 [ S V 2 ] 6 × 6 [ S V 3 ] 6 × 6 [ S V 4 ] 6 × 6 [ S V 5 ] 6 × 3 ] 30 × 26
is composed of the velocity screw matrix of each kinematic chain and diag [ ] is the diagonal matrix of S V i   ( i = 1 , 2 , , 5 ) , and
ω = [ [ ω 1 ] 5 × 1 T [ ω 2 ] 6 × 1 T [ ω 5 ] 3 × 1 T ] 26 × 1 T
is the velocity vector and contains all the relative angular velocities of each kinematic joint.
The velocity screw S V can be expressed through
S V = [ [ O C 1 S V 1 ] 6 × 1 T [ O C 2 S V 2 ] 6 × 1 T [ O C 3 S V 3 ] 6 × 1 T [ O C 4 S V 4 ] 6 × 1 T [ O C 5 S V 5 ] 6 × 1 T ] 30 × 1 T
with O C i S V i ( i = 1 , 2 , , 5 ) representing the absolute velocity screws of the end effectors of i -th kinematic chain.
As the topological diagram illustrated in Figure 4, according to the given motion of the geometric center E on the outer ring of the moving platform O E S V , the velocity screws of the end effectors of each kinematic chain O C i S V i ( i = 1 , 2 , , 5 ) can be calculated by:
O C i S V i = O E S V C i E S V i ( i = 1 , 2 , , 5 )
where C i E S V i ( i = 1 , 2 , , 5 ) denotes the relative velocity screw of point E with respect to C i   ( i = 1 , 2 , , 5 ) , which is
C i E S V i = [ 0 O C i ω i × r E ] 6 × 1   ( i = 1 , 2 , , 5 )
with O C i ω i presenting the absolute angular velocity of the last kinematic joint of the kinematic chain and r E being the absolute position vector of the geometric center E in the coordinate frame O .
Through inverse kinematics Equation (7), the relative angular velocities of each joint in kinematic chains can be derived from the given kinematics of E as
ω = [ S T S ] 1 S T S V
Substituting Equations (19) and (20), and Equations (22)–(24) into Equation (25), the inverse velocity of the mechanism can be solved.

4. Dynamic Modeling

4.1. Fundamentals of Momentum Screw in Dynamic Analysis

As illustrated in Figure 5, the mass center C is chosen as the reference point of the rigid body Ω , the velocity of point C can be obtained through O v C = d r C d t , and the velocity of body-fixed mass segment d m at point A can be calculated by v A =   O v C + ω × r C A .
Considering the fundamental definition of momentum, the momentum of the mass d m can be expressed as
d p = v d m
Consequently, upon integrating the Equation (28) across the entirety of the rigid body, the resulting expression is obtained:
p = Ω d p = Ω v d m = Ω ( O v C + ω × r C A ) d m = Ω O v C ρ d V + Ω ( ω × r C A ) ρ d V = Ω O v C ρ d V = m O v C
Equation (29) is simplified based on the definition of mass center with Ω r C A ρ d V = 0 . Similarly, the moment of momentum for the whole rigid body can be derived as:
L O = Ω d ( O L ) = Ω ( r C + r C A ) × ( v C + ω × r C A ) d m = r C × m v C + ω { Ω [ ( r C A T r C A ) I ( r C A r C A T ) ] ρ d V } = r C × m v C + J C ω
where J C = Ω [ ( r C A T r C A ) I ( r C A r C A T ) ] ρ d V .
Then the momentum screw S M can be established by dual 3-dimensional vector p and L O as
S M = [ p r C × p + J C ω ] = [ p L O ] 6 × 1
Based on the parallel theorem of forces, the action of a force F A , which acts on the rigid body at point A observed in the absolute coordinate frame O , can be equivalently balanced through the resultant action of a force system F A and r A × F A . The force screw O S F on the rigid body can be obtained:
O S F A = [ F A r A × F A ] = [ F A T A ] 6 × 1
According to Newton’s second law,
d p d t = F
and
d ( J C ω ) d t = r C A × F
Substituting Equations (33) and (34) into Equation (31), it can be drawn that
d S M d t = S F
Therefore, Equation (33) can be rewritten by integrating both sides of the equation as
S M ( t 2 ) S M ( t 1 ) = t 1 t 2 S F d t
Considering the equivalent condition of a rigid body, the resultant forces screw must be zero, that is S F = 0 . Then,
S M ( t 2 ) S M ( t 1 ) = 0
For a multi-rigid-body system, the momentum screw can be expresses as:
i = 1 n [ S M i ( t 2 ) S M i ( t 1 ) ] = K = 1 K t 1 t 2 S F K d t
where n is the number of the rigid bodies in the system and K is number of the external loads.
When K = 1 K t 1 t 2 S F K d t = 0 , the system is in a state of equilibrium, otherwise, there is
d d t [ i = 1 n S O M i ( t ) ] = j = 1 K S O F K
From Equation (39), it is clear that the acceleration information of each joint is not required in establishing dynamic equations. The computation and programming are simplified, and the computational efficiency is significantly enhanced compared to conventional dynamic modeling based on Newton–Euler equations, especially the dynamic analysis algorithm using displacement as a global variable, because the whole procedure to compute acceleration through second-order differential can be avoided.

4.2. Dynamic Modeling of the 3UPS-UPU-S Parallel Mechanism

To enhance the load capacity and optimize the load distribution, the four kinematic subchains with prismatic pairs are active driven limbs, and the actuators are assembled in prismatic pairs.
As shown in Figure 6a, the lower limbs of four subchains contain one universal joint and one prismatic joint, the momentum screw of the lower limbs can be derived as:
S M L = [ p r C × p + J C ω ] = [ m L ( ω i × r i L ) O J i L ω i ]   ( i = 1 , 2 , 3 , 4 )
where O J L = R O J L R O T + m L [ ( r L T r L ) I ( r L r L T ) ] is the inertia matrix of lower limbs in the absolute coordinate system with the transformation matrix from the local coordinate frame to the absolute coordinate frame R O and the inertia matrix of lower limbs J L in their respective local coordinate frame. r presents the position vector of the mass center of each limb in the absolute coordinate frame.
The force screw of the lower limbs in general form can be written based on Equation (30) as
O S F L = [ F A i + F B i + m L g r A i × F A i + T A i + r B i × F B i + T B i + r L i × m L g ]   ( i = 1 , 2 , 3 , 4 )
Then, according to Equation (37) the momentum screw equation of four lower limbs can be obtained
d d t [ m L ( ω i × r i L ) O J i L ω i ] = [ F A i + F B i + m L g r A i × F A i + T A i + r B i × F B i + T B i + r L i × m L g ]   ( i = 1 , 2 , 3 , 4 )
Similarly, the upper limbs of four subchains contains prismatic joint and universal joint or spherical joints, which is shown in Figure 6c, the momentum screw can be written as
S M E U = [ p r C × p + J C ω ] = [ m E U v E U + m E U ( ω 1 E U × r 1 E U ) O J 1 E U ω 1 E U ]   S M E S = [ p r C × p + J C ω ] = [ m E S v E S + m E S ( ω i E S × r i E S ) O J i E S ω i E S ]   ( i = 2 , 3 , 4 )
The force screw of the upper limbs of four subchains are
O S F E U = [ F B 1 + F C 1 + m E U g r B 1 × F B 1 + T B 1 + r C 1 × F C 1 + T C 1 + r 1 E U × m E U g ] O S F E S = [ F B i + F C i + m E S g r B i × F B i + T B i + r C i × F C i + r i E S × m E S g ]   ( i = 2 , 3 , 4 )
The momentum screw of the moving platform can be deduced as:
S M G = [ p r C × p + J C ω ] = [ m G v G r G × ( m G v G ) + O J G ω G ]
where r G is the position vector of mass center G of the moving platform in the absolute coordinate frame.
The moving platform consists of one universal pair and four spherical pairs, which are shown in Figure 6d. The force screw of the moving platform is
S F G = [ i = 1 4 F C i + F A 5 + m G g + F E i = 1 4 ( r C i × F C i ) + T C 1 + r G × m G g + M E ]
Therefore, the momentum screw equation of the moving platform can be written as
d d t [ m G v G r G × ( m G v G ) + O J G ω G ] = [ i = 1 4 F C i + F A 5 + m G g + F E i = 1 4 ( r C i × F C i ) + T C 1 + r G × m G g + M E ]
By associating the momentum screw equations, the dynamic equation of 3 UPS - UPU - S parallel mechanism can be deduced based on Equation (47)
[ i = 1 4 F C i + F A 5 i = 1 4 ( r C i × F C i ) + T C 1 ] = d d t [ m G v G r G × ( m G v G ) + O J G ω G ] [ m G g + F E r G × m G g + M E ]
Afterwards, the driven forces at prismatic joints at points B i   ( i = 1 , 2 , 3 , 4 ) can be obtained through Equations (43) and (44):
F B 1 = d d t [ m U v U + m U ( ω 1 U × r 1 E U ) ] F C 1 m U g F B i = d d t [ m E v E + m E ( ω i S × r i E S ) ] F C i + m E g     ( i = 2 , 3 , 4 )

5. Numerical Simulation and Results Analysis

5.1. The Inverse Kinematics of the 3UPS-UPU-S Parallel Mechanism

To validate the efficiency of the kinematic and dynamic analysis methods proposed in this paper, a spatial trajectory is given for the moving platform. The function of trajectory over time is defined as
{ x ( t ) = 0.1 cos ( t ) + 0.2 ,   ( m ) y ( t ) = 0.1 sin ( t ) ,   ( m ) z ( t ) = H ,   ( m )
Through the trajectory, the displacement vector D E , velocity screw S E , and acceleration vector A E of the moving platform are that:
{ D E = [ 0.1 cos ( t ) + 0.2 0.1 sin ( t ) 0 0 0 H ] T ( m ) V E = [ 0.1 sin ( t ) 0.1 cos ( t ) 0 0 0 0 ] T ( m / s ) A E = [ 0.1 cos ( t ) 0.1 sin ( t ) 0 0 0 0 ] T ( m / s 2 )
t in Equations (50) and (51) is the time of the trajectory, the simulation step length is Δ t = 0.001 and the total number of iterations is n = 10000 . As depicted in Figure 1, H is the initial height between the geometric center O on the base platform and the geometric center E of the outer ring of the moving platform, L is the initial length between joint A and joint C . R and r are the constant radii of circle A 1 A 2 A 3 A 4 and C 1 C 2 C 3 C 4 formed by the primary universal joints and end universal/spherical joints of four kinematic subchains. θ and p give the initial assembly configurations of each kinematic joint in four kinematic chains. The configuration parameters and the initial assembly configuration parameters of the 3 U P _ S - U P _ U - S parallel mechanism for kinematics analysis are given in Table 1 and Table 2, respectively.
The inverse kinematics of the 3 U P _ S - U P _ U - S parallel mechanism are programmed and carried out based on the given trajectory, and the curves of the kinematics are plotted and shown in Figure 7 and Figure 8.
Figure 7a plots the relative angular displacements θ of each revolute joint in five kinematic subchains. Figure 7b shows the relative linear displacements d of all prismatic pairs of four subchains surrounding the moving platform.
Figure 8a depicts the relative angular velocity ω of each revolute joint in 3 U P _ S - U P _ U - S parallel mechanism. Figure 8b shows the relative linear velocity v 3 of four active prismatic pairs in four {UPU} and {UPS} subchains. According to the simulation results, there are no unexpected sudden changes in velocities, and the motion of each joint shows a harmonious operation of the mechanism.

5.2. The Inverse Dynamics of the 3 U P _ S - U P _ U - S Parallel Mechanism

Suppose that the resultant action of the external mechanical loadings is acting on the geometric center of the outer ring of the moving platform at point E . The given resultant force is F E = [ 0 0 1 ]   ( kN ) and the resultant moment is T E = [ 1 0 0 ]   ( kN m ) . By utilizing the kinematic parameters of each joint obtained in Section 5.1, the inverse dynamic analysis of the 3 U P _ S - U P _ U - S parallel mechanism could be carried out, and the driving forces, which should be provided by four prismatic joints, could be gained through the approach introduced in Section 4. The needed structure parameters are illustrated in Table 3.
The whole kinematic and dynamic calculation process can be programmed. The driving forces exerted by the four prismatic joints are depicted in Figure 9, providing valuable insights into the dynamics of the system. Throughout the entire motion cycle, the resultant driving forces exhibit variations, and the forces generated by the four actuators are comparable in magnitude. This observation signifies that the actuators in the four prismatic joints are involved in achieving the determined motion through the whole motion cycle. Moreover, the forces required to keep balance from the external loads by the four actuators exhibit uniformity in terms of magnitude. This uniformity in force generation among the actuators reflects effective coordination, ensuring synchronized operation. Consequently, this effective coordination among the actuators contributes to an optimized distribution of external loads. The system’s ability to achieve a balanced load distribution is of paramount importance, as it guarantees the equitable sharing of external forces and facilitates the smooth functioning of the mechanism. The results indicate the effectiveness of the two additional {UPS} subchains. The simulation results of displacements and the forces of actuators during the given motion cycle can provide initial guidance for the selection and configuration of actuators.
To validate the correctness of the modeling method proposed here, dynamic analysis modeling based on Newton–Euler equations is also established [5]. Method A represents the method using momentum screws and force screws proposed in this paper, and Method B is the method based on Newton–Euler equations. From Figure 9, the results of both methods are consistent, which indicates the correctness of both methods. Furthermore, a dynamic analysis is performed by commercial software, Adams. The kinematic parameters of the specified motion are defined in Adams simulation model, and the driving forces of four actuators in prismatic joints are analyzed. The results of numerical analysis through MATLAB shown in Figure 10a and the results of simulation through Adams shown in Figure 10b are comparable and have good consistency. The simulation model used in Adams is simplified, and the influence of step length on simulation results has different weights in MATLAB and Adams, which can result in differences between the results.
Besides all the driving forces, the support forces on each passive joint can be computed simultaneously. The forces exerted on universal joints assembled on the base at position A 1 ,   A 2 ,   A 3 ,   A 4 and the spherical joint at position A 5 of the 5th kinematic chain are illustrated in Figure 11a. It shows that the four surrounding subchains withstand more forces than the chain {S}, which facilitates rotation of the spherical joint of chain {S} and allows for more stable motion overall. Figure 11b demonstrates the forces acting on universal joints at position C 1 and spherical joints C 2 ,   C 3 ,   C 4 . In the whole motion period, forces vary according to the motion, and there are no sudden changes in forces, which expresses a stable and robust support.
The supporting forces on each joint can be measured by force sensors and employed in controlling the mechanism. The sensors should be arranged according to the working situation and other limitations, such as temperature and space limitations. By solving all the forces and torques of each joint, it provides the possibilities for designing various sensor arrangement schemes.

6. Conclusions

In this paper, a redundant actuated parallel mechanism with five kinematic subchains is introduced. The kinematics and dynamics of this mechanism are investigated in screw coordinates using the principle of screw theory. Firstly, the kinematic parameters of each kinematic joint within the mechanism, crucial for dynamic analysis, can be directly derived through velocity screws. Then, a dynamic modeling approach using momentum screws is proposed. Compared with conventional analysis methods like establishing Newton-Euler equations, employing momentum in screw form offers significantly improved computational efficiency and provides a clearer physical explanation of the equilibrium and control of multi-body systems. By utilizing screw coordinates, the coordination of kinematics and dynamics is achieved on a unified platform. Leveraging the kinematic information, the dynamic analysis can be carried out through the differential equations from the momentum screws and force screws, enabling simultaneous determination of the relevant forces and torques. Simulation results depict that the kinematics of each joint within this parallel mechanism can be initially solved based on the given motion of the manipulator. Additionally, the moving distance and required driving forces of each prismatic joint throughout the motion cycle can also be derived, offering essential information for actuator selection and configuration. Furthermore, the simulation results facilitate further optimization of the mechanism, such as controlling driving forces and torques within acceptable ranges. This method provides possibilities for the development of computational algorithms for dynamic analysis applicable to different types of mechanisms, including planar and spatial, as well as serial and parallel mechanisms.

Author Contributions

Methodology, J.-S.Z.; software, X.-C.S. and S.-T.W.; validation, J.-S.Z., X.-C.S. and S.-T.W.; formal analysis, J.-S.Z.; investigation, X.-C.S.; resources, J.-S.Z.; data curation, X.-C.S. and S.-T.W.; writing—original draft preparation, X.-C.S.; writing—review and editing, J.-S.Z., X.-C.S. and S.-T.W.; visualization, J.-S.Z., X.-C.S. and S.-T.W.; supervision, J.-S.Z.; project administration, J.-S.Z.; funding acquisition, J.-S.Z. All authors have read and agreed to the published version of the manuscript.

Funding

This work was supported in part by the National Natural Science Foundation of China under Grant 51575291, in part by the National Major Science and Technology Project of China under Grant 2015ZX04002101, in part by the State Key Laboratory of Tribology, Tsinghua University, and in part by the 221 Program of Tsinghua University.

Informed Consent Statement

Not applicable.

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Zhao, J.-S.; Wei, S.-T.; Sun, H.-L. Kinematics and Statics of a 3-UPU Robot in Screw Coordinates. J. Mech. Robot. 2023, 15, 061004. [Google Scholar] [CrossRef]
  2. Chen, X.; Wu, L.; Deng, Y.; Wang, Q. Dynamic Response Analysis and Chaos Identification of 4-UPS-UPU Flexible Spatial Parallel Mechanism. Nonlinear Dyn. 2017, 87, 2311–2324. [Google Scholar] [CrossRef]
  3. Liu, S.; Peng, G.; Gao, H. Dynamic Modeling and Terminal Sliding Mode Control of a 3-DOF Redundantly Actuated Parallel Platform. Mechatronics 2019, 60, 26–33. [Google Scholar] [CrossRef]
  4. Chen, M.; Zhang, Q.; Qin, X.; Sun, Y. Kinematic, Dynamic, and Performance Analysis of a New 3-DOF over-Constrained Parallel Mechanism without Parasitic Motion. Mech. Mach. Theory 2021, 162, 104365. [Google Scholar] [CrossRef]
  5. Zhao, J.-S.; Wei, S.-T.; Sun, X.-C. Dynamics of a 3-UPS-UPU-S Parallel Mechanism. Appl. Sci. 2023, 13, 3912. [Google Scholar] [CrossRef]
  6. Chen, X.; Li, Y. Dynamics Analysis of Spatial Parallel Mechanism with Irregular Spherical Joint Clearance. Shock Vib. 2019, 2019, 6242971. [Google Scholar] [CrossRef]
  7. Asadi, F.; Heydari, A. Analytical Dynamic Modeling of Delta Robot with Experimental Verification. Proc. Inst. Mech. Eng. Part K J. Multi-Body Dyn. 2020, 234, 623–630. [Google Scholar] [CrossRef]
  8. Zhang, C.; Jiang, H. Rigid-Flexible Modal Analysis of the Hydraulic 6-DOF Parallel Mechanism. Energies 2021, 14, 1604. [Google Scholar] [CrossRef]
  9. Niu, A.; Wang, S.; Sun, Y.; Qiu, J.; Qiu, W.; Chen, H. Dynamic Modeling and Analysis of a Novel Offshore Gangway with 3UPU/UP-RRP Series-Parallel Hybrid Structure. Ocean Eng. 2022, 266, 113122. [Google Scholar] [CrossRef]
  10. Mazare, M.; Taghizadeh, M.; Najafi, M.R. Inverse Dynamic of a 3-P[2(US)] Translational Parallel Robot. Robotica 2019, 37, 708–728. [Google Scholar] [CrossRef]
  11. Yun, Y.; Li, Y. A General Dynamics and Control Model of a Class of Multi-DOF Manipulators for Active Vibration Control. Mech. Mach. Theory 2011, 46, 1549–1574. [Google Scholar] [CrossRef]
  12. Wen, S.; Qin, G.; Zhang, B.; Lam, H.K.; Zhao, Y.; Wang, H. The Study of Model Predictive Control Algorithm Based on the Force/Position Control Scheme of the 5-DOF Redundant Actuation Parallel Robot. Robot. Auton. Syst. 2016, 79, 12–25. [Google Scholar] [CrossRef]
  13. Mirtaheri, S.M.; Zohoor, H. Efficient Formulation of the Gibbs–Appell Equations for Constrained Multibody Systems. Multibody Syst. Dyn. 2021, 53, 303–325. [Google Scholar] [CrossRef]
  14. Mirtaheri, S.M.; Zohoor, H. The Explicit Gibbs-Appell Equations of Motion for Rigid-Body Constrained Mechanical System. In Proceedings of the 2018 6th RSI International Conference on Robotics and Mechatronics (IcRoM), Tehran, Iran, 23–25 October 2018; pp. 304–309. [Google Scholar]
  15. Pappalardo, C.M. Dynamic Analysis of Planar Rigid Multibody Systems Modeled Using Natural Absolute Coordinates. Appl. Comput. Mech. 2018, 12, 73–110. [Google Scholar] [CrossRef]
  16. Gallardo, J.; Rico, J.M.; Frisoli, A.; Checcacci, D.; Bergamasco, M. Dynamics of Parallel Manipulators by Means of Screw Theory. Mech. Mach. Theory 2003, 38, 1113–1131. [Google Scholar] [CrossRef]
  17. Gallardo-Alvarado, J.; Rodríguez-Castro, R.; Delossantos-Lara, P.J. Kinematics and Dynamics of a 4-P RUR Schönflies Parallel Manipulator by Means of Screw Theory and the Principle of Virtual Work. Mech. Mach. Theory 2018, 122, 347–360. [Google Scholar] [CrossRef]
  18. Liu, Z.; Tao, R.; Fan, J.; Wang, Z.; Jing, F.; Tan, M. Kinematics, Dynamics, and Load Distribution Analysis of a 4-PPPS Redundantly Actuated Parallel Manipulator. Mech. Mach. Theory 2022, 167, 104494. [Google Scholar] [CrossRef]
  19. Pennock, G.R.; Oncu, B.A. Application of Screw Theory to Rigid Body Dynamics. J. Dyn. Syst. Meas. Control 1992, 114, 262–269. [Google Scholar] [CrossRef]
  20. Gallardo-Alvarado, J.; Aguilar-Nájera, C.R.; Casique-Rosas, L.; Pérez-González, L.; Rico-Martínez, J.M. Solving the Kinematics and Dynamics of a Modular Spatial Hyper-Redundant Manipulator by Means of Screw Theory. Multibody Syst. Dyn. 2008, 20, 307–325. [Google Scholar] [CrossRef]
  21. Müller, A. Screw and Lie Group Theory in Multibody Kinematics: Motion Representation and Recursive Kinematics of Tree-Topology Systems. Multibody Syst. Dyn. 2018, 43, 37–70. [Google Scholar] [CrossRef]
  22. Müller, A. Screw Theory—A Forgotten Tool in Multibody Dynamics. Proc. Appl. Math. Mech. 2017, 17, 809–810. [Google Scholar] [CrossRef]
Figure 1. Geometry of the 3 UPS - UPU - S parallel mechanism: (a) structure in front view; (b) structure in top view.
Figure 1. Geometry of the 3 UPS - UPU - S parallel mechanism: (a) structure in front view; (b) structure in top view.
Machines 11 00840 g001
Figure 2. Swing angles and schematic diagram of motion.
Figure 2. Swing angles and schematic diagram of motion.
Machines 11 00840 g002
Figure 3. Kinematics of kinematic subchains in the 3 UPS - UPU - S parallel mechanism.
Figure 3. Kinematics of kinematic subchains in the 3 UPS - UPU - S parallel mechanism.
Machines 11 00840 g003
Figure 4. Topological diagram and screws showing the constraints of the 3 UPS - UPU - S parallel mechanism.
Figure 4. Topological diagram and screws showing the constraints of the 3 UPS - UPU - S parallel mechanism.
Machines 11 00840 g004
Figure 5. Theory of the momentum screw of a rigid body.
Figure 5. Theory of the momentum screw of a rigid body.
Machines 11 00840 g005
Figure 6. Dynamic analysis of the 3 UPS - UPU - S parallel mechanism. (a) Dynamics of the lower limbs of four subchains; (b) dynamics of the {S} chain; (c) dynamics of upper limbs of four subchains connecting with universal joint or spherical joints; (d) dynamics of the moving platform.
Figure 6. Dynamic analysis of the 3 UPS - UPU - S parallel mechanism. (a) Dynamics of the lower limbs of four subchains; (b) dynamics of the {S} chain; (c) dynamics of upper limbs of four subchains connecting with universal joint or spherical joints; (d) dynamics of the moving platform.
Machines 11 00840 g006
Figure 7. Displacement of each kinematic joint. (a) Relative angular displacements of each revolute joint; (b) relative linear displacement of each prismatic joints within each kinematic chain.
Figure 7. Displacement of each kinematic joint. (a) Relative angular displacements of each revolute joint; (b) relative linear displacement of each prismatic joints within each kinematic chain.
Machines 11 00840 g007
Figure 8. Relative velocity of each joint. (a) Relative angular velocity of each revolute joint; (b) relative linear velocities of four prismatic joints within each kinematic chain.
Figure 8. Relative velocity of each joint. (a) Relative angular velocity of each revolute joint; (b) relative linear velocities of four prismatic joints within each kinematic chain.
Machines 11 00840 g008
Figure 9. The required driving forces of the prismatic joints in four kinematic subchains in the 3 U P _ S - U P _ U - S parallel mechanism.
Figure 9. The required driving forces of the prismatic joints in four kinematic subchains in the 3 U P _ S - U P _ U - S parallel mechanism.
Machines 11 00840 g009
Figure 10. The driving forces of the prismatic joints computed by Adams. (a) Driving forces of the prismatic joints computed by MATLAB; (b) driving forces of the prismatic joints simulated by Adams.
Figure 10. The driving forces of the prismatic joints computed by Adams. (a) Driving forces of the prismatic joints computed by MATLAB; (b) driving forces of the prismatic joints simulated by Adams.
Machines 11 00840 g010
Figure 11. Supporting forces on each joint. (a) Forces on universal joints at position A1, A2, A3, A4 and spher-ical joint at position A5; (b) forces on universal joint at position C1 and spherical joints C2, C3, C4.
Figure 11. Supporting forces on each joint. (a) Forces on universal joints at position A1, A2, A3, A4 and spher-ical joint at position A5; (b) forces on universal joint at position C1 and spherical joints C2, C3, C4.
Machines 11 00840 g011
Table 1. Configuration parameters of the 3 U P _ S - U P _ U - S .
Table 1. Configuration parameters of the 3 U P _ S - U P _ U - S .
H ( 0 )   ( m ) R   ( m ) r   ( m ) L ( 0 )   ( m )
3 3 10 0.8 0.5 0.6
Table 2. Initial conditions of the 3 U P _ S - U P _ U - S .
Table 2. Initial conditions of the 3 U P _ S - U P _ U - S .
θ 1 i ( 0 )   ( rad ) θ 2 i ( 0 )   ( rad ) p 3 i ( 0 )   ( m ) θ 4 i ( 0 )   ( rad ) θ 5 i ( 0 )   ( rad ) θ 6 i ( 0 )   ( rad )
{ θ 1 1 } = { 0 } { θ 2 1 } = { π 6 } { p 3 1 } = { 0.3 } { θ 4 1 } = { 0 } { θ 5 1 } = { π 3 } { θ 6 1 } = { 0 }
Table 3. The structure parameters at the mass center of each limb and moving platform.
Table 3. The structure parameters at the mass center of each limb and moving platform.
Mass   ( kg )
Lower   limb   m L Upper   limb   m E U ,   m E S Moving   platform   m G
1.421.422.87
Moment   of   inertia   matrix   ( kg m 2 )
Lower   limb   J L Upper   limb   J E U ,   J E S Lower   limb   J G
diag ( 0.0556 1.14 1.16 ) diag ( 0.0556 1.14 1.16 ) diag ( 68.7 68.7 92.1 )
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Zhao, J.-S.; Sun, X.-C.; Wei, S.-T. Kinematics and Dynamics Analysis of a 3UPS-UPU-S Parallel Mechanism. Machines 2023, 11, 840. https://doi.org/10.3390/machines11080840

AMA Style

Zhao J-S, Sun X-C, Wei S-T. Kinematics and Dynamics Analysis of a 3UPS-UPU-S Parallel Mechanism. Machines. 2023; 11(8):840. https://doi.org/10.3390/machines11080840

Chicago/Turabian Style

Zhao, Jing-Shan, Xiao-Cheng Sun, and Song-Tao Wei. 2023. "Kinematics and Dynamics Analysis of a 3UPS-UPU-S Parallel Mechanism" Machines 11, no. 8: 840. https://doi.org/10.3390/machines11080840

APA Style

Zhao, J. -S., Sun, X. -C., & Wei, S. -T. (2023). Kinematics and Dynamics Analysis of a 3UPS-UPU-S Parallel Mechanism. Machines, 11(8), 840. https://doi.org/10.3390/machines11080840

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