The present disclosure generally relates to manipulators and, more particularly, to translational parallel manipulators.
In currently developed 3-DOF (Degree of Freedom) translational manipulators, high output stiffness and accuracy are limited by their respective topological structures. The general topological structural forms for such manipulators include serial and parallel forms. The serial forms of 3-DOF translational manipulators are opened-loop structures. Errors of the output motions are accumulated by the serial connections, and the stiffness, load/weight ratio, and speed of the serial manipulators are limited. In order to achieve higher stiffness, accuracy, load/weight ratio and operation speeds of translational manipulators, closed-loop parallel forms of 3-DOF translational manipulators can be used to simultaneously constrain the output motions generated by three serial kinematic chains. However, the developed 3-DOF translational parallel manipulators have respective structural disadvantages, such as moving actuators, independent actuation forces, anisotropic constraints, singularity configurations and complex joint combinations.
In the development of parallel manipulators, manipulators with a limited number of parallel DOF have been designed for many different industrial applications because 6-DOF motions are not always required. Compared to serial manipulators, the rotational ability of the developed parallel manipulators is limited by multi-loop constraints. Thus, the designs of limited-DOF parallel manipulators are focused on translational output motions, while the required rotational output motions are realized by mounting serial revolute joints on the output movable platform of the parallel manipulator.
Some of the drawbacks of current manipulators include, but are not limited to: Having too many 1-DOF joints included in the structure of the parallel manipulators; low stiffness and accuracy are induced by cumulative effects of the joints; some designs have orthogonal constraints; having three revolute joints in each subchain may be responsible for low stiffness and accuracy of the output movable platform; the prismatic joints, placed on the movable platform of certain designs, require a large-sized movable platform to increase a range of the workspace; a low load/weight ratio is inevitable with large-sized movable platforms; planar joints are not easy to fabricate and depend on the design of planar aerostatic bearing systems; constraint forces of the planar joints are not uniform when heavy loads are applied to the movable platform; etc.
Three typical 3-DOF TPMs include the Delta Robot, the Tsai mechanism and the Cartesian parallel manipulator. These designs have been used in many practical applications including manufacturing, medical and food industries to mention a few. However, these developed 3-DOF TPMs still suffer from a variety of drawbacks. The structural disadvantage of the Delta Robot is its complex structure with a total of twenty-one 1-DOF joints. The Tsai mechanism includes six universal joints, and the three actuators are not placed on the fixed platform. Cartesian parallel manipulators have orthogonally arranged constraints and, furthermore, the actuation force of each subchain independently resists the external force. All of the above-mentioned characteristics lead to low stiffness and accuracy of these parallel manipulators.
In light of the above, a need exists to develop a translational parallel manipulator that overcomes the above-identified and other disadvantages.
The present disclosure is directed to a translational parallel manipulator that can manipulate an object by generating a plurality of orthogonal translational output motions in space. In some aspects, the manipulator is a 3 DOF translational parallel manipulator that generates three orthogonal translational output motions. The manipulator overcomes drawbacks of current technology to achieve a higher load/weight ratio, stiffness and accuracy, among other benefits.
In one aspect, the manipulator includes three serial kinematic subchains coupled between a fixed platform and a movable platform. Structures of the three serial kinematic subchains may be identical. In other aspects, structures of the three serial kinematic subchains may be different.
In one aspect, each serial kinematic subchain comprises a first prismatic joint, a first revolute joint, a second prismatic joint and a second revolute joint. The four 1-DOF joints are connected serially. In a serial kinematic subchain, the moving direction of the first prismatic joint is parallel to the rotational axis of the first revolute joint, and the rotational axis of the second revolute joint is parallel to the rotational axis of the first revolute joint.
In one aspect, an intersection angle between a moving direction of the second prismatic joint and the rotational axis of the first revolute joint is 45±15 degrees for a relative larger workspace and a better kinematic performance.
In one aspect, the first prismatic joint may be a drive joint and may be driven.
In one aspect, the first prismatic joint may be actuated by a lead screw. In another aspect, the first prismatic joint may be actuated by a linear motor in each subchain.
In one embodiment, moving directions of three first joints of the subchains may be placed in a plane and symmetrically arranged in a star form on the fixed platform such that axes of movement of the three first joints intersect each other.
In one aspect, on a movable platform, rotational axes of three connected second revolute joints are positioned in a plane and intersect at a central point of the movable platform. The movable platform may be an end-effector of the manipulator. Output motions of the end-effector may be three orthogonal translational motions in space.
In one aspect, a translational parallel manipulator is provided and includes a fixed platform including three guide members. The three guide members include first ends and second ends, and the first ends of the three guide members are all coupled to each other and the second ends of the three guide members are all spaced-apart from each other. The manipulator also includes a movable platform spaced-apart from the fixed platform and three serial subchains coupled between the three guide members and the movable platform.
In one aspect, the three guide members are co-planar with each other.
In one aspect, the three guide members are non-planar with each other.
In one aspect, the first ends of the three guide members are disposed above the second ends of the three guide members.
In one aspect, the first ends of the three guide members are disposed below the second ends of the three guide members.
In one aspect, the three serial subchains are identical in structure.
In one aspect, the three serial subchains are different in structure.
In one aspect, at least one of the three serial subchains includes no more than four one degree-of-freedom joints.
In one aspect, the four one degree-of-freedom joints are comprised of: a first prismatic joint; a first revolute joint; a second prismatic joint; and a second revolute joint.
In one aspect, the first prismatic joint is coupled directly to a respective one of the guide members and the second revolute joint is coupled directly to the movable platform.
In one aspect, the first prismatic joint is a driven prismatic joint.
In one aspect, the first revolute joint, the second prismatic joint, and the second revolute joint are passive joints.
In one aspect, the first prismatic joint is driven by at least one of a lead screw and a linear motor.
In one aspect, the three serial subchains each include no more than four one degree-of-freedom joints.
In one aspect, each of the three serial subchains include: a first prismatic joint; a first revolute joint; a second prismatic joint; and a second revolute joint. The second revolute joints of the three serial subchains are coupled directly to the movable platform and rotational axes of the second revolute joints intersect each other at a point on the movable platform.
In one aspect, the point is a center point of the movable platform.
In one aspect, the rotational axes of the second revolute joints are co-planar.
In one aspect, the first prismatic joint is movable in a first direction and is parallel to a rotational axis of the first revolute joint.
In one aspect, a rotational axis of the first revolute joint is parallel to a rotational axis of the second revolute joint.
In one aspect, an intersection angle between a rotational axis of the first revolute joint and a moving direction of the second prismatic joint is between zero degrees and about 90 degrees.
In one aspect, the intersection angle is between about 30 degrees and about 60 degrees.
In one aspect, the movable platform includes at least one of a tool holder and a tool.
In one aspect, the translational parallel manipulator is constrained to a limited quantity of degrees-of-freedom.
In one aspect, the translational parallel manipulator is constrained to only three degrees-of-freedom.
In one aspect, a translational parallel manipulator is provided and includes three fixed guide members extending along three respective longitudinal axes. The three longitudinal axes intersect each other at a common point. The manipulator also includes a movable platform spaced-apart from the three fixed guide members and three serial subchains. Each of the three serial subchains is coupled between the movable platform and a respective one of the three fixed guide members.
In one aspect, the three respective longitudinal axes are co-planar with each other.
In one aspect, the three respective longitudinal axes are non-planar with each other.
In one aspect, the three respective longitudinal axes incline upward toward the common point.
In one aspect, the three respective longitudinal axes decline downward toward the common point.
In one aspect, the three serial subchains are identical in structure.
In one aspect, the three serial subchains are different in structure.
In one aspect, at least one of the three serial subchains includes no more than four one degree-of-freedom joints.
In one aspect, the four one degree-of-freedom joints are comprised of: a first prismatic joint; a first revolute joint; a second prismatic joint; and a second revolute joint.
In one aspect, the first prismatic joint is coupled directly to a respective one of the three fixed guide members and the second revolute joint is coupled directly to the movable platform.
In one aspect, the first prismatic joint is a driven prismatic joint.
In one aspect, the first revolute joint, the second prismatic joint, and the second revolute joint are passive joints.
In one aspect, the first prismatic joint is driven by at least one of a lead screw and a linear motor.
In one aspect, the three serial subchains each include no more than four one degree-of-freedom joints.
In one aspect, each of the three serial subchains include: a first prismatic joint; a first revolute joint; a second prismatic joint; and a second revolute joint. The second revolute joints of the three serial subchains are coupled directly to the movable platform and rotational axes of the second revolute joints intersect each other at a point on the movable platform.
In one aspect, the point is a center point of the movable platform.
In one aspect, the rotational axes of the second revolute joints are co-planar.
In one aspect, the first prismatic joint is movable in a first direction and is parallel to a rotational axis of the first revolute joint.
In one aspect, a rotational axis of the first revolute joint is parallel to a rotational axis of the second revolute joint.
In one aspect, an intersection angle between a rotational axis of the first revolute joint and a moving direction of the second prismatic joint is between zero degrees and about 90 degrees.
In one aspect, the intersection angle is between about 30 degrees and about 60 degrees.
In one aspect, the movable platform includes at least one of a tool holder and a tool.
In one aspect, the translational parallel manipulator is constrained to a limited quantity of degrees-of-freedom.
In one aspect, the translational parallel manipulator is constrained to only three degrees-of-freedom.
In one aspect, a translational parallel manipulator is provided and includes a fixed platform, a movable platform spaced-apart from the fixed platform, and a plurality of subchains coupled between the fixed platform and the movable platform. At least one of the plurality of subchains includes no more than four one degree-of-freedom joints.
In one aspect, the fixed platform includes three guide members that are co-planar with each other.
In one aspect, the fixed platform includes three guide members that are non-planar with each other.
In one aspect, the plurality of subchains are identical in structure.
In one aspect, the plurality of subchains are different in structure.
In one aspect, the four one degree-of-freedom joints are serially connected.
In one aspect, the four one degree-of-freedom joints are comprised of a first prismatic joint, a first revolute joint, a second prismatic joint, and a second revolute joint.
In one aspect, the first prismatic joint is coupled directly to the fixed platform and the second revolute joint is coupled directly to the movable platform.
In one aspect, the first prismatic joint is a driven prismatic joint.
In one aspect, the first revolute joint, the second prismatic joint, and the second revolute joint are passive joints.
In one aspect, the first prismatic joint is driven by at least one of a lead screw and a linear motor.
In one aspect, each of the plurality of subchains includes no more than four one degree-of-freedom joints.
In one aspect, each of the plurality of subchains includes a first prismatic joint, a first revolute joint, a second prismatic joint, and a second revolute joint. The second revolute joints of the plurality of subchains are coupled directly to the movable platform and rotational axes of the second revolute joints intersect each other at a point on the movable platform.
In one aspect, the point is a center point of the movable platform.
In one aspect, the rotational axes of the second revolute joints are co-planar.
In one aspect, the first prismatic joint is movable in a first direction and is parallel to a rotational axis of the first revolute joint.
In one aspect, a rotational axis of the first revolute joint is parallel to a rotational axis of the second revolute joint.
In one aspect, an intersection angle between a rotational axis of the first revolute joint and a moving direction of the second prismatic joint is between zero degrees and about 90 degrees.
In one aspect, the intersection angle is between about 30 degrees and about 60 degrees.
In one aspect, the movable platform includes at least one of a tool holder and a tool.
In one aspect, the translational parallel manipulator is constrained to a limited quantity of degrees-of-freedom.
In one aspect, the translational parallel manipulator is constrained to only three degrees-of-freedom.
The present disclosure can be better understood with reference to the following drawings and description. The components in the figures are not necessarily to scale, emphasis instead being placed upon illustrating the principles of the disclosure.
Other features and advantages of the present disclosure will become apparent from the following detailed description. It should be understood, however, that the detailed description and the specific examples, while indicating preferred examples, are given by way of illustration only, because various changes and modifications within the spirit and scope of the present disclosure will become apparent to those skilled in the art.
As indicated above, existing translational parallel manipulators have numerous drawbacks. The present disclosure includes translational parallel manipulators that may alleviate one or more, and other, drawbacks of existing translational parallel manipulators. For example, manipulators of the present disclosure may address one or more of the following conditions: The manipulator may be designed as a symmetric form (subchains have the same/identical structure) and arrangement of the subchains may be of a non-Cartesian form to eliminate orthogonality of the constraints; driven joints or actuators should be placed on or part of a fixed platform of the manipulator and, in some examples, actuation may be linear to assure high resolution inputs; the manipulator may be designed with a minimal number of 1-DOF joints (e.g., no U or S joints should be included); prismatic joints of the manipulator may not be directly connected to the movable platform and the movable platform should be as small as possible in size; decoupled motions, over-constraint elimination, singularity free workspace, and isotropic configuration may be included in the topological constraint design.
In order to realize the above design objectives and overcome drawbacks of conventional manipulators, topological structures of 3-DOF translational parallel manipulators (TPMs) are provided. In some examples of topological constraint designs of serial joints, an inclined planar displacement subset will be defined based on displacement group theory. A triangular pyramidal constraint is also provided and applied in designs of constraints between different subchains of the manipulator.
The translational parallel manipulators included herein are capable of being used in a wide variety of applications and functions including, but not limited to, forming, cutting, grinding, metrology, laser EDM, any other machining or manufacturing process or application, pick-and-place operation, haptic controller, motion simulator, or any other application or function utilizing a manipulator. The manipulator may include at least one tool holder and/or tool for performing any desired operation. The tool holder and/or tool may be located on or part of the movable platform. The movable platform may also include a plurality of tool holders and/or tools.
As far as 3-DOF TPMs are concerned, in some examples, three actuations may be required for 3-DOF output motions and, hence, three actuators should be arranged in different subchains to build a closed-loop form of the parallel manipulator. Thus, in this example, the manipulator includes three subchains connecting a movable platform to a fixed platform for a basic topological arrangement of the 3-DOF TPM. To generate three translational output motions, rotations of the movable platform may be simultaneously constrained by the three connected subchains, namely intersection motions of the three subchains may have no rotational output motions. This 3-DOF TPM may include three orthogonal prismatic joints serially connected in each subchain, thereby resulting in a total of nine prismatic joints involved to eliminate all rotations, and commonly constrain the movable platform to generate three orthogonal translational output motions. However, due to orthogonal constraints and redundant weight of guide members of the prismatic joints, low load/weight ratio, stiffness and accuracy may be induced.
By considering the displacement group theory, in one example, the general method for the design of the topological structure of the subchains of a 3-DOF TPM is to include a planar displacement subgroup and a translational displacement subgroup into a subchain. The planar displacement subgroup contains two non-parallel translational motions in a plane and a rotational motion that is parallel to a normal of the plane. The planar displacement subgroup can be realized by a planar joint, Pl, that is equivalent to a serial connection of 1-DOF joints in three different ways:
The general translational displacement subgroup can be generated by:
Thus, there are three types of structural combinations for the subchain design for a 3-DOF TPM, namely:
A serial combination of planar and translational displacement subgroups can build a subchain of the 3-DOF TPM, while the closed-loop connection of three subchains with non-parallel revolute joints between the different subchains yields a 3-DOF TPM.
By considering the output motions of the three types of subchains, subchains Pl-P and Pl-Pa generate a Schoenflies displacement subgroup (three orthogonal translations and a rotation), respectively. The subchain Pl-RR generates two non-parallel planar displacement subgroups (three orthogonal translations and two non-parallel rotations). In some examples of a 3-DOF TPM, three rotations of the movable platform should be constrained and eliminated from the closed-loop connections of three subchains Pl-P or Pl-Pa. Similarly, in other examples, there are six rotations that should be eliminated from the closed-loop connection of three subchains Pl-RR. Thus, in accordance with design constraint that requires a minimal number of 1-DOF joints, subchains with only a Schoenflies motion will be used in the proposed design. In the following description, a plurality of 3-DOF TPMs are introduced to illustrate aspects of the present disclosure.
In
where Zm represents the output motions of the movable platform. {T(ni)}, {T(Ki)} and {T} respectively represent a translation along vector ni, two translations in plane Ki and three orthogonal translations. {R(ni)} represents a rotation around the vector ni. Three non-parallel rotations of the three subchains are eliminated by the star constraint. The output motions of the 3Pl-P are three translations. The actuated joint is determined in the planar displacement subgroup of each subchain, because there is a common translational motion (along an intersection line of the constraint planes K1, K2 and K3) in the three planar displacement subgroups. The 3Pl-P TPM has moving actuators.
In a similar way, the planar joint can be configured with three parallel revolute joints. Thus, a 3Pl-P TPM with configuration RRR of the planar joint can be constituted as shown in
To avoid the generation of intersection motions between the three planar displacement subgroups that are arranged in the star constraint configuration above, or conversely to design a structural configuration that places the actuators on the fixed platform, the serial connection of a parallelogram joint and of two parallel revolute joints can be used to replace the planar joint of the subchain Pl-P to generate a Schoenflies motion (
It can be seen that the output motions of the 3P-RPaR are three translations, while the three non-parallel rotations are eliminated by the star constraint. The actuated joint may be selected as the prismatic joint P0 of each subchain since there are no intersection motions between the three spherical translations and the three non-parallel rotations. A manipulator has fixed actuators and the guide members of the three linear actuators are arranged in a triangular form to build the triangular 3P-RPaR TPM. Additionally, the guide members may be arranged in a star form to build a star 3P-RPaR TPM as shown in
Although the star 3P-RPaR TPM illustrated in
In
Three non-parallel rotations are eliminated by the triangular pyramidal constraint. In one example, the prismatic joint P0 of each subchain (the joints R1, P1, R2 are passive joints) may be selected as the driven or actuated joint because there are no intersection motions between the three inclined planar displacement subsets in the triangular pyramidal constraint, namely:
where {E} is a fixed displacement subgroup. There are no output motions between the three parallel subchains R1P1R2 when the actuators of the three prismatic joints P0 are locked.
By arbitrarily assuming that two of the actuators are locked, the intersection operation of the displacement subsets between the remaining structures is expressed as:
where {T({right arrow over (OmOf2)})} is a translational output motion of the movable platform along the intersection line {right arrow over (OmOf2)} of the planes K2 and K3. Similarly, if one of the actuators is locked, the output motions of the movable platform are:
where {T(K3)} represents two translational outputs in the plane K3. Thus, the three linear input motions of the manipulator are decoupled. They correspond to the three output motions of the movable platform, respectively.
Based on the general Grubler-Kutzbach criterion, mobility of the manipulator is zero. Thus, the structure of the manipulator may be an over-constrained mechanism. However, in overconstrained mechanisms, large reaction moments and variable friction of the joints can affect the mobility of the movable platform due to unavoidable manufacturing or assembly errors. As a consequence, related output kinematic errors may be induced. Thus, by adding a revolute joint in each subchain, the manipulator may be converted into a non-over-constrained mechanism. An axis of the added revolute joint R3 is parallel to a moving direction of the prismatic joint P1. Equivalently, joint P1 may be replaced by a cylindrical joint to eliminate the overconstrained condition. A 3P-RCR TPM can be obtained by the replacement. The mobility of the non-overconstrained 3P-RCR TPM is three according to the general Grüler-Kutzbach criterion. Based on displacement group theory, the additional three non-parallel rotations (R3) can also be eliminated by the triangular pyramidal constraint. Thus, the added joints have no influence on the mobility and kinematic properties of the manipulator. They are only active when some constraint errors are encountered during the continuous motions.
In some examples, the manipulator illustrated in
As a consequence, based on the above features (i.e., non-Cartesian constraint, fixed linear actuation, minimal number of 1-DOF joints, smaller size of the movable platform, decoupled motions) and the drawback analysis of conventional 3-DOF TPMs, the manipulator can achieve a higher load/weight ratio, stiffness and accuracy. In order to evaluate kinematic performances of the manipulator, related position solutions, workspace, velocity, load, singularity, isotropic and dexterity analysis are performed and described below.
The inverse and forward position solutions of the manipulator illustrated in
l
i
+g
i
=r
o
+r
i
+h
i (7)
where the vectors are defined as:
Thus, the vector hi can be deduced and expressed as:
In accordance with the structural constraint condition, namely the intersection angle between the variable vectors li and hi is the constant γi the corresponding kinematic constraint equation can be obtained by a dot product of li and hi as
To solve Eq. (10) with respect to unknown parameter ∥li∥, an inverse position solution of the manipulator can be defined as:
∥li∥=∥ri∥+x cos αi+y sin αi±cot γi√{square root over ((x sin αi−y cos αi)2+(∥gi∥+z)2)} (11)
where the symbol “±” is selected as “+” for a larger value of ∥li∥, because ∥li∥ is a non-negative number, and initial positions of the slide blocks are placed outward from the symmetric center point Om.
The forward position solution is obtained by solving the equations of the inverse position solution when the output variables x, y, and z are unknown parameters. By writing Eq. (11) three times (once for each i=1, 2, 3), three non-linear equations are obtained:
In accordance with the computational results of symbolic mathematical software, an analytical form of the solutions for x, y, and z exists, but the expression is complex and long. Thus, to solve the forward position configuration of the manipulator illustrated in
To illustrate the developments in this paper, a hypothetical manipulator with structural parameters listed in Table 1 will be assumed. Moving ranges of all joints are represented by ∥li∥min, ∥li∥max, ∥hi∥min, ∥hi∥max, θi,min and θi,max. Numerical forward position solutions, based on Eq. (12), of the manipulator in eight configurations are listed in Table 2.
In Table 2, the eight configurations, defined by ∥l1∥, ∥l2∥, ∥l3∥, were arbitrarily assumed within the moving ranges of the linear actuators. In accordance with Eq. (12), all possible solution results for x, y, and z are listed. In each configuration given by ∥l1∥, ∥l2∥, ∥l3∥, there are two solutions for x, y, and z. The two solutions for x and y are equal in each configuration. The first solution value for z in each configuration is smaller than the second solution value, which means that two possible position solutions of the movable platform and structure exist. These solutions are symmetric with respect to the plane B1B2B3. Thus, the first solution can be determined as the real solution because of physical interference and of the initial positions of the subchains as shown in
The workspace of the manipulator illustrated in
In this example, during continuous motions of the movable platform, the two parallel revolute joints Ri,1, Ri,2 of each subchain are passive joints. Furthermore, vector hi has the same intersection angles with vector gi and the axis zm, where the vector gi is always parallel to the axis zm since there are no rotational outputs on the movable platform. Thus, the rotational angles θi,u, θi,d of the two parallel revolute joints of each subchain are equal. The angles θi,u, θi,d can be determined by the closed-loop constraint as:
The translational displacements ∥li∥ (Pi,0) and ∥hi∥ (Pi,1) are determined by the inverse position solution from Eqs. (11) and (9), respectively. Thus, by considering the moving ranges, physical interference and geometric constraints of all joints, the corresponding constraint equations of the reachable workspace can be obtained as:
In order to evaluate the shape and size of the reachable workspace, a numerical search can be performed based on Eq. (15). In the fixed reference frame Of-xfyfzf, if a point (x, y, z) satisfies the inequalities expressed by Eq. (15), that point can be considered as part of the reachable workspace. Thus, by searching all points on each x-y section of Of-xfyfzf, the set of the valid points is obtained, and the 3D arrangement of all valid points can be considered as the reachable workspace of the manipulator.
As an example, the values of the structural parameters and of the moving ranges of all joints listed in Table 1 will be utilized. Based on the numerical search results in Eq. (15), the basic 3D shape and size of the reachable workspace is shown in
Among all the basic structural constants αi, γi, ∥gi∥ and ∥ri∥, αi determines a symmetric property of the workspace, variations of ∥gi∥ and ∥ri∥ can only change a size of the workspace (instead of the shape of the workspace), because the different lengths of the ∥gi∥ and ∥ri∥ have no influence on the constraint angles between the axes of all the joints. In the inclined planar displacement subsets of the three subchains, the intersection angle γi determines the inclination of the triangular pyramidal constraint that can change the constraint angles between the moving direction of joint Pi,1, and the axes of joints Ri,1, Ri,2. Different constraint angles of the joints will generate workspaces of different shapes and sizes. Thus, by comparing the variation of all the basic structural constants, the variation of γi may have the most significant influence on the workspace.
The variation range of the intersection angle is γiε(0°,90°). In
In order to establish a stiffness model of the manipulator, all of the deformations including three rotations and three translations of the movable platform should be considered. Thus, a 6×6 overall Jacobian matrix is required for the stiffness modeling of this limited-DOF parallel manipulator. The overall Jacobian matrix includes the Jacobian of the constraints and actuations. Correspondingly, the stiffness of structural constraints and the stiffness of actuations can be included in the 6×6 overall Jacobian matrix, respectively. Based on the theory of reciprocal screws, the Jacobian of constraints and actuations are analyzed as follows.
By assuming that the deformations of the output movable platform include 6-DOF motions, the vectors for the angular and linear velocities of the movable platform can be respectively expressed in the fixed reference frame Of-xfyfzf as:
Based on the closed-loop constraint of each subchain in Eq. (7) and the non-overconstrained structure of the manipulator with five joints in each subchain, the instantaneous twist $Om of the movable platform is a linear combination of the five instantaneous twists of the joints, namely:
$Om=[ωTvT]T=∥{dot over (l)}i∥{circumflex over ($)}i,1+{dot over (θ)}i,u{circumflex over ($)}i,2+∥{dot over (h)}i∥{circumflex over ($)}i,3+{dot over (θ)}i,dŜi,4+{dot over (θ)}i,c{dot over ($)}i,5 (17)
where {circumflex over ($)}i,j (i=1, 2, 3, j=1, 2, 3, 4, 5) is a unit screw associated with the jth joint of the ith subchain. ∥{dot over (l)}i∥, {dot over (θ)}i,u, ∥{dot over (h)}i∥, {dot over (θ)}i,d, and {dot over (θ)}i,c represent velocities of the joints. The linear combination of the instantaneous twists of each subchain is the same because the three subchains are connected to the movable platform with identical output motions.
In
where ∥li∥ can be obtained from Eq. (11). Thus, the unit screws {circumflex over ($)}i,j of Eq. (17) are:
In accordance with the theory of reciprocal screws, a reciprocal screw $a∘$b is that the wrench $a has no work along the twist of $b. In each subchain of the manipulator, a unit constraint screw {circumflex over ($)}i,c is reciprocal to all joint screws (instantaneous twist $Om of the movable platform). The wrench {circumflex over ($)}i,c cannot activate the motions of the five joints of each subchain. Thus, based on the structural constraints of the joints in each subchain, the unit constraint screw {circumflex over ($)}i,c can be identified as an infinite-pitch wrench screw, namely:
which represents a unit couple of constraints imposed by the joints of the ith subchain, and the couple is exerted on the movable platform around the direction of the unit constraint vector ki,c. The constraint vector, ki,c is perpendicular to the unit vectors si,2 and si,3. The reciprocal product of the unit constraint screw {circumflex over ($)}i,c and of the instantaneous twist on $Om is:
where the reciprocal matrix ∇ is
Thus, the Jacobian of constraints can be obtained from Eq. (26), which transforms the angular and linear velocities of the movable platform to 0. By considering the constraints of the three subchains, the Jacobian of the constraints is:
where ki,c is determined in Eq. (16). Each row of Jc represents a unit wrench of structural constraints of a subchain, which is exerted on the movable platform. Thus, the Jacobian of constraints determines the 3-DOF translational output motions of the movable platform.
If Jc is of full rank, the unique solution for Ji,c$Om=0 (Eq. (26) is ω=0. Thus, based on Eqs. (17) and (20)-(24), a constraint equation can be obtained as:
{dot over (θ)}i,usi,2+{dot over (θ)}i,dsi,4+{dot over (θ)}i,csi,5=0 (29)
Since si,2=si,4≠si,5≠0, thus, Eq. (29) can be deduced as:
namely, stating that rotational angles of joints and Ri,1 and Ri,2 are equal, and that the added revolute joint Ri,3 has no rotation in the motions of the structure. Thus, the kinematic motions and constraints of the manipulator are not affected by the elimination of the overconstrained mechanism condition.
By assuming that the actuated joint (Pi,0) in each subchain is locked, a unit actuation screw {circumflex over ($)}i,a is reciprocal to all passive joint (Ri,1Pi,1Ri,2Ri,3) screws of the ith subchain. The wrench of {circumflex over ($)}i,a has no work on all passive joints but the actuated joint. Thus, the unit actuation screw {circumflex over ($)}i,a can be identified as a zero-pitch screw along the direction of the unit actuation vector ki,a i.e.:
which represents a unit force of actuation imposed by the actuated joint of the ith subchain that is exerted on the movable platform along the direction of the unit actuation vector ki,a. The vector ki,a is perpendicular to the unit vectors si,3 and passes through the axes of joints Ri,1 and Ri,2. The reciprocal product of the unit actuation screw {circumflex over ($)}i,a and of the instantaneous twist $Om is:
Thus, the Jacobian of actuations is determined by Eq. (33), which transforms the angular and linear velocities of the movable platform to the linear input velocity ∥{dot over (l)}i∥ of the actuator. By considering the motions of the three subchains, the Jacobian of actuations assumes the form:
where the last three columns are dimensionless, while the first three columns are related to the length of ri. It is necessary to homogenize the units of the Jacobian of actuations for which the stiffness matrix and performance index are invariant with respect to the length unit. Thus, the dimensionally homogeneous Jacobian of actuations can be expressed as:
In accordance with the Jacobian of constraints and actuations, the overall velocity transformation from the output movable platform to the input actuated joint of each subchain is:
Thus, the 6×6 overall Jacobian matrix of the manipulator is given by:
which includes all of the basic constraints and actuations of the manipulator.
As far as the kinetostatic analysis of the manipulator is concerned, the relationship between input forces of the three linear actuators and output force acting on the movable platform can be expressed respectively in vector form as:
where the directions of the three input forces ∥f1,a∥, ∥f2,a∥ and ∥f3,a∥ are along the moving directions of the actuated prismatic joints respectively, while the output force is the resultant force of the three axial forces acting at the center point of the movable platform. Based on the principle of virtual work, the relations between the input-output forces can be expressed as:
f
f
T
ΔO
m
=f
a
T
Δl (39)
where the virtual linear displacements of the actuators and of the movable platform are:
In accordance with the differential motions and the Jacobian matrix of velocities, the relationships between the input-output virtual displacements are:
Δl=JΔOm (41)
By substituting Eq. (25) into Eq. (23), the relationships between the input-output forces can be obtained as:
f
f
=J
T
f
a (42)
where JT is the Jacobian matrix of loads that can be used to evaluate the static forces of the linear actuators.
In the motions of the manipulator illustrated in
In the structural design of the manipulator with the three inclined planar displacement subsets (γiε(0°,90°)), a unique singularity pose is encountered when the three vectors hi lie in a common plane as the forward kinematic singularity. The guide members of the three linear actuators should be arranged in a triangular form, and the moving directions of three prismatic joints P1,1, P2,1, P3,1 are parallel to a common plane xmOmym as shown in
In the forward kinematic singularity, the structure gains an additional instantaneous DOF. If the three linear actuators P1,0, P2,0, P3,0 are locked, an instantaneous translational motion of the movable platform still exists along the axis zm, because the constraint planes K1, K2, K3 of the three subchains' inclined planar displacement subsets are perpendicular to the common plane xmOmym instantaneously (det(JOm)=0). This is an uncontrollable DOF of the structure in the forward kinematic singularity configuration.
In the manipulator illustrated in
As far as the kinematic performance of the manipulator is concerned, isotropy of the structure is frequently used to evaluate the output motions and forces of the movable platform. In the isotropic configurations of the structure, the velocity or force transmission of the manipulator are identical in all motion directions of the movable platform. In accordance with the definition of isotropy of parallel manipulators, the isotropic configuration of the manipulator is dependent on the condition number of the Jacobian matrix J that can be expressed as:
κ=√{square root over (Max(λ(J−TJ−1)))} (43)
where Max(λ(J−T J−1)) denotes the largest eigenvalues of the matrix J−T J−1. The Jacobian matrix is variable and dependent on the position of the movable platform. In the reachable workspace, if the condition number of the Jacobian matrix is infinity, the manipulator will be in singularity poses. On the contrary, if the condition number is equal to 1, the manipulator possesses an isotropic configuration. In the isotropic configurations, the Jacobian matrix J should satisfy:
which can be considered as the isotropy conditions for an isotropic manipulator. In accordance with Eq. (45), three vectors J1, J2 and J3 should be perpendicular to one another in the isotropic configurations. Thus, the moving directions of the three actuated prismatic joints P1,0, P2,0, P3,0 should be perpendicular to one another, namely, the guide members of the three actuators are arranged in an orthogonal form. The isotropic structural configuration of the manipulator is shown in
In addition to the isotropic property of the manipulator, the dexterity of the manipulator is also an important property. The dexterity of a manipulator is the ability that the manipulator can generate output motions and forces in arbitrary directions. The frequently used index of dexterity is the kinematic manipulability that can be expressed by the square root of the determinant of JJT as:
m=√{square root over (det(JJT))} (46)
The kinematic manipulability is variable with the position of the movable platform in the reachable workspace. The different values of the kinematic manipulability indicate how close the manipulator is to the singularity poses. A value of m=0 corresponds to a singularity pose of the manipulator. Thus, the distribution of the kinematic manipulability should be determined in the reachable workspace to identify the kinematic performance of the manipulator.
As an example, based on Eq. (46) and the structural parameters in Table 1, the kinematic manipulability distribution can be obtained as shown in
The present disclosure presents a 3-DOF translational parallel manipulator that resolves and/or improves upon the disadvantages of existing developed 3-DOF translational parallel manipulators. In one example, with respect to
Once the stiffness model is obtained, stiffness performance can be evaluated by extreme eigenvalues of the output stiffness matrix, because the output stiffness in an arbitrary direction is defined by the minimal and maximal eigenvalues of the stiffness matrix in a given pose. Hence, the distribution of the output stiffness can be characterized by the distribution of the minimal and maximal eigenvalues in the manipulator's reachable workspace. By considering the variations of the structural parameters and the distribution of the output stiffness, the minimal stiffness workspace can be obtained through numerical optimization. This information provides basic design constraints for the parameters of the manipulator.
The stiffness of all links, joints, actuators, fixed and movable platforms are included in the stiffness model of the manipulator. In accordance with the analysis of the overall Jacobian matrix, in each subchain the actuation screw {circumflex over ($)}i,a imposes an actuation force fi,a at point Ci of the movable platform along the directions of ki,a, while the constraint screw {circumflex over ($)}i,c exerts a constraint couple Mi,c at point Ci of the movable platform around the direction of ki,c as shown in
In
Tensional and compressional stiffnesses (along the direction of vector hi) do not exist in the prismatic joint Pi,1 because Pi,1 is a passive joint, and the actuation force fi,a is perpendicular to the vector hi. Similarly, there is no torsional compliance around the vector hi since the direction of the constraint couple Mi,c is perpendicular to the vector hi, and {dot over (θ)}ci=0. Thus, in a subchain, there are a total two torsional springs and six bending springs that can be used to represent the equivalent spring structure. In the static balance of the equivalent spring structure, the deformations of a subchain include the deformations of actuation and constraints as shown in
In the case of lead screw in the ith subchain, the torque τi,a of the actuator can be expressed as:
τi,a=Ki,αaΔαi,a (47)
where Ki,αa and Δαi,a represent the torsional stiffness and angular deformation of the actuator. By considering the torque transmission of the lead screw, the actuation force fi,al is acting on the slide block AiBi and along the guide member OfGi, which can be deduced as:
where di,a and Li,a represent the pitch diameter and lead of the lead screw respectively. λi,a and ψi,a are the lead angle and the friction angle of the lead screw respectively, while αi,t and μi,c are the radial angle of the thread and the coefficient of friction between the screw and nut. In
Δli=Li,aΔαi,a (50)
which is induced by the angular deformation of the actuator. Thus, the compliance of the torsional spring of the actuation can be deduced from Eqs. (47)-(50) as:
In
where Δφi,GOf is the angular deformation of the guide member OfGi, ∥li∥min and ∥li∥max represent the moving range of the slide block AiBi, E is Young's modulus of elasticity, and Iik,GOf is the moment of inertia of the guide member Of Gi along the direction ki,c.
In the slide block AiBi, the angular deformation (around ki,c) that is induced by the constraint couple Mi,c can be decomposed into Δφi,AB (perpendicular to the vector gi for the bending stiffness) and Δφi,ABt (around the vector gi for the torsional stiffness). Thus, the bending and torsional compliances of the slide block AiBi can be respectively represented by:
where G is the shear modulus of elasticity, Iik,AB and Iip,AB are the moment of inertia and polar moment of inertia of the slide block AiBi, respectively.
Similarly, the bending compliances of BiHi,m, Hi,mHi and HiCi can be respectively determined as:
The bending compliance of link CiOm is:
Thus, in the serial connection of the springs, the equivalent stiffness of a subchain can be respectively determined as the stiffness of the actuation and constraints as:
By combining the equivalent stiffnesses of the three subchains in the closed-loop form, the overall stiffness of the manipulator can be obtained and analyzed.
In order to establish the stiffness model of the manipulator, the overall stiffness of the three subchains can be analyzed by the load/displacement ratio of the movable platform. By assuming that there are no preloads and gravity effects on the structure, the output force and torque exerted on the movable platform are:
which can be expressed as an output wrench wf=[ffT MfT]T. In the fixed reference frame Of-xfyfzf, the infinitesimal translational and rotational deformations of the movable platform caused by wf are:
ΔOm=[ΔxOmΔyOmΔzOmΔθxfΔθyfΔθzf]T (62)
The input force and torque that are caused by actuations and constraints of the three subchains can be respectively expressed as:
In accordance with the differential motions of the structure and the Jacobian of actuations and constraints, the output infinitesimal deformations of the movable platform can be respectively transformed as the input deformations of the actuators and the constrained subchains. Thus, the infinitesimal translational and rotational deformations of the actuators and of the constrained subchains are respectively deduced as:
By applying the principle of virtual work to the overall structure, the relations of the input-output force and torque become:
where the input force fal of the actuators and torque Mc of the constraints are respectively determined by the equivalent stiffness of the three subchains in Eqs. (59) and (60) as:
By substituting Eq. (67) and (68) into Eq. (66), the output force and torque of the movable platform is obtained:
Thus, the 6×6 stiffness matrix of the manipulator can be deduced from Eq. (69) and becomes:
The stiffness matrix includes the effects of the actuations and constraints of the manipulator, and the stiffness of all links, joints, actuators, fixed and movable platforms are considered based on the analysis of the overall Jacobian matrix. The stiffness performance of the manipulator can now be evaluated based on this stiffness matrix.
In the structure of the manipulator, the stiffness matrix is varied when the movable platform is moving to different positions. In addition, the stiffness matrix is also dependent on the direction of the applied external loads on the movable platform. In the reachable workspace, the minimal stiffness should be larger than a designed value to ensure accuracy of manipulation. Thus, the distribution of the stiffness should be evaluated in the reachable workspace.
Each point of the reachable workspace is characterized by a minimal and maximal value of the stiffness. The actual stiffness at each point depends on the direction of the external load. The range of the values can be characterized by the minimal and maximal eigenvalues of the stiffness matrix, because the output stiffness in an arbitrary direction is bounded by the minimal and maximal eigenvalues of the stiffness matrix in a given pose. The variations of the minimal and maximal eigenvalues can be used as stiffness performance indices to evaluate the stiffness distribution in the reachable workspace.
By substituting all coordinates of the reachable workspace into the stiffness matrix in Eq. (76), the distributions of the minimal and maximal eigenvalues of the stiffness matrix can be respectively determined in the fixed reference frame Of-zfyfzf. The structural and physical parameters are listed in Tables 1 and 3, respectively.
In
Among all the basic structural constants αi, γi, ∥gi∥, ∥ri∥, ∥hi,u∥ and ∥hi,d∥, αi determines the symmetric property of the structure, while the variations of ∥gi∥, ∥ri∥, ∥hi,u∥ and ∥hi,d∥ can only change the size of the workspace (instead of the shape of the workspace), because the different lengths of ∥gi∥, ∥ri∥, ∥hi,u∥ and ∥hi,d∥ have no influence on the constraint angles between the axes of all joints. In the inclined planar displacement subsets of the three subchains, the intersection angle γi determines the constraint angles between the moving direction of joint Pi,1 and the axes of joints Ri,1, Ri,2. Different constraint angles of the joints induce different shapes and sizes of the structure. Thus, by comparing the variation of all the basic structural constants, the variation of γi has the most significant influence on the structure.
The variation range of the intersection angle is γiε(0°,90°). In
The motions and constraints of the 3-DOF translational parallel manipulator are analyzed. There are only four 1-DOF joints required in each subchain of the manipulator. A small size of the movable platform and fixed linear actuations are designed for achieving a high load/weight ratio, stiffness and accuracy. The inverse position solution was obtained in the closed-loop constraint analysis. By considering the 6-DOF deformations of the movable platform, a 6×6 overall Jacobian matrix of the manipulator was built based on the theory of reciprocal screws, which includes the constraint and actuation effects on the output stiffness.
In accordance with the overall Jacobian matrix method, the stiffness model of the manipulator was established. The model includes the deformations of all links, joints, actuators, fixed and movable platforms. In each subchain, two torsional springs and six bending springs were used to represent the equivalent spring structure of the stiffness model. A 6×6 output stiffness matrix was obtained by the transformations of loads and deformations in the closed-loop form. Furthermore, the stiffness performance of the manipulator was characterized and evaluated by the maximal and minimal eigenvalues of the stiffness matrix in the reachable workspace. By evaluating the workspace and distributions of the maximal and minimal eigenvalues with the variation of structural parameters, the maximal size of the practical workspace was determined. The stiffness model and analysis provide the basic constraints for the parametric design of the manipulator.
Referring now to
For precision manipulation purposes, structural stiffness is an important performance measure. In order to evaluate the stiffness distribution in the workspace of a parallel manipulator, its stiffness model should be established in the form of an output stiffness matrix.
The stiffness model of the manipulator illustrated in
For this example, in order to overcome drawbacks of the conventional DOF TPMs, a conical displacement subset is defined and used to build a Schoenflies displacement subgroup in each subchain. The additional specified constraint relations between all the joints will be analyzed below.
As shown in
where the output motions Zm of the movable platform are three orthogonal translations {T}. The actuated joint can be chosen as the prismatic joints Pi,0 of each subchain (the remaining joints Ri,1Ri,1Ri,2 are passive joints), because there are no intersection motions between the three conical displacement subsets in the different directions when the actuators of the three prismatic joints P0 are locked. In order to avoid sticking of the passive prismatic joints, the three linear actuations will not be placed in a plane, and the intersection angle between the actuated prismatic joint and the passive prismatic joint in each subchain should not be 90°. Meanwhile, in the reachable workspace, the intersection cure of any two cones of the subchains is unparallel with a moving direction of passive prismatic joint of the third subchain. Thus, the output motion along the intersection cure can be actuated by the fixed prismatic joint of the third subchain. Three fixed input linear actuations can be designed in an orthogonal form. The three orthogonal output translations of the movable platform can be directly actuated by the three orthogonal linear actuations.
The manipulator illustrated in
As a consequence of these features, a higher load/weight ratio and stiffness of the manipulator can be expected. The related kinematic position analysis, overall Jacobian, stiffness matrix determination, workspace and stiffness evaluations are performed hereinafter.
In order to establish a stiffness model of the manipulator, the kinematic position solutions should be determined to provide the constraint relations of the structure. The position relationships between the three linear input motions of actuations and the three translational output motions of the movable platform can be analyzed in a closed-loop form. In the following paragraphs the basic relations required for the stiffness analysis are reviewed.
In
l
i
=r
o
+r
i
+h
i (72)
where the constituent vectors are defined as:
Thus, the vector hi can be deduced as:
In accordance with the structural constraint condition, namely the intersection angle between variable vectors ni and hi is constant γi, the corresponding kinematic constraint equation can be obtained by the dot product of ni and hi as:
To solve Eq. (75) with respect to the unknown parameter ∥li∥, the inverse kinematic position solution of the manipulator can be obtained as:
where EAi and EBi are:
In Eq. (76), the symbol “±” is set to “+” for the larger value because the ∥li∥ is a non-negative number, and the initial positions of slide blocks are placed outward from the symmetric center point Om.
Correspondingly, the forward kinematic position solution can be obtained by solving Eq. (76) for the unknown output variables x, y, and z when the input variables ∥li∥ are given. Based on the kinematic position solutions, the overall Jacobian matrix will be developed in the next section for stiffness modeling.
In order to establish the stiffness model of the manipulator, all of the deformations including three rotations and three translations of the movable platform should be considered. Thus, a 6×6 overall Jacobian matrix is required for the stiffness modeling of this limited-DOF parallel manipulator. The overall Jacobian matrix includes the Jacobian of the constraints and actuations. Correspondingly, the stiffness of structural constraints and the stiffness of actuations can be included in the 6×6 overall Jacobian matrix, respectively. Based on the theory of reciprocal screws, the Jacobian of constraints and actuations are analyzed as follows.
By assuming that the deformations of the output movable platform include 6-DOF motions, the vectors for the angular and linear velocities of the movable platform can be respectively expressed in the fixed reference frame Of-xfyfzf as:
Based on the closed-loop constraint of each subchain in Eq. (72), the instantaneous twist $Om, of the movable platform is a linear combination of the four instantaneous twists of the joints, namely:
$Om=[ωTvT]T=∥{dot over (l)}i∥{circumflex over ($)}i,1+{dot over (θ)}i,u{circumflex over ($)}i,2+∥{dot over (h)}i∥{circumflex over ($)}i,3+{dot over (θ)}i,d{circumflex over ($)}i,4 (79)
where {circumflex over ($)}i,j (i=1, 2, 3, j=1, 2, 3, 4) is a unit screw associated with the jth joint of the ith subchain. ∥{dot over (l)}i∥, {dot over (θ)}i,u, ∥{dot over (h)}i∥ and {dot over (θ)}i,d, represent the velocities of the joints. The linear combination of the instantaneous twists of each subchain is the same because the three subchains are connected to the movable platform and constrained with identical output motions.
In
where ∥li∥ can be obtained from Eq. (76). Thus, the unit screws {circumflex over ($)}i,j of Eq. (79) are:
In accordance with the theory of reciprocal screws, a reciprocal screw $a ∘$b is that the wrench $a has no work along the twist of $b. In each subchain of the manipulator, a unit constraint screw {circumflex over ($)}i,c, is reciprocal to all joint screws (instantaneous twist $Om of the movable platform). The wrench {circumflex over ($)}i,c cannot activate the motions of the four joints of each subchain. Thus, based on the structural constraints of the joints in each subchain, the unit constraint screw {circumflex over ($)}i,c can be identified as an infinite-pitch wrench screw, namely:
which represents a unit couple of constraints imposed by the joints of the ith subchain, and the couple is exerted on the movable platform around the direction of the unit constraint vector ki,c. The constraint vector ki,c, is perpendicular to the unit vectors si,2 and si,3. The reciprocal product of the unit constraint screw {circumflex over ($)}i,c and of the instantaneous twist $Om is:
{circumflex over ($)}i,c∘$Om=(Λ{circumflex over ($)}i,c)T$Om=Ji,c$Om=0 (88)
where the transformation matrix Λ is
Thus, the Jacobian of constraints can be obtained from Eq. (88), which transforms the angular and linear velocities of the movable platform to 0. By considering the constraints of the three subchains, the Jacobian of the constraints is:
where ki,c is determined in Eq. (87). Each row of Jc represents a unit wrench of structural constraints of a subchain, which is exerted on the movable platform. Thus, the Jacobian of constraints determines the 3-DOF translational output motions of the movable platform.
If Jc is of full rank, the unique solution for Ji,c$Om=0 (Eq. (88)) is ω=0. Thus, based on Eqs. (79) and (83)-(86), a constraint equation can be obtained as:
{dot over (θ)}i,usi,2+{dot over (θ)}i,dsi,4=0 (91)
Since si,2=si,4≠0, thus, Eq. (91) can be deduced as:
{dot over (θ)}i,u+{dot over (θ)}i,d=0 (92)
stating that the magnitudes of the rotational angles of joints Ri,1 and Ri,2 are equal.
By assuming that the actuated joint (Pi,0) in each subchain is locked, a unit actuation screw {circumflex over ($)}i,a is reciprocal to all passive joint (Ri,1Pi,1Ri,2) screws of the ith subchain. The wrench of {circumflex over ($)}i,a has no work on all passive joints but the actuated joint. Thus, the unit actuation screw {circumflex over ($)}i,a can be identified as a zero-pitch screw along the direction of the unit actuation vector ki,a, i.e.:
which represents a unit force of actuation imposed by the actuated joint of the ith subchain that is exerted on the movable platform along the direction of the unit actuation vector ki,a. The vector ki,a is perpendicular to the unit vectors si,3 and passes through the axes of joints Ri,1 and Ri,2. The reciprocal product of the unit actuation screw {circumflex over ($)}i,a and of the instantaneous twist $Om is:
{circumflex over ($)}i,a∘$Om=(Λ{circumflex over ($)}i,a)T$Om=∥{dot over (l)}i∥cos φi=∥{dot over (l)}i∥ki,aTsi,1 (94)
where φi is intersection angle between ki,a and si,1. Eq. (94) can be transformed as:
Thus, the Jacobian of actuations is determined by Eq. (95), which transforms the angular and linear velocities of the movable platform to the linear input velocity ∥{dot over (l)}i∥ of the actuator. By considering the motions of the three subchains, the Jacobian of actuations assumes the form:
In accordance with the Jacobian of constraints and actuations, the overall velocity transformation from the output movable platform to the input actuated joint of each subchain is:
Thus, the 6×6 overall Jacobian matrix of the manipulator is given by:
which is a 6×6 transformation matrix including all of the basic constraints and actuations of transformation between all joints motions and output motions of the movable platform.
In the structure of the manipulator, the stiffness of all links, joints, actuators, fixed and movable platforms are included in the stiffness model. In accordance with the analysis of the overall Jacobian matrix, in each subchain the actuation screw {circumflex over ($)}i,a imposes an actuation force fi,a at point Ci of the movable platform along the directions of ki,a, while the constraint screw {circumflex over ($)}i,c exerts a constraint couple Mi,c at point Ci of the movable platform around the direction of ki,c as shown in
In
(1) If a lead screw is used, a torsional spring can be used to represent the stiffness of actuation. The rotational deformation of the actuator can be transformed as a linear deformation along the guide member. The compliance of the torsional spring is denoted by Ci,al. Equivalently, if a linear motor is used for actuation, a tensional spring is used to represent the stiffness of actuation. The linear deformation is along the guide member without a displacement transformation between the rotation and translation.
(2) In the guide member OfGi, a bending spring is used to represent the stiffness of the part of the fixed platform. The corresponding compliance is Ci,GOf.
(3) In the prismatic joint Pi,1, the guide member and the slide block have different bending stiffnesses. Thus, the equivalent spring between the points Ai and Bi can be separated into three parts, namely guide member AiHi,m, slide block HiBi and Hi,mHi (overlapping part between the guide member and the slide block). The compliances of AiHi,m, HiBi and Hi,mHi are denoted as Ci,AH, Ci,HB and Ci,HH, respectively.
(4) In the link BiOm, a bending spring is used to represent the stiffness of the part of the movable platform. The compliance of the link is denoted as Ci,BOm.
Tensional and compressional stiffnesses (along the direction of vector hi) do not exist in the prismatic joint Pi,1 because Pi,1 is a passive joint, and the actuation force fi,a is perpendicular to the vector hi. Similarly, there is no torsional compliance around the vector hi since the direction of the constraint couple Mi,c is perpendicular to the vector hi. Thus, in a subchain, there is a total of one torsional spring and five bending springs that can be used to represent the equivalent spring structure. In the static balance of the equivalent spring structure, the deformations of a subchain include both the deformations of actuation and of the constraints as shown in
In the case of lead screw in the ith subchain, the torque τi,a of the actuator can be expressed as:
τi,a=Ki,αaΔαi,a (99)
where Ki,αa and Δαi,a represent the torsional stiffness and angular deformation of the actuator. By considering the torque transmission of the lead screw, the actuation force fi,al is acting on the slide block and along the guide member OfGi, which can be deduced as:
where di,a and Li,a represent the pitch diameter and lead of the lead screw respectively. λi,a and ψi,a are the lead angle and the friction angle of the lead screw respectively, while αi,t and μi,c are the radial angle of the thread and the coefficient of friction between the screw and nut. In
Δli=Li,aΔαi,a (102)
which is induced by the angular deformation of the actuator. Thus, the compliance of the torsional spring of the actuation can be deduced from Eqs. (99)-(102) as:
In
where Δφi,GOf is the angular deformation of the guide member OfGi, ∥li∥min and ∥li∥max represent the moving range of the slide block, E is Young's modulus of elasticity, and Iik,GOf is the cross section moment of inertia of guide member OfGi around the direction ki,c.
In the joint Pi,1, the bending compliances of AiHi,m, Hi,mHi and HiBi can be respectively determined as:
The bending compliance of link BiOm is:
Thus, in the serial connection of the springs, the equivalent stiffness of a subchain can be respectively determined as the stiffness of the actuation and constraints as:
By combining the equivalent stiffnesses of the three subchains in the closed-loop form, the overall stiffness of the manipulator can be obtained and analyzed.
In order to establish the stiffness model of the manipulator, the overall stiffness of the three subchains can be analyzed by the load/displacement ratio of the movable platform. By assuming that there are no preloads and gravity effects on the structure, the output force and torque exerted on the movable platform are:
which can be expressed as an output wrench wf=[ffT MfT]T. In the fixed reference frame Of-xfyfzf, the infinitesimal translational and rotational deformations of the movable platform caused by wf are:
ΔOm=[ΔxOmΔyOmΔzOmΔθxfΔθyfΔθzf]T (112)
The input force and torque that are caused by actuations and constraints of the three subchains can be respectively expressed as:
In accordance with the differential motions of the structure and the Jacobian of actuations and constraints, the output infinitesimal deformations of the movable platform can be respectively transformed as the input deformations of the actuators and the constrained subchains. Thus, the infinitesimal translational and rotational deformations of the actuators and of the constrained subchains are respectively deduced as:
By applying the principle of virtual work to the overall structure, the relations of the input-output force and torque become:
where the input force fal of the actuators and torque Mc of the constraints are respectively determined by the equivalent stiffness of the three subchains in Eqs. (109) and (110) as:
By substituting Eq. (117) and (118) into Eq. (116), the output force and torque of the movable platform is obtained:
Thus, the 6×6 stiffness matrix of the manipulator can be deduced from Eq. (119) and becomes:
The stiffness matrix includes the effects of the actuations and constraints of the manipulator, and the stiffness of all links, joints, actuators, fixed and movable platforms are considered based on the analysis of the overall Jacobian matrix. The stiffness performance of the manipulator can now be evaluated based on this stiffness matrix.
To evaluate the stiffness performance of the manipulator, the reachable workspace should be determined and used to analyze the stiffness distributions. The shape and size of the reachable workspace is defined as the space that can be reached by the three translations of point Om of the movable platform in the fixed reference frame Of-xfyfzf. The boundary of the reachable workspace is simultaneously constrained by the moving ranges, physical interference and geometric constraints of all joints in the closed-loop form.
In accordance with Eq. (92), the rotational angles θi,u and θi,d of the two parallel revolute joints are equal as determined by the closed-loop constraint as:
where
{right arrow over (AiCi)}={right arrow over (OfOi)}−{right arrow over (OfAi)}=rO+{right arrow over (OmCi)}−li=rO+ri+∥hi∥cos γi[111]T−li (122)
The translational displacements ∥li∥ (Pi,0) and ∥hi∥ (Pi,1) are determined by the inverse position solution from Eqs. (76) and (74), respectively. Thus, by considering the moving ranges, physical interference and geometric constraints of all joints, the corresponding constraint equations of the reachable workspace are given by:
In order to determine the shape and size of the reachable workspace, a numerical search is performed based on Eq. (123). In the fixed reference frame Of-xfyfzf, if a point (x, y, z) satisfies the inequalities in Eq. (123), that point can be considered as part of the reachable workspace. Thus, by searching all points on each x-y section of Of-xfyfzf, a set of points is obtained. The 3D arrangement of all these points constitutes the reachable workspace of the manipulator.
The related values of the structural parameters and of the moving ranges of all joints for the manipulator selected for illustrative purposes are listed in Table 4. Based on the numerical search results in accordance to Eq. (123), the basic 3D shape and size of the reachable workspace is shown in
In the structure of the manipulator, the stiffness matrix is varied when the movable platform moves to different positions. In addition, the output stiffness is also dependent on the direction of the applied external loads on the movable platform. In the reachable workspace, the minimal stiffness should be larger than a designed value to ensure accuracy of manipulation. Thus, the distribution of the stiffness should be evaluated in the reachable workspace.
Each point of the reachable workspace is characterized by a minimal and maximal value of the stiffness. The actual output stiffness at each point depends on the direction of the external load. The range of the values can be characterized by the minimal and maximal eigenvalues of the stiffness matrix because the output stiffness in an arbitrary direction is bounded by the minimal and maximal eigenvalues of the stiffness matrix in a given pose. The variations of the minimal and maximal eigenvalues can be used as stiffness performance indices to evaluate the stiffness distribution in the reachable workspace.
By substituting all coordinates of the reachable workspace into the stiffness matrix in Eq. (120), the distributions of the minimal and maximal eigenvalues of the stiffness matrix can be respectively determined in the fixed reference frame Of-xfyfzf. The structural and physical parameters are listed in Tables 4 and 5, respectively.
In
Among all the basic structural constants αi, αPi, αRi, γi, ∥ri∥, ∥hi,u∥ and ∥hi,d∥, αi determines the symmetric property of the structure and workspace, while the variations of ∥ri∥, ∥hi,u∥ and ∥hi,d∥ can change the size of the workspace (instead of the shape of the workspace), because the different lengths of ∥ri∥, ∥hi,u∥ and ∥hi,d∥ have no influence on the constraint angles between the axes of all of the joints. In the three subchains, the intersection angles αPi, αRi and γi determine the constraint relations between all of the joints. Different constraint angles of the joints induce different shapes and sizes of the structure and of the workspace. In the illustrative example of a simplified sensitivity analysis of the structural parameters and of a simplified structural optimization, to be presented below, only the variation of γi will be considered while assuming that the other variables are constants.
During the linear actuation of Pi,0, in order to actuate the passive motion of joint Pi,1, joint Pi,1 cannot be parallel or perpendicular to Pi,0. Thus, the variation range of the intersection angle is γiε(0°,−((π/2)−|αRi|)) In
The motions and constraints of a 3-DOF translational parallel manipulator are analyzed. There are only four 1-DOF joints required in each subchain of the manipulator. A small size of the movable platform and fixed linear actuations are designed for achieving a better kinematic characteristic. The inverse position solution was obtained in the closed-loop constraint analysis. By considering the 6-DOF deformations of the movable platform, a 6×6 overall Jacobian matrix of the manipulator was built based on the theory of reciprocal screws, which includes the constraint and actuation effects on the output stiffness.
In accordance with the overall Jacobian matrix method, the stiffness model of the manipulator was established. The model includes the deformations of all links, joints, actuators, fixed and movable platforms. In each subchain, one torsional spring and five bending springs were used to represent the equivalent spring structure of the stiffness model. A 6×6 output stiffness matrix was obtained by the transformations of loads and deformations in the closed-loop form. Furthermore, the stiffness performance of the manipulator was characterized and evaluated by the maximal and minimal eigenvalues of the stiffness matrix in the reachable workspace. By evaluating the workspace and distributions of the maximal and minimal eigenvalues with the variation of structural parameters, the maximal size of the practical workspace was analyzed, and the maximal stiffness workspace can be determined according to the stiffness distributions. The stiffness model and analysis provide the basic constraints for the parametric design of the manipulator.
Referring now to
With continued reference to
It should be understood that use of the identifier “levels” is purely for organization of the figures and associated description, and is not intended to be limiting or imply an interpretation of any detail in the figures or description in any manner. It should also be understood that any of the levels may include more, less or different elements, and all of such possibilities are intended to be within the spirit and scope of the present disclosure.
It should further be understood that the joints described and illustrated herein are capable of being replaced with other types of joints that have different structures and function in different manners. For example, the joints may be replaced with flexure hinges, which would make the subchains and/or the manipulator a monolithic and/or a unitarily formed one-piece structure. It should also be understood that the manipulator may include piezo-transducers and/or motors for movement of portions of the manipulator, thereby resulting in better control of the manipulator (e.g., nanoscale movement).
The Abstract of the disclosure is provided to allow the reader to quickly ascertain the nature of the technical disclosure. It is submitted with the understanding that it will not be used to interpret or limit the scope or meaning of the claims. In addition, in the foregoing Detailed Description, it can be seen that various features are grouped together in various embodiments for the purpose of streamlining the disclosure. This method of disclosure is not to be interpreted as reflecting an intention that the claimed embodiments require more features than are expressly recited in each claim. Rather, as the following claims reflect, inventive subject matter lies in less than all features of a single disclosed embodiment. Thus, the following claims are hereby incorporated into the Detailed Description, with each claim standing on its own as a separately claimed subject matter.
While various embodiments and examples of the disclosure have been described, it will be apparent to those of ordinary skill in the art that other embodiments and examples, and implementations are possible within the scope of the disclosure. Accordingly, the disclosure is not to be restricted except in light of the attached claims and their equivalents.
The present application is a continuation of co-pending U.S. Non-Provisional patent application Ser. No. 14/259,815, filed Apr. 23, 2014, which claims the benefit of U.S. Provisional Patent Application No. 61/814,922, filed Apr. 23, 2013, all of which are incorporated by reference herein in their entirety.
Number | Date | Country | |
---|---|---|---|
61814922 | Apr 2013 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 14259815 | Apr 2014 | US |
Child | 15040156 | US |