Translational parallel manipulators and methods of operating the same
10583552 ยท 2020-03-10
Assignee
Inventors
Cpc classification
B25J9/0036
PERFORMING OPERATIONS; TRANSPORTING
Y10S901/19
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
B25J9/1623
PERFORMING OPERATIONS; TRANSPORTING
International classification
B25J9/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
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, 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.
Claims
1. A translational parallel manipulator comprising: a fixed platform comprising three guide members, wherein: the three guide members comprise first ends and second ends; and the first ends of the three guide members are coupled to each other and the second ends of the three guide members are spaced apart from each other; a movable platform spaced apart from the fixed platform; and three serial subchains coupled between the three guide members and the movable platform, wherein at least one of the three serial subchains comprises: a first prismatic joint; a first revolute joint coupled to the first prismatic joint; a second prismatic joint coupled to the first revolute joint; and a second revolute joint coupled to the second prismatic joint and parallel to the first revolute joint; wherein the first prismatic joint, the first revolute joint, the second prismatic joint, and the second revolute joint comprise one degree-of-freedom joints.
2. The translational parallel manipulator of claim 1, wherein the three guide members are co-planar with each other.
3. The translational parallel manipulator of claim 1, wherein the three guide members are non-planar with each other.
4. The translational parallel manipulator of claim 1, wherein the first ends of the three guide members are disposed above the second ends of the three guide members.
5. The translational parallel manipulator of claim 1, wherein the first ends of the three guide members are disposed below the second ends of the three guide members.
6. The translational parallel manipulator of claim 1, wherein the three serial subchains are identical in structure.
7. The translational parallel manipulator of claim 1, wherein: the first prismatic joint is coupled to one of the guide members; and the second revolute joint is coupled to the movable platform.
8. The translation parallel manipulator of claim 1, wherein the first prismatic joint comprises a driven prismatic joint.
9. The translational parallel manipulator of claim 8, wherein the first revolute joint, the second prismatic joint, and the second revolute joint comprise passive joints.
10. The translational parallel manipulator of claim 1, wherein at least one serial subchain comprises four one degree-of-freedom joints.
11. The translational parallel manipulator of claim 1, wherein: at least one of the first prismatic joint, the first revolute joint, the second prismatic joint and the second revolute joint comprises a driven joint; and at least one of the first prismatic joint, the first revolute joint, the second prismatic joint and the second revolute joint comprises a passive joint.
12. The translational parallel manipulator of claim 11, wherein the driven joint comprises the first prismatic joint.
13. The translational parallel manipulator of claim 12, wherein the first revolute joint, the second prismatic joint, and the second revolute joint comprise a passive joint.
14. The translational parallel manipulator of claim 1, wherein the three subchains comprise symmetric subchains.
15. The translational parallel manipulator of claim 1, wherein an intersection angle between the first prismatic joint and the second prismatic joint is less than ninety degrees.
16. The translational parallel manipulator of claim 1, wherein an intersection angle between the first prismatic joint and the second prismatic joint is greater than ninety degrees.
17. A translational parallel manipulator comprising: a fixed platform comprising three guide members, wherein: the three guide members each comprise a first end and a second end; and the first ends of the three guide members are coupled to each other and the second ends of the three guide members are spaced apart from each other; a movable platform spaced apart from the fixed platform; and three serial subchains, each of the three serial subchains coupled to one of the three guide members and coupled to the movable platform, wherein each of the three serial subchains comprises: a first prismatic joint coupled to one of the guide members; a first revolute joint coupled to the first prismatic joint; a second prismatic joint coupled to the first revolute joint; and a second revolute joint coupled to the second prismatic joint and coupled to the movable platform; wherein the first prismatic joint, the first revolute joint, the second prismatic joint, and the second revolute joint comprise one degree-of-freedom joints.
18. The translational parallel manipulator of claim 17, further comprising three linear actuators, each linear actuator coupled to the fixed platform and the first prismatic joint of each serial subchain.
19. A translational parallel manipulator comprising: a fixed platform comprising three guide members, wherein: the three guide members comprise first ends and second ends; and the first ends of the three guide members are coupled to each other and the second ends of the three guide members are spaced apart from each other; a movable platform spaced apart from the fixed platform; and three serial subchains coupled between the three guide members and the movable platform, wherein at least one of the three serial subchains comprises: a first prismatic joint; a first revolute joint coupled to the first prismatic joint; a second prismatic joint coupled to the first revolute joint; and a second revolute joint coupled to the second prismatic joint and parallel to the first revolute joint; wherein at least one serial subchain comprises four one degree-of-freedom joints.
20. The translation parallel manipulator of claim 19, wherein the first prismatic joint comprises a driven prismatic joint.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) 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.
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
(15)
(16)
(17)
(18)
(19)
(20)
(21)
(22)
(23)
(24)
(25)
(26)
(27)
(28)
(29)
(30)
(31)
(32)
(33)
(34)
(35)
(36)
(37)
(38)
(39)
(40)
(41)
(42)
(43)
(44)
(45)
(46)
(47)
(48)
(49)
(50)
(51)
(52)
(53)
(54)
(55)
(56)
(57)
(58)
(59)
(60)
(61)
(62)
(63)
(64)
(65)
(66) 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.
DETAILED DESCRIPTION
(67) 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.
(68) 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.
(69) 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.
Topological Constraint and Structural Design
(70) 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.
(71) 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: 1) Two non-parallel prismatic joints and a revolute joint (an axis of the revolute joint is perpendicular to moving directions of the two prismatic joints). 2) A prismatic joint and two parallel revolute joints (axes of the revolute joints are perpendicular to moving direction of the prismatic joint). 3) Three parallel revolute joints.
(72) The general translational displacement subgroup can be generated by: 1) A prismatic joint, P. 2) A parallelogram joint, Pa, namely, four parallel revolute joints are connected in a parallelogram in a closed-loop form. 3) Two parallel revolute joints, RR.
(73) Thus, there are three types of structural combinations for the subchain design for a 3-DOF TPM, namely: 1) Subchain Pl-P: A planar joint with a prismatic joint (a direction of the prismatic joint is not perpendicular to a normal of the planar joint). 2) Subchain Pl-Pa: A planar joint with a parallelogram joint (axes of the revolute joints of the parallelogram joint are not parallel to a normal of the planar joint). 3) Subchain Pl-RR: A planar joint with two parallel revolute joint (axes of the two parallel revolute joints are not parallel to a normal of the planar joint).
(74) 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.
(75) 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.
Four General Structures of 3-DOF TPMs
(76) In
(77)
where Z.sub.m represents the output motions of the movable platform. {T(n.sub.i)}, {T(K.sub.i)} and {T} respectively represent a translation along vector n.sub.i, two translations in plane K.sub.i and three orthogonal translations. {R(n.sub.i)} represents a rotation around the vector n.sub.i. 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 K.sub.1, K.sub.2 and K.sub.3) in the three planar displacement subgroups. The 3Pl-P TPM has moving actuators.
(78) 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
(79) 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 (
(80)
(81) 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 P.sub.0 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
(82) Although the star 3P-RPaR TPM illustrated in
(83) In
(84)
(85) Three non-parallel rotations are eliminated by the triangular pyramidal constraint. In one example, the prismatic joint P.sub.0 of each subchain (the joints R.sub.1, P.sub.1, R.sub.2 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:
(86)
where {E} is a fixed displacement subgroup. There are no output motions between the three parallel subchains R.sub.1P.sub.1R.sub.2 when the actuators of the three prismatic joints P.sub.0 are locked.
(87) By arbitrarily assuming that two of the actuators are locked, the intersection operation of the displacement subsets between the remaining structures is expressed as:
(88)
where {T({right arrow over (O.sub.mO.sub.f2)})} is a translational output motion of the movable platform along the intersection line {right arrow over (O.sub.mO.sub.f2)} of the planes K.sub.2 and K.sub.3. Similarly, if one of the actuators is locked, the output motions of the movable platform are:
(89)
where {T(K.sub.3)} represents two translational outputs in the plane K.sub.3. Thus, the three linear input motions of the manipulator are decoupled. They correspond to the three output motions of the movable platform, respectively.
(90) 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 R.sub.3 is parallel to a moving direction of the prismatic joint P.sub.1. Equivalently, joint P.sub.1 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 Grler-Kutzbach criterion. Based on displacement group theory, the additional three non-parallel rotations (R.sub.3) 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.
(91) In some examples, the manipulator illustrated in
(92) 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.
Inverse and Forward Position Solutions
(93) The inverse and forward position solutions of the manipulator illustrated in
l.sub.i+g.sub.i=r.sub.O+r.sub.i+h.sub.i(7)
where the vectors are defined as:
(94)
Thus, the vector h.sub.i can be deduced and expressed as:
(95)
(96) In accordance with the structural constraint condition, namely the intersection angle between the variable vectors l.sub.i and h.sub.i is the constant .sub.i the corresponding kinematic constraint equation can be obtained by a dot product of l.sub.i and h.sub.i as
(97)
To solve Eq. (10) with respect to unknown parameter l.sub.i, an inverse position solution of the manipulator can be defined as:
l.sub.i=r.sub.i+x cos .sub.i+y sin .sub.icot .sub.i{square root over ((x sin .sub.iy cos .sub.i).sup.2+(g.sub.i+z).sup.2)}(11)
where the symbol is selected as + for a larger value of l.sub.i, because l.sub.i is a non-negative number, and initial positions of the slide blocks are placed outward from the symmetric center point O.sub.m.
(98) 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:
(99)
(100) 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
(101) 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 l.sub.i.sub.min, l.sub.i.sub.max, h.sub.i.sub.min, h.sub.i.sub.max, .sub.i,min and .sub.i,max. Numerical forward position solutions, based on Eq. (12), of the manipulator in eight configurations are listed in Table 2.
(102) TABLE-US-00001 TABLE 1 Structural parameters of the Manipulator Parameter Value Parameter Value Parameter Value .sub.1 90 g.sub.i 600 mm h.sub.i.sub.min 1800 mm .sub.2 210 r.sub.i 215 mm h.sub.i.sub.max 900 mm .sub.3 330 l.sub.i.sub.min 600 mm .sub.i, min 60 .sub.i 45 l.sub.i.sub.max 1800 mm .sub.i, max 60
(103) TABLE-US-00002 TABLE 2 Forward position solutions of the Manipulator Config- uration l.sub.1, l.sub.2, l.sub.3 (mm) x (mm) y (mm) z (mm) Solutions 1 800, 800, 800 0 0 1185 1 0 0 15 2 2 900, 1000, 1100 61.58 98.14 1380.7 1 61.58 98.14 180.7 2 3 1000, 1150, 1200 30.8 113.36 1498 1 30.8 113.36 297.8 2 4 1150, 1300, 1250 30.08 81.91 1616 1 30.08 81.91 416.5 2 5 1350, 1400, 1200 113.89 30.6 1699 1 113.89 30.6 498.5 2 6 1500, 1450, 1250 110.8 99.49 1780 1 110.8 99.49 580.3 2 7 1550, 1400, 1500 56.25 66.93 1867 1 56.25 66.93 666.8 2 8 1600, 1600, 1600 0 0 1985 1 0 0 785 2
(104) In Table 2, the eight configurations, defined by l.sub.1, l.sub.2, l.sub.3, 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 l.sub.1, l.sub.2, l.sub.3, 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 B.sub.1B.sub.2B.sub.3. 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
Workspace Evaluation
(105) The workspace of the manipulator illustrated in
(106) In this example, during continuous motions of the movable platform, the two parallel revolute joints R.sub.i,1, R.sub.i,2 of each subchain are passive joints. Furthermore, vector h.sub.i has the same intersection angles with vector g.sub.i and the axis z.sub.m, where the vector g.sub.i is always parallel to the axis z.sub.m since there are no rotational outputs on the movable platform. Thus, the rotational angles .sub.i,u, .sub.i,d of the two parallel revolute joints of each subchain are equal. The angles .sub.i,u, .sub.i,d can be determined by the closed-loop constraint as:
(107)
(108) The translational displacements l.sub.i (P.sub.i,0) and h.sub.i (P.sub.i,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:
(109)
(110) 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 O.sub.f-x.sub.fy.sub.fz.sub.f, 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 O.sub.f-x.sub.fy.sub.fz.sub.f, 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.
(111) 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
(112) Among all the basic structural constants .sub.i, .sub.i, g.sub.i and r.sub.i, .sub.i determines a symmetric property of the workspace, variations of g.sub.i and r.sub.i can only change a size of the workspace (instead of the shape of the workspace), because the different lengths of the g.sub.i and r.sub.i 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 .sub.i determines the inclination of the triangular pyramidal constraint that can change the constraint angles between the moving direction of joint P.sub.i,1, and the axes of joints R.sub.i,1, R.sub.i,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 .sub.i may have the most significant influence on the workspace.
(113) The variation range of the intersection angle is .sub.i(0,90). In
Velocity and Load Jacobian Analysis
(114) 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 66 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 66 overall Jacobian matrix, respectively. Based on the theory of reciprocal screws, the Jacobian of constraints and actuations are analyzed as follows.
(115) 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 O.sub.f-x.sub.fy.sub.fz.sub.f as:
(116)
(117) 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 $.sub.Om of the movable platform is a linear combination of the five instantaneous twists of the joints, namely:
$.sub.Om=[.sup.Tv.sup.T].sup.T={dot over (l)}.sub.i{circumflex over ($)}.sub.i,1+{dot over ()}.sub.i,u{circumflex over ($)}.sub.i,2+{dot over (h)}.sub.i{circumflex over ($)}.sub.i,3+{dot over ()}.sub.i,d.sub.i,4+{dot over ()}.sub.i,c{dot over ($)}.sub.i,5(17)
where {circumflex over ($)}.sub.i,j (i=1, 2, 3, j=1, 2, 3, 4, 5) is a unit screw associated with the j.sup.th joint of the i.sup.th subchain. {dot over (l)}.sub.i, {dot over ()}.sub.i,u, {dot over (h)}.sub.i, {dot over ()}.sub.i,d, and {dot over ()}.sub.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.
(118) In
(119)
where l.sub.i can be obtained from Eq. (11). Thus, the unit screws {circumflex over ($)}.sub.i,j of Eq. (17) are:
(120)
(121) In accordance with the theory of reciprocal screws, a reciprocal screw $.sub.a$.sub.b is that the wrench $.sub.a has no work along the twist of $.sub.b. In each subchain of the manipulator, a unit constraint screw {circumflex over ($)}.sub.i,c is reciprocal to all joint screws (instantaneous twist $.sub.Om of the movable platform). The wrench {circumflex over ($)}.sub.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 ($)}.sub.i,c can be identified as an infinite-pitch wrench screw, namely:
(122)
which represents a unit couple of constraints imposed by the joints of the i.sup.th subchain, and the couple is exerted on the movable platform around the direction of the unit constraint vector k.sub.i,c. The constraint vector, k.sub.i,c is perpendicular to the unit vectors s.sub.i,2 and s.sub.i,3. The reciprocal product of the unit constraint screw {circumflex over ($)}.sub.i,c and of the instantaneous twist on $.sub.Om is:
(123)
where the reciprocal matrix is
(124)
(125) 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:
(126)
where k.sub.i,c is determined in Eq. (16). Each row of J.sub.c 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.
(127) If J.sub.c is of full rank, the unique solution for J.sub.i,c$.sub.Om=0 (Eq. (26) is =0. Thus, based on Eqs. (17) and (20)-(24), a constraint equation can be obtained as:
{dot over ()}.sub.i,us.sub.i,2+{dot over ()}.sub.i,ds.sub.i,4+{dot over ()}.sub.i,cs.sub.i,5=0(29)
Since s.sub.i,2=s.sub.i,4s.sub.i,50, thus, Eq. (29) can be deduced as:
(128)
namely, stating that rotational angles of joints and R.sub.i,1 and R.sub.i,2 are equal, and that the added revolute joint R.sub.i,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.
(129) By assuming that the actuated joint (P.sub.i,0) in each subchain is locked, a unit actuation screw {circumflex over ($)}.sub.i,a is reciprocal to all passive joint (R.sub.i,1P.sub.i,1R.sub.i,2R.sub.i,3) screws of the i.sup.th subchain. The wrench of {circumflex over ($)}.sub.i,a has no work on all passive joints but the actuated joint. Thus, the unit actuation screw {circumflex over ($)}.sub.i,a can be identified as a zero-pitch screw along the direction of the unit actuation vector k.sub.i,a i.e.:
(130)
which represents a unit force of actuation imposed by the actuated joint of the i.sup.th subchain that is exerted on the movable platform along the direction of the unit actuation vector k.sub.i,a. The vector k.sub.i,a is perpendicular to the unit vectors s.sub.i,3 and passes through the axes of joints R.sub.i,1 and R.sub.i,2. The reciprocal product of the unit actuation screw {circumflex over ($)}.sub.i,a and of the instantaneous twist $.sub.Om is:
(131)
(132) 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)}.sub.i of the actuator. By considering the motions of the three subchains, the Jacobian of actuations assumes the form:
(133)
where the last three columns are dimensionless, while the first three columns are related to the length of r.sub.i. 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:
(134)
(135) 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:
(136)
(137) Thus, the 66 overall Jacobian matrix of the manipulator is given by:
(138)
which includes all of the basic constraints and actuations of the manipulator.
(139) 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:
(140)
where the directions of the three input forces f.sub.1,a, f.sub.2,a and f.sub.3,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.sub.f.sup.TO.sub.m=f.sub.a.sup.Tl(39)
where the virtual linear displacements of the actuators and of the movable platform are:
(141)
(142) In accordance with the differential motions and the Jacobian matrix of velocities, the relationships between the input-output virtual displacements are:
l=JO.sub.m(41)
By substituting Eq. (25) into Eq. (23), the relationships between the input-output forces can be obtained as:
f.sub.f=J.sup.Tf.sub.a(42)
where J.sup.T is the Jacobian matrix of loads that can be used to evaluate the static forces of the linear actuators.
Singularity Analysis
(143) In the motions of the manipulator illustrated in
(144) In the structural design of the manipulator with the three inclined planar displacement subsets (.sub.i(0,90)), a unique singularity pose is encountered when the three vectors h.sub.i 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 P.sub.1,1, P.sub.2,1, P.sub.3,1 are parallel to a common plane x.sub.mO.sub.my.sub.m as shown in
(145) In the forward kinematic singularity, the structure gains an additional instantaneous DOF. If the three linear actuators P.sub.1,0, P.sub.2,0, P.sub.3,0 are locked, an instantaneous translational motion of the movable platform still exists along the axis z.sub.m, because the constraint planes K.sub.1, K.sub.2, K.sub.3 of the three subchains' inclined planar displacement subsets are perpendicular to the common plane x.sub.mO.sub.my.sub.m instantaneously (det(J.sub.Om)=0). This is an uncontrollable DOF of the structure in the forward kinematic singularity configuration.
(146) In the manipulator illustrated in
Isotropy Analysis
(147) 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.sup.TJ.sup.1)))}(43)
where Max((J.sup.T J.sup.1)) denotes the largest eigenvalues of the matrix J.sup.T J.sup.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:
(148)
which can be considered as the isotropy conditions for an isotropic manipulator. In accordance with Eq. (45), three vectors J.sub.1, J.sub.2 and J.sub.3 should be perpendicular to one another in the isotropic configurations. Thus, the moving directions of the three actuated prismatic joints P.sub.1,0, P.sub.2,0, P.sub.3,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
Dexterity Analysis
(149) 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 JJ.sup.T as:
m={square root over (det(JJ.sup.T))}(46)
(150) 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.
(151) As an example, based on Eq. (46) and the structural parameters in Table 1, the kinematic manipulability distribution can be obtained as shown in
(152) 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
Stiffness Analysis of a Subchain
(153) 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.
(154) 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 ($)}.sub.i,a imposes an actuation force f.sub.i,a at point C.sub.i of the movable platform along the directions of k.sub.i,a, while the constraint screw {circumflex over ($)}.sub.i,c exerts a constraint couple M.sub.i,c at point C.sub.i of the movable platform around the direction of k.sub.i,c as shown in
(155) In
(156) Tensional and compressional stiffnesses (along the direction of vector h.sub.i) do not exist in the prismatic joint P.sub.i,1 because P.sub.i,1 is a passive joint, and the actuation force f.sub.i,a is perpendicular to the vector h.sub.i. Similarly, there is no torsional compliance around the vector h.sub.i since the direction of the constraint couple M.sub.i,c is perpendicular to the vector h.sub.i, and {dot over ()}.sub.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
(157) In the case of lead screw in the i.sup.th subchain, the torque .sub.i,a of the actuator can be expressed as:
.sub.i,a=K.sub.i,a.sub.i,a(47)
where K.sub.i,a and .sub.i,a represent the torsional stiffness and angular deformation of the actuator. By considering the torque transmission of the lead screw, the actuation force f.sub.i,al is acting on the slide block A.sub.iB.sub.i and along the guide member O.sub.fG.sub.i, which can be deduced as:
(158)
where d.sub.i,a and L.sub.i,a represent the pitch diameter and lead of the lead screw respectively. .sub.i,a and .sub.i,a are the lead angle and the friction angle of the lead screw respectively, while .sub.i,t and .sub.i,c are the radial angle of the thread and the coefficient of friction between the screw and nut. In
l.sub.i=L.sub.i,a.sub.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:
(159)
(160) In
(161)
where .sub.i,GOf is the angular deformation of the guide member O.sub.fG.sub.i, l.sub.i.sub.min and l.sub.i.sub.max represent the moving range of the slide block A.sub.iB.sub.i, E is Young's modulus of elasticity, and I.sub.ik,GOf is the moment of inertia of the guide member O.sub.f G.sub.i along the direction k.sub.i,c.
(162) In the slide block A.sub.iB.sub.i, the angular deformation (around k.sub.i,c) that is induced by the constraint couple M.sub.i,c can be decomposed into .sub.i,AB (perpendicular to the vector g.sub.i for the bending stiffness) and .sub.i,ABt (around the vector g.sub.i for the torsional stiffness). Thus, the bending and torsional compliances of the slide block A.sub.iB.sub.i can be respectively represented by:
(163)
where G is the shear modulus of elasticity, I.sub.ik,AB and I.sub.ip,AB are the moment of inertia and polar moment of inertia of the slide block A.sub.iB.sub.i, respectively.
(164) Similarly, the bending compliances of B.sub.iH.sub.i,m, H.sub.i,mH.sub.i and H.sub.iC.sub.i can be respectively determined as:
(165)
(166) The bending compliance of link C.sub.iO.sub.m is:
(167)
(168) 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:
(169)
(170) 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.
Stiffness Matrix Determination of the Manipulator
(171) 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:
(172)
which can be expressed as an output wrench w.sub.f=[f.sub.f.sup.T M.sub.f.sup.T].sup.T. In the fixed reference frame O.sub.f-x.sub.fy.sub.fz.sub.f, the infinitesimal translational and rotational deformations of the movable platform caused by w.sub.f are:
O.sub.m=[x.sub.Omy.sub.Omz.sub.Om.sub.xf.sub.yf.sub.zf].sup.T(62)
(173) The input force and torque that are caused by actuations and constraints of the three subchains can be respectively expressed as:
(174)
(175) 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:
(176)
(177) By applying the principle of virtual work to the overall structure, the relations of the input-output force and torque become:
(178)
where the input force f.sub.al of the actuators and torque M.sub.c of the constraints are respectively determined by the equivalent stiffness of the three subchains in Eqs. (59) and (60) as:
(179)
(180) By substituting Eq. (67) and (68) into Eq. (66), the output force and torque of the movable platform is obtained:
(181)
(182) Thus, the 66 stiffness matrix of the manipulator can be deduced from Eq. (69) and becomes:
(183)
(184) 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.
Stiffness Evaluation
(185) 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.
(186) 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.
(187) 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 O.sub.f-z.sub.fy.sub.fz.sub.f. The structural and physical parameters are listed in Tables 1 and 3, respectively.
(188) TABLE-US-00003 TABLE 3 Physical Parameters of the Manipulator Parameter Value Parameter Value K.sub.i, a 2.5 10.sup.9 Nmm/rad I.sub.ik, GOf 4.22 10.sup.4 mm.sup.4 L.sub.i, a 6.5 mm I.sub.ik, AB 2.12 10.sup.4 mm.sup.4 d.sub.i, a 31.5 mm I.sub.ip, AB 6.45 10.sup.4 mm.sup.4 .sub.i, t 14.5 I.sub.ik, BH 2.53 10.sup.4 mm.sup.4 .sub.i, c 0.2 I.sub.ik, HH 3.21 10.sup.4 mm.sup.4 E 2.03 10.sup.5 Mpa I.sub.ik, HC 2.36 10.sup.4 mm.sup.4 G 7.85 10.sup.4 Mpa I.sub.ik, COm 1.78 10.sup.4 mm.sup.4 h.sub.i, u 900 mm h.sub.i, d 900 mm
(189) In
(190) Among all the basic structural constants .sub.i, .sub.i, g.sub.i, r.sub.i, h.sub.i,u and h.sub.i,d, .sub.i determines the symmetric property of the structure, while the variations of g.sub.i, r.sub.i, h.sub.i,u and h.sub.i,d can only change the size of the workspace (instead of the shape of the workspace), because the different lengths of g.sub.i, r.sub.i, h.sub.i,u and h.sub.i,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 .sub.i determines the constraint angles between the moving direction of joint P.sub.i,1 and the axes of joints R.sub.i,1, R.sub.i,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 .sub.i has the most significant influence on the structure.
(191) The variation range of the intersection angle is .sub.i(0,90). In
(192) 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 66 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.
(193) 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 66 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.
(194) Referring now to
(195) 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.
(196) The stiffness model of the manipulator illustrated in
Structural Design
(197) 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.
(198) As shown in
(199)
where the output motions Z.sub.m of the movable platform are three orthogonal translations {T}. The actuated joint can be chosen as the prismatic joints P.sub.i,0 of each subchain (the remaining joints R.sub.i,1R.sub.i,1R.sub.i,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 P.sub.0 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.
(200) The manipulator illustrated in
(201) 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.
Kinematic Position Solutions
(202) 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.
(203) In
l.sub.i=r.sub.O+r.sub.i+h.sub.i(72)
where the constituent vectors are defined as:
(204)
Thus, the vector h.sub.i can be deduced as:
(205)
(206) In accordance with the structural constraint condition, namely the intersection angle between variable vectors n.sub.i and h.sub.i is constant .sub.i, the corresponding kinematic constraint equation can be obtained by the dot product of n.sub.i and h.sub.i as:
(207)
(208) To solve Eq. (75) with respect to the unknown parameter l.sub.i, the inverse kinematic position solution of the manipulator can be obtained as:
(209)
where E.sub.Ai and E.sub.Bi are:
(210)
(211) In Eq. (76), the symbol is set to + for the larger value because the l.sub.i is a non-negative number, and the initial positions of slide blocks are placed outward from the symmetric center point O.sub.m.
(212) 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 l.sub.i are given. Based on the kinematic position solutions, the overall Jacobian matrix will be developed in the next section for stiffness modeling.
Overall Jacobian Matrix
(213) 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 66 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 66 overall Jacobian matrix, respectively. Based on the theory of reciprocal screws, the Jacobian of constraints and actuations are analyzed as follows.
(214) 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 O.sub.f-x.sub.fy.sub.fz.sub.f as:
(215)
(216) Based on the closed-loop constraint of each subchain in Eq. (72), the instantaneous twist $.sub.Om, of the movable platform is a linear combination of the four instantaneous twists of the joints, namely:
$.sub.Om=[.sup.Tv.sup.T].sup.T={dot over (l)}.sub.i{circumflex over ($)}.sub.i,1+{dot over ()}.sub.i,u{circumflex over ($)}.sub.i,2+{dot over (h)}.sub.i{circumflex over ($)}.sub.i,3+{dot over ()}.sub.i,d{circumflex over ($)}.sub.i,4(79)
where {circumflex over ($)}.sub.i,j (i=1, 2, 3, j=1, 2, 3, 4) is a unit screw associated with the j.sup.th joint of the i.sup.th subchain. {dot over (l)}.sub.i, {dot over ()}.sub.i,u, {dot over (h)}.sub.i and {dot over ()}.sub.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.
(217) In
(218)
where l.sub.i can be obtained from Eq. (76). Thus, the unit screws {circumflex over ($)}.sub.i,j of Eq. (79) are:
(219)
(220) In accordance with the theory of reciprocal screws, a reciprocal screw $.sub.a $.sub.b is that the wrench $.sub.a has no work along the twist of $.sub.b. In each subchain of the manipulator, a unit constraint screw {circumflex over ($)}.sub.i,c, is reciprocal to all joint screws (instantaneous twist $.sub.Om of the movable platform). The wrench {circumflex over ($)}.sub.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 ($)}.sub.i,c can be identified as an infinite-pitch wrench screw, namely:
(221)
which represents a unit couple of constraints imposed by the joints of the i.sup.th subchain, and the couple is exerted on the movable platform around the direction of the unit constraint vector k.sub.i,c. The constraint vector k.sub.i,c, is perpendicular to the unit vectors s.sub.i,2 and s.sub.i,3. The reciprocal product of the unit constraint screw {circumflex over ($)}.sub.i,c and of the instantaneous twist $.sub.Om is:
{circumflex over ($)}.sub.i,c$.sub.Om=({circumflex over ($)}.sub.i,c).sup.T$.sub.Om=J.sub.i,c$.sub.Om=0(88)
where the transformation matrix is
(222)
(223) 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:
(224)
where k.sub.i,c is determined in Eq. (87). Each row of J.sub.c 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.
(225) If J.sub.c is of full rank, the unique solution for J.sub.i,c$.sub.Om=0 (Eq. (88)) is =0. Thus, based on Eqs. (79) and (83)-(86), a constraint equation can be obtained as:
{dot over ()}.sub.i,us.sub.i,2+{dot over ()}.sub.i,ds.sub.i,4=0(91)
Since s.sub.i,2=s.sub.i,40, thus, Eq. (91) can be deduced as:
{dot over ()}.sub.i,u+{dot over ()}.sub.i,d=0(92)
stating that the magnitudes of the rotational angles of joints R.sub.i,1 and R.sub.i,2 are equal.
(226) By assuming that the actuated joint (P.sub.i,0) in each subchain is locked, a unit actuation screw {circumflex over ($)}.sub.i,a is reciprocal to all passive joint (R.sub.i,1P.sub.i,1R.sub.i,2) screws of the i.sup.th subchain. The wrench of {circumflex over ($)}.sub.i,a has no work on all passive joints but the actuated joint. Thus, the unit actuation screw {circumflex over ($)}.sub.i,a can be identified as a zero-pitch screw along the direction of the unit actuation vector k.sub.i,a, i.e.:
(227)
which represents a unit force of actuation imposed by the actuated joint of the i.sup.th subchain that is exerted on the movable platform along the direction of the unit actuation vector k.sub.i,a. The vector k.sub.i,a is perpendicular to the unit vectors s.sub.i,3 and passes through the axes of joints R.sub.i,1 and R.sub.i,2. The reciprocal product of the unit actuation screw {circumflex over ($)}.sub.i,a and of the instantaneous twist $.sub.Om is:
{circumflex over ($)}.sub.i,a$.sub.Om=({circumflex over ($)}.sub.i,a).sup.T$.sub.Om={dot over (l)}.sub.icos .sub.i={dot over (l)}.sub.ik.sub.i,a.sup.Ts.sub.i,1(94)
where .sub.i is intersection angle between k.sub.i,a and s.sub.i,1. Eq. (94) can be transformed as:
(228)
(229) 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)}.sub.i of the actuator. By considering the motions of the three subchains, the Jacobian of actuations assumes the form:
(230)
(231) 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:
(232)
Thus, the 66 overall Jacobian matrix of the manipulator is given by:
(233)
which is a 66 transformation matrix including all of the basic constraints and actuations of transformation between all joints motions and output motions of the movable platform.
Stiffness Analysis of a Subchain
(234) 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 ($)}.sub.i,a imposes an actuation force f.sub.i,a at point C.sub.i of the movable platform along the directions of k.sub.i,a, while the constraint screw {circumflex over ($)}.sub.i,c exerts a constraint couple M.sub.i,c at point C.sub.i of the movable platform around the direction of k.sub.i,c as shown in
(235) In
(236) (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 C.sub.i,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.
(237) (2) In the guide member O.sub.fG.sub.i, a bending spring is used to represent the stiffness of the part of the fixed platform. The corresponding compliance is C.sub.i,GOf.
(238) (3) In the prismatic joint P.sub.i,1, the guide member and the slide block have different bending stiffnesses. Thus, the equivalent spring between the points A.sub.i and B.sub.i can be separated into three parts, namely guide member A.sub.iH.sub.i,m, slide block H.sub.iB.sub.i and H.sub.i,mH.sub.i (overlapping part between the guide member and the slide block). The compliances of A.sub.iH.sub.i,m, H.sub.iB.sub.i and H.sub.i,mH.sub.i are denoted as C.sub.i,AH, C.sub.i,HB and C.sub.i,HH, respectively.
(239) (4) In the link B.sub.iO.sub.m, a bending spring is used to represent the stiffness of the part of the movable platform. The compliance of the link is denoted as C.sub.i,BOm.
(240) Tensional and compressional stiffnesses (along the direction of vector h.sub.i) do not exist in the prismatic joint P.sub.i,1 because P.sub.i,1 is a passive joint, and the actuation force f.sub.i,a is perpendicular to the vector h.sub.i. Similarly, there is no torsional compliance around the vector h.sub.i since the direction of the constraint couple M.sub.i,c is perpendicular to the vector h.sub.i. 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
(241) In the case of lead screw in the i.sup.th subchain, the torque .sub.i,a of the actuator can be expressed as:
.sub.i,a=K.sub.i,a.sub.i,a(99)
where K.sub.i,a and .sub.i,a represent the torsional stiffness and angular deformation of the actuator. By considering the torque transmission of the lead screw, the actuation force f.sub.i,al is acting on the slide block and along the guide member O.sub.fG.sub.i, which can be deduced as:
(242)
where d.sub.i,a and L.sub.i,a represent the pitch diameter and lead of the lead screw respectively. .sub.i,a and .sub.i,a are the lead angle and the friction angle of the lead screw respectively, while .sub.i,t and .sub.i,c are the radial angle of the thread and the coefficient of friction between the screw and nut. In
l.sub.i=L.sub.i,a.sub.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:
(243)
(244) In
(245)
where .sub.i,GOf is the angular deformation of the guide member O.sub.fG.sub.i, l.sub.i.sub.min and l.sub.i.sub.max represent the moving range of the slide block, E is Young's modulus of elasticity, and I.sub.ik,GOf is the cross section moment of inertia of guide member O.sub.fG.sub.i around the direction k.sub.i,c.
(246) In the joint P.sub.i,1, the bending compliances of A.sub.iH.sub.i,m, H.sub.i,mH.sub.i and H.sub.iB.sub.i can be respectively determined as:
(247)
(248) The bending compliance of link B.sub.iO.sub.m is:
(249)
(250) 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:
(251)
(252) 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.
Stiffness Matrix Determination of the Manipulator
(253) 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:
(254)
which can be expressed as an output wrench w.sub.f=[f.sub.f.sup.T M.sub.f.sup.T].sup.T. In the fixed reference frame O.sub.f-x.sub.fy.sub.fz.sub.f, the infinitesimal translational and rotational deformations of the movable platform caused by w.sub.f are:
O.sub.m=[x.sub.Omy.sub.Omz.sub.Om.sub.xf.sub.yf.sub.zf].sup.T(112)
(255) The input force and torque that are caused by actuations and constraints of the three subchains can be respectively expressed as:
(256)
(257) 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:
(258)
(259) By applying the principle of virtual work to the overall structure, the relations of the input-output force and torque become:
(260)
where the input force f.sub.al of the actuators and torque M.sub.c of the constraints are respectively determined by the equivalent stiffness of the three subchains in Eqs. (109) and (110) as:
(261)
(262) By substituting Eq. (117) and (118) into Eq. (116), the output force and torque of the movable platform is obtained:
(263)
(264) Thus, the 66 stiffness matrix of the manipulator can be deduced from Eq. (119) and becomes:
(265)
(266) 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.
Workspace Evaluation
(267) 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 O.sub.m of the movable platform in the fixed reference frame O.sub.f-x.sub.fy.sub.fz.sub.f. 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.
(268) In accordance with Eq. (92), the rotational angles .sub.i,u and .sub.i,d of the two parallel revolute joints are equal as determined by the closed-loop constraint as:
(269)
where
{right arrow over (A.sub.iC.sub.i)}={right arrow over (O.sub.fO.sub.i)}{right arrow over (O.sub.fA.sub.i)}=r.sub.O+{right arrow over (O.sub.mC.sub.i)}l.sub.i=r.sub.O+r.sub.i+h.sub.icos .sub.i[111].sup.Tl.sub.i(122)
(270) The translational displacements l.sub.i (P.sub.i,0) and h.sub.i (P.sub.i,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:
(271)
(272) 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 O.sub.f-x.sub.fy.sub.fz.sub.f, 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 O.sub.f-x.sub.fy.sub.fz.sub.f, a set of points is obtained. The 3D arrangement of all these points constitutes the reachable workspace of the manipulator.
(273) 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
(274) TABLE-US-00004 TABLE 4 Structural Parameters of the Manipulator Parameter Value Parameter Value .sub.1 90 l.sub.i.sub.min 400 mm .sub.2 210 l.sub.i.sub.max 1250 mm .sub.3 330 h.sub.i.sub.min 600 mm .sub.Pi 35 h.sub.i.sub.max 1200 mm .sub.Ri 35 .sub.i, min 90 .sub.i 30 .sub.i, max 90 r.sub.i 100 mm
Stiffness Evaluation
(275) 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.
(276) 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.
(277) 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 O.sub.f-x.sub.fy.sub.fz.sub.f. The structural and physical parameters are listed in Tables 4 and 5, respectively.
(278) TABLE-US-00005 TABLE 5 Physical parameters of the Manipulator Parameter Value Parameter Value K.sub.i, a 2.5 10.sup.9 Nmm/rad I.sub.ik, GOf 4.22 10.sup.4 mm.sup.4 L.sub.i, a 6.5 mm I.sub.ik, AH 2.53 10.sup.4 mm.sup.4 d.sub.i, a 31.5 mm I.sub.ik, HH 3.21 10.sup.4 mm.sup.4 .sub.i, t 14.5 I.sub.ik, HB 2.36 10.sup.4 mm.sup.4 .sub.i, c 0.2 I.sub.ik, BOm 1.78 10.sup.4 mm.sup.4 E 2.03 10.sup.5 Mpa h.sub.i, u 600 mm h.sub.i, d 400 mm
(279) In
(280) Among all the basic structural constants .sub.i, .sub.Pi, .sub.Ri, .sub.i, r.sub.i, h.sub.i,u and h.sub.i,d, .sub.i determines the symmetric property of the structure and workspace, while the variations of r.sub.i, h.sub.i,u and h.sub.i,d can change the size of the workspace (instead of the shape of the workspace), because the different lengths of r.sub.i, h.sub.i,u and h.sub.i,d have no influence on the constraint angles between the axes of all of the joints. In the three subchains, the intersection angles .sub.Pi, .sub.Ri and .sub.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 .sub.i will be considered while assuming that the other variables are constants.
(281) During the linear actuation of P.sub.i,0, in order to actuate the passive motion of joint P.sub.i,1, joint P.sub.i,1 cannot be parallel or perpendicular to P.sub.i,0. Thus, the variation range of the intersection angle is .sub.i(0,((/2)|.sub.Ri|)) In
(282) 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 66 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.
(283) 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 66 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.
(284) Referring now to
(285) With continued reference to
(286) 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.
(287) 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).
(288) 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.
(289) 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.