4.1. Analysis of Inverse Position Solution
The mapping between the actuated joint variables and the moving platform pose is established using the prismatic joints in the three limbs, and the revolute joint on the first limb is used as the actuated joint.
As shown in
Figure 7, the initial coordinates of the center point
of the U joint connected to the fixed platform in the
coordinate system, and the initial coordinates of the center point
of the U joint connected to the moving platform in the
coordinate system, where
:
The rotation angle of the moving platform about the
Z-axis is
, and the corresponding rotation matrix is
:
The displacements of the moving platform along the
X,
Y, and
Z axes are
x,
y, and
z, respectively. The translation matrix is
T:
In the process of movement of the mechanism, the coordinates of the point
:
The closed-loop vector method is used to solve the length of the driving rod:
The length
of the driving rod of the mechanism can be obtained by the simultaneous formula (Equations (11)–(15)).
When the revolute joint is used as the actuated joint, it is difficult to directly establish the analytical relationship between its rotation angle and the motion of the moving platform using the closed-loop vector method. Therefore, based on the geometric relationship between the kinematic pairs in a limb, this paper deduces the corresponding relationship between the rotation angle of the revolute joint and the pose variables of the moving platform.
As shown in
Figure 10, the moving platform coordinate system
first rotates at a certain angle along the
Z-axis, and then moves a distance along the
X-axis and the
Y-axis to reach
. The revolute joint axis
is aligned with the
axis. The axis
is directed along the line connecting points
and
. Axis
is perpendicular to both
and
. Axis
is parallel to
. Axis
is perpendicular to both
and
.
As shown in
Figure 10,
and
are projected in parallel to the
plane. Since
and
are parallel to the
plane,
are projected. Because of
, after projection
; because of
, so
; and
, it follows that
.
The included angle between axis
before and after rotation represents the rotation angle
of the moving platform. Similarly, the included angle between axis
before and after rotation denotes the rotation angle
of the revolute pair
. Finally, the rotation angle
of the moving platform is equal to the rotation angle
of the revolute joint
.
As shown in
Figure 10, when the rotation angle
of the revolute joint
is equal to a fixed value, the PUPU limb becomes the UPU limb. At this time, the UPU limb will provide a couple constraint
, which is perpendicular to
and not lying in the
plane, and constraints
and
form a constraint system of order three, so that the degree of freedom of the moving platform is degraded to three degrees of freedom of translation, and the mechanism switches to 3T mode.
It can be demonstrated that the 2UPU/RUPU mechanism constitutes a reconfigurable parallel mechanism, capable of switching between the 3T mode and the 3T1R mode via the revolute joint .
4.2. Workspace Analysis
The motion ranges of all joints and the moving platform are defined as follows.
When the parameters of the mechanism are specified, the constraint equations of each actuated joint can be expressed as a function of the output parameters of the moving platform. The output parameters of the moving platform that meet the range of each actuated joint are obtained by the limit search method, and the output parameters are recorded to determine the mechanism workspace.
As shown in
Figure 11a–c, the three-dimensional workspace, constructed form the displacement of the moving platform center
, shows that the center point increases with
displacement, and the reachable region of
increases.
As shown in
Figure 11d–f, the four-dimensional workspace is composed of the displacement and rotation angle
of the center point
of the moving platform. Because the second and third limbs of the parallel mechanism are symmetrical along first limb, the rotation angle of the moving platform along the
Z-axis is symmetrical.
The absolute value of the maximum rotation angle of the mechanism at this working point is taken and converted into an angular value, which serves as the third coordinate axis. The -displacement is taken as the fourth axis to obtain the workspace surfaces corresponding to different z-displacements. The rotation angle of the middle part of the working space plane of each -displacement plane can be all up to , and the rotation angle of the same plane decreases gradually from the inside to the outside.
4.3. Full Jacobi Matrix Analysis
(1) Establishment of the constrained Jacobian matrix
The instantaneous motion screw
of the moving platform in the
coordinate system can be expressed as:
The reciprocal product of the force couple spiral
and the instantaneous screw
is made.
is a 2 × 6 matrix, which is the constraint Jacobian matrix of the mechanism. Each row represents a constraint couple imposed by a limb on the moving platform. The rank of should be 2. When the rank of is less than 2, the constraint spiral system of the moving platform is linearly related, the constraints on the moving platform are reduced accordingly, the degree of freedom of the moving platform increases, and the mechanism enters the constraint singular state.
(2) Establishment of the actuation Jacobian matrix
As shown in
Figure 12, the moving pair axis
of the first, second and third branches intersects with the revolute joint axes
,
,
and
, respectively. When the actuated joint
is locked, the limb will introduce an additional force constraint
, which passes through point
towards another point,
.
Taking the reciprocal product of the force constraint
and the instantaneous screw
.
When the actuator pair of a limb is fixed, the limb will add a constraint couple .
The reciprocal product of the constraint couple
and the instantaneous screw
is made.
Let the kinematic screw
be defined as:
Driving Reciprocal Screw:
The value of in these Equations (26)–(28) depends on the position of , and the value of depends on the direction of .
The rotational angular velocity of the moving platform is equal to the angular velocity of the revolute joint , the corresponding angular displacement obtained by integration is also identical, and the angular acceleration corresponding to the derivation is also the same. It can be obtained that the rotation law of the moving platform is consistent with that of the actuated joint .
According to Equations (19), (29) and (30), it is observed that the elements in the fourth and fifth columns of the fourth row of matrix have no influence on the solution result . Therefore, the fourth row of the matrix is replaced by . When , the calculated result is the driving speed in 3T mode.
is a 4 × 6 matrix, which is the actuation Jacobian matrix of the mechanism. Each row of represents a driving force or a couple imposed by a branched chain on the moving platform. represents the velocity mapping relationship between the output of the moving platform and the input of the actuated joint. The rank of should be 4. When the rank of is less than 4, the mechanism will have a driving singularity.
(3) Establishment of the full Jacobian matrix:
The constraint Jacobian matrix and the actuation Jacobian matrix are combined, and the full Jacobian matrix of the mechanism is
is a 6 × 6 matrix, which is the full Jacobian matrix of the mechanism. If the rank of is equal to 2, the rank of is equal to 4, but the rank of is less than 6, the mechanism is also a singular state.
Taking the determinant
of matrix
,
is an expression in terms of
:
By setting , the singular points of the mechanism are determined. Based on the value range of , we obtain , which is then transformed into via .
As shown in
Figure 13, regardless of the value of
, for any arbitrary value of rotation angle
,
and
form a singular line, and all such singular lines collectively constitute a singular surface.
4.4. Dexterity Analysis
Dexterity characterizes the degree to which the output of the moving platform responds to the input supplied by the actuation rod.
(1) Dexterity calculation based on the velocity Jacobian matrix
The length
and the angle
of the actuator joint are the functions of the displacement angle
of the moving platform. Taking the total differential of
and
yields the relationship between the linear and angular velocities of the actuation pairs and the moving platform
The velocity Jacobian matrix
is obtained.
The above equation is abbreviated as:
is called the velocity Jacobian matrix, which reflects the velocity mapping relationship between the moving platform and the actuated joint.
Conversely, the speed of the moving platform can also be expressed as:
During the movement of the mechanism, if the output parameters of the moving platform produce deviation
, the input parameters of the actuated joints will also have corresponding deviation
.
Two norms are taken at both ends of Formula (38). According to the compatibility property of matrix norm (i.e.,
), we obtain:
Starting from
, both sides are divided by
:
And because
, so
, that is
. By substituting into the above formula, the relative deviation relationship between
and
can be obtained:
In addition to the singular points, the velocity Jacobian matrix of the mechanism is invertible, and the condition number is:
and
are the largest and smallest eigenvalues of
. Because
, the reciprocal of the condition number is used to describe the dexterity
:
Among these , the larger the values of , the better the motion performance of the mechanism. Conversely, the smaller the value of , the poorer the motion performance. If , a singularity exists at the corresponding configuration of the mechanism. If , the mechanism achieves its optimal motion performance at that position.
When the rotation angle is a fixed value, the length
of the three prismatic pairs will become a function of the translating
of the moving platform, and the velocity Jacobian matrix
will degenerate into a third-order square matrix.
The velocity Jacobian matrix
is substituted into (43), as shown in
Figure 14a,d,g, and the dexterity
performance spectra
are calculated respectively. The dexterity is taken as the third axis, and the z-displacement is taken as the fourth axis to obtain the dexterity spectra of different
-displacements. The dexterity surfaces under different
-displacements gradually become larger with
from outside to inside, and the middle part is the largest.
(2) Dexterity calculation based on the actuation Jacobian matrix.
When the rotation angle of the moving platform is fixed, the rotation speed
,
is directly determined by the first three rows and the first three columns of the actuation Jacobian matrix
, and
is simplified into a square matrix of three rows and three columns:
The simplified actuation Jacobian matrix is substituted into Formula (43) to obtain the dexterity of the corresponding angle.
It can be seen from
Figure 14b,e,h that the distribution of dexterity calculated by the two methods in the workspace is the same.
(3) Comparison of dexterity calculated by the two methods
The ratio is used to judge the difference in sensitivity between the two methods. The closer is to 1, the closer and are.
As shown in
Figure 14c,f,i, all points in the workspace correspond to
, indicating that the two methods calculate the same dexterity.
4.5. Simulation Verification
This section verifies through simulation experiments that the rotation law of the moving platform of the reconfigurable parallel mechanism is equal to the rotation law of the revolute joint , and the motion of the moving platform is continuous.
In order to verify that the parallel mechanism is reconfigurable, the motion law of the moving platform of the mechanism is given, and the moving platform in the X, Y and Z directions runs according to the
function law [
23]. The rotational degree of freedom along the
Z-axis is reconfigurable, and the mechanism will be in 3T mode when the revolute joint
is fixed at any position. When
is released, the mechanism is in 3T1R mode, and the switching between 3T and 3T1R modes is not affected by the position. To demonstrate this, the motion profile along this direction is defined as a piecewise function: the first function
runs for 2 s, the second function runs for 2 s with
, and the third function
runs for 2 s.
The motion law of the moving platform in all directions is as follows:
Based on the inverse kinematics, the above motion function is applied to the moving platform, and the corresponding motion function of the measuring mechanism is verified by simulation.
As shown in
Figure 15, a diagram of the three-dimensional simulation process of the reconfigurable parallel mechanism is presented. It can be observed that the motion of the mechanism follows a symmetrical pattern: the postures at 0 s and 6 s, 1 s and 5 s, and 2 s and 4 s correspond to each other, respectively. The mechanism is in its initial state at 0 s. The period from 0 to 3 s represents the forward stroke, while the period from 3 to 6 s represents the return stroke.
As shown in
Figure 16a,b, after simulation, the displacement of the center point of the moving platform along each direction and the rotational displacement are measured. It can be seen from the figure that the moving platform translates 300 mm along the
X-direction and returns to the origin, 200 mm along the
Y-direction and returns to the origin, and 150 mm along the
Z-axis direction and returns to the origin. It rotates
along the Z-direction from 0 to 2 s, maintains at
from 2 to 4 s, and returns from
to
from 4 to 6 s. As shown in
Figure 16c,d, the corresponding linear velocity and angular velocity start and end points are equal to zero, and continuous and smooth, which conforms to the law of motion function of (46) and (47) formula.
As shown in
Figure 17, after simulation, by measuring the rotation law of the moving platform along the Z-axis and the rotation law of the revolute joint
, it is found that the rotation angle, velocity, and acceleration of the moving platform and the revolute joint
are equal. It is proved that the mechanism can realize the switching of two modes through the revolute joint
.
As shown in
Figure 18, the linear displacement and linear velocity of the moving actuated joint of the mechanism are measured. The curves are smooth and continuous, indicating that the driving function corresponding to the motion trajectory is good and can be used as the driving function of the actuated joint.
Through the above simulation experiments, it is verified that the parallel mechanism is a reconfigurable mechanism and that it maintains motion continuity.