TRANSLATIONAL PARALLEL MANIPULATORS AND METHODS OF OPERATING THE SAME

Information

  • Patent Application
  • 20160158934
  • Publication Number
    20160158934
  • Date Filed
    February 10, 2016
    8 years ago
  • Date Published
    June 09, 2016
    8 years ago
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.
Description
FIELD OF THE INVENTION

The present disclosure generally relates to manipulators and, more particularly, to translational parallel manipulators.


BACKGROUND

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.


SUMMARY

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.





BRIEF DESCRIPTION OF THE DRAWINGS

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.



FIG. 1 is a bottom perspective view of one example of a translational parallel manipulator, in accordance with one aspect of the present disclosure.



FIG. 2 is a top perspective view of a portion of the manipulator shown in FIG. 1, in accordance with one aspect of the present disclosure.



FIG. 3 is top perspective view of the manipulator shown in FIG. 1, in accordance with one aspect of the present disclosure.



FIG. 4 is a top perspective view of the manipulator shown in FIG. 1 illustrating examples of structural parameters of the manipulator, in accordance with one aspect of the present disclosure.



FIG. 5 is a bottom perspective of another example of a translational parallel manipulator, in accordance with one aspect of the present disclosure.



FIG. 6 is a top perspective view of a portion of the manipulator shown in FIG. 5, in accordance with one aspect of the present disclosure.



FIG. 7 is a top perspective view of the manipulator shown in FIG. 5, in accordance with one aspect of the present disclosure.



FIG. 8 is a bottom perspective view of another example of a translational parallel manipulator, in accordance with one aspect of the present disclosure.



FIG. 9 is a top perspective view of a portion of the manipulator shown in FIG. 8, in accordance with one aspect of the present disclosure.



FIG. 10 is a top perspective view of the manipulator shown in FIG. 8, in accordance with one aspect of the present disclosure.



FIG. 11 is a bottom perspective view of another example of a translational parallel manipulator, in accordance with one aspect of the present disclosure.



FIG. 12 is a top perspective view of a portion of the manipulator shown in FIG. 11, in accordance with one aspect of the present disclosure.



FIG. 13 is a top perspective view of the manipulator shown in FIG. 11, in accordance with one aspect of the present disclosure.



FIG. 14 is a bottom perspective view of another example of a translational parallel manipulator, in accordance with one aspect of the present disclosure.



FIG. 15 is a top perspective view of a portion of the manipulator shown in FIG. 14, in accordance with one aspect of the present disclosure.



FIG. 16 is a top perspective view of the manipulator shown in FIG. 14, in accordance with one aspect of the present disclosure.



FIG. 17 is a diagram illustrating one example of a three-dimensional (3D) workspace associated with the manipulator shown in FIG. 1 with γi equal to 45 degrees, in accordance with one aspect of the present disclosure.



FIG. 18 is a diagram of several x-y cross-sections taken from FIG. 17 at various z values, in accordance with one aspect of the present disclosure.



FIG. 19 is a diagram illustrating another example of a three-dimensional (3D) workspace associated with the manipulator shown in FIG. 1 with γi equal to 30 degrees, in accordance with one aspect of the present disclosure.



FIG. 20 is a diagram of several x-y cross-sections taken from FIG. 19 at various z values, in accordance with one aspect of the present disclosure.



FIG. 21 is a diagram illustrating another example of a three-dimensional (3D) workspace associated with the manipulator shown in FIG. 1 with γi equal to 60 degrees, in accordance with one aspect of the present disclosure.



FIG. 22 is a diagram of several x-y cross-sections taken from FIG. 21 at various z values, in accordance with one aspect of the present disclosure.



FIG. 23 is a top perspective view of another example of a translational parallel manipulator illustrating a forward kinematic singularity, in accordance with one aspect of the present disclosure.



FIG. 24 is a top perspective view of another example of a translational parallel manipulator, in accordance with one aspect of the present disclosure.



FIG. 25 is a diagram of one example of a three-dimensional distribution of kinematic manipulability of one example of a translational parallel manipulator such as the example shown in FIG. 1, in accordance with one aspect of the present disclosure.



FIG. 26 is a diagram of several x-y cross-sections taken from FIG. 25 at various z values, in accordance with one aspect of the present disclosure.



FIG. 27 is a top perspective view of one example of a translational parallel manipulator, such as the manipulator shown in FIG. 1, illustrating examples of loads on the manipulator, in accordance with one aspect of the present disclosure.



FIG. 28 is a top perspective view of a portion of one example of a translational parallel manipulator, such as the manipulator shown in FIG. 1, illustrating one example of an equivalent spring structure of the portion, in accordance with one aspect of the present disclosure.



FIG. 29a is a top perspective view of a portion of one example of a translational parallel manipulator, such as the manipulator shown in FIG. 1, illustrating one example of a deformation of actuation of the portion, in accordance with one aspect of the present disclosure.



FIG. 29b is a top perspective view of a portion of one example of a translational parallel manipulator, such as the manipulator shown in FIG. 1, illustrating one example of deformation of constraints of the portion, in accordance with one aspect of the present disclosure.



FIG. 30a is a diagram of one example of a distribution of a maximum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −1432, in accordance with one aspect of the present disclosure.



FIG. 30b is a diagram of another example of a distribution of a maximum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −1582, in accordance with one aspect of the present disclosure.



FIG. 30c is a diagram of another example of a distribution of a maximum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −1732, in accordance with one aspect of the present disclosure.



FIG. 30d is a diagram of one example of a distribution of a minimum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −1432, in accordance with one aspect of the present disclosure.



FIG. 30e is a diagram of another example of a distribution of a minimum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −1582, in accordance with one aspect of the present disclosure.



FIG. 30f is a diagram of another example of a distribution of a minimum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −1732, in accordance with one aspect of the present disclosure.



FIG. 31a is a diagram illustrating one example of a three-dimensional (3D) workspace associated with a translational parallel manipulator with γi equal to 30 degrees, in accordance with one aspect of the present disclosure.



FIG. 31b is a diagram of one example of a stiffness distribution taken at an x-y section of a maximum eigenvalue at a z value of −1050 (of FIG. 31a) and having γi equal to 30 degrees, in accordance with one aspect of the present disclosure.



FIG. 31c is a diagram of one example of a stiffness distribution taken at an x-y section of a minimum eigenvalue at a z value of −1050 (of FIG. 31 and having γi equal to 30 degrees, in accordance with one aspect of the present disclosure.



FIG. 31d is a diagram illustrating another example of a three-dimensional (3D) workspace associated with a translational parallel manipulator with γi equal to 60 degrees, in accordance with one aspect of the present disclosure.



FIG. 31e is a diagram of one example of a stiffness distribution taken at an x-y section of a maximum eigenvalue at a z value of −1975 (of FIG. 31d) and having γi equal to 60 degrees, in accordance with one aspect of the present disclosure.



FIG. 31f is a diagram of one example of a stiffness distribution taken at an x-y section of a minimum eigenvalue at a z value of −1975 (of FIG. 31d) and having γi equal to 60 degrees, in accordance with one aspect of the present disclosure.



FIG. 32 is a top perspective view of another translational parallel manipulator, in accordance with one aspect of the present disclosure.



FIG. 33 is a top perspective view of a portion of the manipulator shown in FIG. 32, in accordance with one aspect of the present disclosure.



FIG. 34 is a top perspective of the manipulator shown in FIG. 32 illustrating examples of structural parameters of the manipulator, in accordance with one aspect of the present disclosure.



FIG. 35 is a top perspective view of the manipulator shown in FIG. 32 illustrating examples of loads on the manipulator, in accordance with one aspect of the present disclosure.



FIG. 36 is a top perspective view of a portion of the manipulator shown in FIG. 32 illustrating one example of an equivalent spring structure of the portion, in accordance with one aspect of the present disclosure.



FIG. 37a is a top perspective view of a portion of the manipulator shown in FIG. 32 illustrating one example of a deformation of actuation of the portion, in accordance with one aspect of the present disclosure.



FIG. 37b is a top perspective view of a portion of the manipulator shown in FIG. 32 illustrating one example of a deformation of constraints of the portion, in accordance with one aspect of the present disclosure.



FIG. 38 is a diagram illustrating one example of a three-dimensional (3D) workspace associated with the manipulator shown in FIG. 32, in accordance with one aspect of the present disclosure.



FIG. 39 is a diagram of several x-y cross-sections taken from FIG. 38 at various z values, in accordance with one aspect of the present disclosure.



FIG. 40a is a diagram associated with the manipulator shown in FIG. 32 of one example of a distribution of a maximum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −900, in accordance with one aspect of the present disclosure.



FIG. 40b is a diagram associated with the manipulator shown in FIG. 32 of another example of a distribution of a maximum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −1000, in accordance with one aspect of the present disclosure.



FIG. 40c is a diagram associated with the manipulator shown in FIG. 32 of another example of a distribution of a maximum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −1100, in accordance with one aspect of the present disclosure.



FIG. 40d is a diagram associated with the manipulator shown in FIG. 32 of one example of a distribution of a minimum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −900, in accordance with one aspect of the present disclosure.



FIG. 40e is a diagram associated with the manipulator shown in FIG. 32 of another example of a distribution of a minimum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −1000, in accordance with one aspect of the present disclosure.



FIG. 40f is a diagram associated with the manipulator shown in FIG. 32 of another example of a distribution of a minimum eigenvalue of a stiffness matrix at an x-y section taken at a z value of −1100, in accordance with one aspect of the present disclosure.



FIG. 41a is a diagram illustrating another example of a three-dimensional (3D) workspace associated with the manipulator shown in FIG. 32 with γi equal to −40 degrees, in accordance with one aspect of the present disclosure.



FIG. 41b is a diagram of one example of a stiffness distribution taken at an x-y section of a maximum eigenvalue at a z value of −1000 and having γi equal to −40 degrees, in accordance with one aspect of the present disclosure.



FIG. 41c is a diagram of one example of a stiffness distribution taken at an x-y section of a minimum eigenvalue at a z value of −1000 and having γi equal to −40 degrees, in accordance with one aspect of the present disclosure.



FIG. 41d is a diagram illustrating another example of a three-dimensional (3D) workspace associated with the manipulator shown in FIG. 32 with γi equal to −50 degrees, in accordance with one aspect of the present disclosure.



FIG. 41e is a diagram of one example of a stiffness distribution taken at an x-y section of a maximum eigenvalue at a z value of −1000 and having γi equal to −50 degrees, in accordance with one aspect of the present disclosure.



FIG. 41f is a diagram of one example of a stiffness distribution taken at an x-y section of a minimum eigenvalue at a z value of −1000 and having γi equal to −50 degrees, in accordance with one aspect of the present disclosure.



FIG. 42 is a diagram of one example of a control system for one example of a translational parallel manipulator, in accordance with one aspect of the present 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.


DETAILED DESCRIPTION

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.


Topological Constraint and Structural Design

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:

    • 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.


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.


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).


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.


Four General Structures of 3-DOF TPMs

In FIGS. 5-7, one example of a TPM is illustrated. In this example, the manipulator includes a subchain Pl-P having a planar joint and a prismatic joint. The planar joint is configured with two revolute joints and a prismatic joint, namely R1P1R2. A normal of the planar joint is n1. A planar motion {G(n1)} is generated in plane K1, and a Schoenflies motion {X(n1)} can be obtained by connection of a planar joint and of a prismatic joint P0. By combining three subchains Pl-P in a star constraint (the constraint planes K1, K2 and K3 of the subchains are arranged in a star shape), a 3Pl-P TPM is obtained. The intersection operation of the displacement subsets between the subchains is given by:













Z
m

=







i
=
1


3



{

X


(

n
i

)


}








=







i
=
1


3



[


{

G


(

n
i

)


}



{

T


(

n
i

)


}


]








=






3


i
=
1




[


{

R


(

n
i

)


}



{

T


(

K
i

)


}



{

T


(

n
i

)


}


]








=







i
=
1


3



[


{

T


(

K
i

)


}



{

T


(

n
i

)


}


]








=



{
T
}








(
1
)







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 FIGS. 8-10.


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 (FIGS. 11-13). In FIGS. 11-13, axes of joints P0, R1 and R2 are parallel to axis n1. An axis of the parallelogram joint Pa, is perpendicular to the axis n1. A spherical translation {T(S1)} is generated on spherical surface S1 by serial joints R1Pa1R2, where a spherical center and radius are So and Sr respectively. A rotation {R(n1)} is obtained from the parallel joints R1 and R2. Thus, a Schoenflies motion {X(n1)} is generated by the subchain P-RPaR. By combining the three subchains P-RPaR in a star constraint configuration, a 3P-RPaR TPM is obtained. The intersection operation of the displacement subsets between the subchains is:













Z
m

=







i
=
1


3



{

X


(

n
i

)


}








=






3


i
=
1




[


{

R


(

n
i

)


}



{

T


(

S
i

)


}



{

T


(

n
i

)


}


]








=







i
=
1


3



[


{

T


(

S
i

)


}



{

T


(

n
i

)


}


]








=



{
T
}








(
2
)







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 FIGS. 14-16. A size of the movable platform of the star 3P-RPaR may be reduced by the star connection of the guide members, because the movable platform is connected by three revolute joints whose axes intersect at a center point of the movable platform. A size of the movable platform is dependent on the cross-section of the connected revolute joints instead of their longitudinal section. Compared to the triangular 3P-RPaR TPM, a higher load/weight ratio can be achieved in the star 3P-RPaR TPM with a movable platform of smaller size. In other examples, the axes of the three revolute joints may intersect each other at a point of the movable platform other than the center point. In further examples, the axes of the three revolute joints may intersection each other, but not necessarily at the same point.


Although the star 3P-RPaR TPM illustrated in FIGS. 11-13 is designed with fixed actuators and a reduced size of the movable platform, this manipulator includes a large quantity of 1-DOF joints and the input motions are coupled by spherical translations of the parallelogram joints. To reduce the number of joints and decouple the motions of the star 3P-RPaR TPM, a prismatic joint may be used to replace the parallelogram joint in each subchain as illustrated in FIGS. 1-3.


In FIGS. 1-3, prismatic joint P1 connects two parallel revolute joints R1 and R2 with an intersection angle γi. Joints P1, R1 and R2 generate a rotation around axis n1 and two translations in plane K1. Thus, the resulting new displacement subset can be defined as an inclined planar displacement subset {I(n1,K1)} that can be generated by serial joints R1P1R2. The difference between motions of the {I(n1,K1)} and the general planar displacement subgroup {G(n1)} is that the axis of rotation of {I(n1,K1)} is not perpendicular to the moving directions of the two translations. This type of inclined constraint between the rotation and translations can be used for a new structural design of the Schoenflies motion. By combining a prismatic joint P0 with joints R1P1R1 of the inclined planar displacement subset (P0 is not perpendicular to the normal of the plane K1), a new structure of the Schoenflies motion can be obtained as a subchain P-RPR. Three P-RPR subchains can be combined in a closed-loop form, where the three guide members of the joints P0 are connected in a star form. The three constraint planes K1, K2 and K3 of the subchains are arranged in a triangular pyramidal constraint form that intersect at point Om. Consequently, a new 3P-RPR TPM can be obtained. The intersection operation of the displacement subsets between the subchains is:













Z
m

=








i
=
1







3



{

X


(

n
i

)


}








=







i
=
1


3



[


{

I


(


n
i

,

K
i


)


}



{

T


(

n
i

)


}


]








=







i
=
1


3



[


{

R


(

n
i

)


}



{

T


(

K
i

)


}



{

T


(

n
i

)


}


]








=







i
=
1


3



[


{

T


(

K
i

)


}



{

T


(

n
i

)


}


]








=



{
T
}








(
3
)







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:













Z
m

=







i
=
1


3



{

I


(


n
i

,

K
i


)


}








=






3


i
=
1




[


{

R


(

n
i

)


}



{

T


(

K
i

)


}


]








=



{
E
}








(
4
)







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:













Z
m

=




{

X


(

n
1

)


}



{

I


(


n
2

,

K
2


)


}



{

I


(


n
3

,

K
3


)


}








=




[


{

R


(

n
1

)


}



{

T


(

K
1

)


}



{

T


(

n
1

)


}


]













[


{

R


(

n
2

)


}



{

T


(

K
2

)


}


]



[


{

R


(

n
3

)


}



{

T


(

K
3

)


}


]








=




[


{

T


(

K
1

)


}



{

T


(

n
1

)


}


]



{

T


(

K
2

)


}



{

T


(

K
3

)


}








=




{
T
}



{

T


(

K
2

)


}



{

T


(

K
3

)


}








=



{

T


(



O
m



O

f





2





)


}








(
5
)







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:













Z
m

=




{

X


(

n
1

)


}



{

X


(

n
2

)


}



{

I


(


n
3

,

K
3


)


}








=




[


{

R


(

n
1

)


}



{

T


(

K
1

)


}



{

T


(

n
1

)


}


]



[


{

R


(

n
2

)


}



{

T


(

K
2

)


}



{

T


(

n
2

)


}


]












[


{

R


(

n
3

)


}



{

T


(

K
3

)


}


]







=




[


{

T


(

K
1

)


}



{

T


(

n
1

)


}


]



[


{

T


(

K
2

)


}



{

T


(

n
2

)


}


]



{

T


(

K
3

)


}








=




{
T
}



{
T
}



{

T


(

K
3

)


}








=



{

T


(

K
3

)


}








(
6
)







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 FIGS. 1-3 offers a number of features that were achieved as a consequence of overcoming the drawbacks of conventional TPMs. These, satisfying at the same time the design objectives, include, for example:

    • 1) Three identical subchains are designed and arranged symmetrically in a non-Cartesian constraint.
    • 2) All actuators provide linear actuation and are placed on the fixed platform.
    • 3) Only four 1-DOF joints are included in each subchain, no Uor S joints are involved.
    • 4) The movable platform is connected with three revolute joints in a star form. A small size of the movable platform is realized.
    • 5) The three input-output translations are decoupled and the manipulator is a non-over-constrained manipulator. Elimination of the over-constrained mechanism characteristics does not influence the mobility and kinematic properties of the manipulator.
    • 6) The manipulator is singularity free and is characterized by an isotropic configuration (described in more detail below).


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

The inverse and forward position solutions of the manipulator illustrated in FIGS. 1-3 define position relationships between the three linear input motions of actuations and the three translational output motions of the movable platform, to provide the basic constraint relations for the practical position control system. With reference to FIG. 4, a fixed reference frame Of-xfyfzf is placed at a center of the fixed platform and a parallel moving reference frame Om-xmymzm is defined at a center of the movable platform. The guide members OfGi (i=1, 2, 3) of the three linear actuators are perpendicular to axis zf. The guide members are arranged along axis xf with intersection angles α1, α2 and α3, respectively. The prismatic joints and revolute joints Pi,0, Ri,1, Pi,1 and Ri,2 are connected in sequence. The basic structural parameters are αi, γi, ∥gi∥, and where γi is an intersection angle between an axis of Ri,1, and a moving direction of Pi,1, ∥gi∥ represents a size of a slide block between points Ai and Bi which is parallel to the axis zf, while ∥ri∥ is a size of the movable platform between points Om and Ci which is perpendicular to the axis zf. The joint variables of Pi,0, Ri,1, Pi,1 and Ri,2 are ∥li∥, θi,u, ∥hi∥ and θi,d, respectively. The input variables are the lengths of travel ∥li∥ of the linear actuators between points Of and Ai which takes place along the three guide members, while an output variable is a position vector ro (x, y, z) of the movable platform between points Of and Om. In a given subchain, the kinematic constraint of the closed loop is:






l
i
+g
i
=r
o
+r
i
+h
i  (7)


where the vectors are defined as:









{





l
i

=




O
f



A
i




=


[







l
i




cos






α
i








l
i




sin






α
i




0



]

T









g
i

=




A
i



B
i




=





O
f



B
i




-



O
f



A
i





=


[



0


0



-



g
i







]

T










r
O

=




O
f



O
m




=


[



x


y


z



]

T









r
i

=




O
m



C
i




=





O
f



C
i




-



O
f



O
m





=


[







r
i




cos






α
i








r
i




sin






α
i




0



]

T











(
8
)







Thus, the vector hi can be deduced and expressed as:













h
i

=





C
i



B
i










=




l
i

+

g
i

-

r
O

-

r
i








=




[






(




l
i



-



r
i




)


cos






α
i


-
x






(




l
i



-



r
i




)


sin






α
i


-
y





-



g
i




-
z




]

T








(
9
)







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



















l
i

·

h
i


=







l
i





cos







α
i



(



(




l
i



-



r
i




)


cos






α
i


-
x

)



+












l
i




sin







α
i



(



(




l
i



-



r
i




)


sin






α
i


-
y

)









=






l
i







h
i




cos






γ
i








=






l
i











(

(




l
i



-




r
i




cos






α
i


-
x

)

)

2

+








(



(




l
i



-



r
i




)


sin






α
i


-
y

)

2

+


(




g
i



+
z

)

2







cos






γ
i









(
10
)







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:









{








cot






γ
1






(


x





sin






α
1


-

y





cos






α
1



)

2

+


(




g
1



+
z

)

2




+








x





cos






α
1


+

y





sin






α
1


+



r
1



-



l
1




=
0













cot






γ
2






(


x





sin






α
2


-

y





cos






α
2



)

2

+


(




g
2



+
z

)

2




+








x





cos






α
2


+

y





sin






α
2


+



r
2



-



l
2




=
0













cot






γ
3






(


x





sin






α
3


-

y





cos






α
3



)

2

+


(




g
3



+
z

)

2




+








x





cos






α
3


+

y





sin






α
3


+



r
3



-



l
3




=
0











(
12
)







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 FIGS. 1-3, numerical evaluations of Eq. (12) can also be used.


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 ∥limin, ∥limax, ∥himin, ∥himax, θi,min and θi,max. Numerical forward position solutions, based on Eq. (12), of the manipulator in eight configurations are listed in Table 2.









TABLE 1







Structural parameters of the Manipulator












Parameter
Value
Parameter
Value
Parameter
Value





α1
 90°
∥gi
600 mm
∥himin
1800 mm


α2
210°
∥ri
215 mm
∥himax
 900 mm


α3
330°
∥limin
600 mm
θi, min
−60°


γi
 45°
∥limax
1800 mm 
θi, max
 60°
















TABLE 2







Forward position solutions of the Manipulator












Config-







uration
∥l1∥, ∥l2∥, ∥l3∥ (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









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 FIG. 4.


Workspace Evaluation

The workspace of the manipulator illustrated in FIGS. 1-3 is a basic property that reflects its working capacity. The shape and size of the workspace provides basic boundary information for related trajectory planning of applications. As indicated above, the manipulator is capable of being used in a variety of applications with a variety of functionalities and operations. In connection with the manipulator shown in FIGS. 1-3, the reachable workspace of the movable platform may be defined as the space that can be reached by the three translations of the point Om in the fixed reference frame Of-xfyfzf. The boundary of the reachable workspace is simultaneously constrained by moving ranges, physical interference and geometric constraints of all joints in the closed-loop form.


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:











θ

i
,
u


=


θ

i
,
d


=

arccos
(



[



0


0


1



]





B
i



D
i










B
i



D
i







)








where




(
13
)












B
i



D
i




=






O
f



D
i




-



O
f



B
i











=




[






(




r
i



+




h
i




cos






γ
i



)


cos






α
i


+
x








(




r
i



+




h
i




cos






γ
i



)


sin






α
i


+
y





z



]

-

[







l
i




cos






α
i










l
i




sin






α
i







-



g
i







]








=



[






(




r
i



+




h
i




cos






γ
i



)


cos






α
i


+
x
-




l
i




cos






α
i










(




r
i



+




h
i




cos






γ
i



)


sin






α
i


+
y
-




l
i




sin






α
i








z
+



g
i







]








(
14
)







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:









{








l
i




m





i





n






l
i








l
i




ma





x












h
i




m





i





n






h
i








h
i




ma





x










θ

i
,





m





i





n





θ

i
,
u



=


θ

i
,
d




θ

i
,

ma





x










z


-



g
i












(
15
)







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 FIG. 17. The shape of the reachable workspace is symmetric about the axis zf Extreme values of the coordinates of the reachable workspace are: xε[−848,848], yε[−583,945], zε[−1873,−1230] (the unit is mm). In FIG. 18, three x-y sections of the reachable workspace are generated and are taken at z=−1432 mm, −1582 mm and −1732 mm. The three x-y sections have different shapes and sizes. By considering practical motion ranges of the movable platform and general applications of the manipulator, in one example, the manipulator may have a practical workspace (namely, the sub-workspace of the reachable workspace) defined in the form of a cylinder with a height of 300 mm (between two x-y sections at z=−1432 mm and −1732 mm), where the maximal diameter of the cylinder is Φ=884 mm (around a center point Of).


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 FIG. 17, the workspace is generated for γi equal to 45°. In order to illustrate variation of the workspace for different values of γi, a numerical evaluation of the workspace is shown in FIGS. 19-22, for γi=30° and 60°. By comparing the shape and size of the three different workspaces in FIGS. 17 and 22, extreme values of the coordinates of the reachable workspace are not changed dramatically, while the maximal diameter of the cylinder of the defined practical workspace has been reduced to Φ=570 mm (γi=30°) and Φ=604 mm (γi=60°), while the height of the cylinder remains constant. Compared to the Φ=884 mm (γi=45°) in FIGS. 17 and 18, the size of the practical workspace in FIGS. 19-22 has decreased. The coordinate z of the workspace decreases with the increase of γi. Thus, by evaluating the workspace with the variation of γi, the maximal size of the practical workspace can be achieved when γi=49.8°. The cylinder of the practical workspace has the maximal diameter of Φ=908 mm and height 300 mm between the two x-y sections at z=−1895 mm and −1595 mm.


Velocity and Load Jacobian Analysis

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:









{




ω
=


[




ω
xf




ω
yf




ω
zf




]

T







v
=


[




v
xf




v
yf




v
zf




]

T









(
16
)







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 FIG. 27, unit vector si,j that is along the jth joint axis of the ith subchain is given by:















s

i
,
1


=


s

i
,
2


=


s

i
,
4


=



l
i




l
i




=


[




cos






α
i





sin






α
i




0



]

T









(
18
)







s

i
,
3


=


s

i
,
5


=



h
i




h
i




=



[






(




l
i



-



r
i




)


cos






α
i


-
x






(




l
i



-



r
i




)


sin






α
i


-
y





-



g
i




-
z




]

T








(



(




l
i



-



r
i




)


cos






α
i


-
x

)

2

+








(



(




l
i



-



r
i




)


sin






α
i


-
y

)

2

+


(




g
i



+
z

)

2













(
19
)







where ∥li∥ can be obtained from Eq. (11). Thus, the unit screws {circumflex over ($)}i,j of Eq. (17) are:
















$
^


i
,
1


=


[



0





s

i
,
1





]

=


[



0


0


0



cos






α
i





sin






α
i




0



]

T







(
20
)








$
^


i
,
2


=


[




s

i
,
2








r
s

×

s

i
,
2






]

=


[




s

i
,










O
fr



O
m




×

s

i
,
2






]

=


[




s

i
,
3








(




O
fr



O
f




+

r
O


)

×

s

i
,
2






]

=


[




cos






α
i





sin






α
i




0




-

(







g
i



+





z



)



sin






α
i






(







g
i



+





z



)


cos






α
i









x





sin






α
i


-






y





cos






α
i








]

T








(
21
)











$
^


i
,
3


=



[



0





s

i
,
3





]







=









[



0


0


0





(







l
i



-








r
i






)


cos






α
i


-
x






(







l
i



-








r
i






)


sin






α
i


-
y





-



g
i




-
z








]









(



(




l
i



-



r
i




)


cos






α
i


-
x

)

2

+








(



(




l
i



-



r
i




)


sin






α
i


-
y

)

2

+


(




g
i



+
z

)

2














(
22
)













$
^


i
,
4


=


[




s

i
,
4







0
×

s

i
,
4






]

=


[




cos






α
i





sin






α
i




0


0


0


0



]

T







(
23
)













$
^


i
,
5


=


[




s

i
,
5








r
i

×

s

i
,
5






]

=


[






(




l
i



-



r
i




)


cos






α
i


-
x








(




l
i



-



r
i




)


sin






α
i


-
y







-



g
i




-
z







-



r
i





sin







α
i



(




g
i



+
z

)











r
i




cos







α
i



(




g
i



+
z

)











r
i





(


x





sin






α
i


-

y





cos






α
i



)





]








(



(




l
i



-



r
i




)


cos






α
i


-
x

)

2

+








(

(



(




l
i



-



r
i




)


sin






α
i


-
y

)

)

2

+


(




g
i



+
z

)

2













(
24
)







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:














$
^


i
,
c


=



[



0





k

i
,
c





]







=



[



0







s

i
,
2


×

s

i
,
3







s

i
,
2


×

s

i
,
3









]







=





[



0


0


0




-
sin








α
i



(




g
i



+
z

)






cos







α
i



(




g
i



+
z

)











x





sin






α
i


-






y





cos






α
i













]

T





(


x





sin






α
i


-

y





cos






α
i



)

2

+


(




g
i



+
z

)

2











(
25
)







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:












$
^


i
,
c




$
Om


=




(




$
^


i
,
c



)

T



$
Om


=




[





-
sin








α
i



(




g
i



+
z

)






cos







α
i



(




g
i



+
z

)










x





sin






α
i


-






y





cos






α
i







0


0


0



]



$
Om






(


x





sin






α
i


-

y





cos






α
i



)

2

+


(




g
i



+
z

)

2




=



J

i
,
c




$
Om


=
0







(
26
)







where the reciprocal matrix ∇ is











=

[



0


0


0


1


0


0




0


0


0


0


1


0




0


0


0


0


0


1




1


0


0


0


0


0




0


1


0


0


0


0




0


0


1


0


0


0



]






(
27
)







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:










J
c

=


[




J

1
,
c







J

2
,
c







J

3
,
c





]

=

[




k

1
,
c

T



0


0


0





k

2
,
c

T



0


0


0





k

3
,
c

T



0


0


0



]






(
28
)







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:









{







θ
.


i
,
u


+


θ
.


i
,
d



=
0








θ
.


i
,
c


=
0








(
30
)







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.:














$
^


i
,
a


=



[




k

i
,
a








r
i

×

k

i
,
a






]







=



[






k

i
,
c


×

s

i
,
3







k

i
,
c


×

s

i
,
3












r
i

×

(



k

i
,
c


×

s

i
,
3







k

i
,
c


×

s

i
,
3






)





]







=




[






-
cos









α
i



(




g
i



+
z

)


2


-


(


x





sin






α
i


-

y





cos






α
i



)



(



(




l
i



-



r
i




)


sin






α
i


-
y

)










-
sin









α
i



(




g
i



+
z

)


2


+


(


x





sin






α
i


-

y





cos






α
i



)



(



(




l
i



-



r
i




)


cos






α
i


-
x

)









(




g
i



+
z

)



(


-

(




l
i



-



r
i




)


+

x





cos






α
i


+

y





sin






α
i



)










r
i




sin







α
i



(




g
i



+
z

)




(


-

(




l
i



-



r
i




)


+

x





cos






α
i


+

y





sin






α
i



)








-



r
i





cos







α
i



(




g
i



+
z

)




(


-

(




l
i



-



r
i




)


+

x





cos






α
i


+

y





sin






α
i



)










r
i





(


x





sin






α
i


-

y





cos






α
i



)



(


(




l

i








-



r
i




)

-

x





cos






α
i


-

y





sin






α
i



)





]











(





cos








α
i



(




g
i



+
z

)


2


+







(


x





sin






α
i


-

y





cos






α
i



)



(



(




l
i



-



r
i




)


sin






α
i


-
y

)





)

2

+








(






(

sin







α
i



(




g
i



+
z

)



)

2

-







(


x





sin






α
i


-

y





cos






α
i



)



(



(




l
i



-



r
i




)


cos






α
i


-
x

)





)

2

+











(




g
i



+
z

)

2




(


-

(




l
i



-



r
i




)


+

x





cos






α
i


+

y





sin






α
i



)

2














(
31
)







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:















$
^


i
,
a








$
Om


=





(




$
^


i
,
a



)

T



$
Om








=





-




l
.

i






(



(




g
i



+
z

)

2

+


(


x





sin






α
i


-

y





cos






α
i



)


2







)












(





cos








α
i



(




g
i



+
z

)


2


+







(


x





sin






α
i


-

y





cos






α
i



)



(



(




l
i



-



r
i




)


sin






α
i


-
y

)





)

2

+








(





sin








α
i



(




g
i



+
z

)


2


-







(


x





sin






α
i


-

y





cos






α
i



)



(



(




l
i



-



r
i




)


cos






α
i


-
x

)





)

2

+











(




g
i



+
z

)

2




(


-

(




l
i



-



r
i




)


+

x





cos






α
i


+

y





sin






α
i



)

2













=







l
.

i




cos






φ
i








=







l
.

i





cos


(


π
2

-

γ
i


)









=







l
.

i





k

i
,
a

T



s

i
,
2










(
32
)











namely
,

















J

i
,
ar




$
Om


=




[






(


r
i

×

k

i
,
a



)

T



k

i
,
a

T



s

i
,
2








k

i
,
a

T



k

i
,
a

T



s

i
,
2







]



$
Om








=






[







r
i




sin







α
i



(




g
i



+
z

)




(

-

(







l
i



-



r
i



+







x





cos






α
i


+

y





sin






α
i






)


)








-



r
i





cos







α
i



(




g
i



+
z

)




(





-

(




l
i



-



r
i




)


+







x





cos






α
i


+

y





sin






α
i






)










r
i





(


x





sin






α
i


-

y





cos






α
i



)



(





(




l
i



-



r
i




)

-







x





cos






α
i


-

y





sin






α
i






)












-
cos









α
i



(




g
i



+
z

)


2


-







(


x





sin






α
i


-

y





cos






α
i



)



(



(




l
i



-



r
i




)


sin






α
i


-
y

)















-
sin









α
i



(




g
i



+
z

)


2


+







(


x





sin






α
i


-

y





cos






α
i



)



(



(




l
i



-



r
i




)


cos






α
i


-
x

)











(




g
i



+
z

)



(


-

(




l
i



-



r
i




)


+

x





cos






α
i


+

y





sin






α
i



)





]

T



$
Om




-


(




g
i



+
z

)

2


-


(


x





sin






α
i


-

y





cos






α
i



)

2









=






l
.

i










(
33
)







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:













J
ar

=



[




J

1
,
ar







J

2
,
ar







J

3
,
ar





]







=



[






(


r
1

×

k

1
,
a



)

T



k

1
,
a

T



s

1
,
2








k

1
,
2

T



k

1
,
2

T



s

1
,
2











(


r
2

×

k

2
,
a



)

T



k

2
,
a

T



s

2
,
2








k

2
,
a

T



k

2
,
a

T



s

2
,
2











(


r
3

×

k

3
,
a



)

T



k

3
,
a

T



s

3
,
2








k

3
,
a

T



k

3
,
a

T



s

3
,
2







]







=





[






(


r
1

×

k

1
,
a



)

T


cos


(


π
2

-

γ
1


)







k

1
,
a

T


cos


(


π
2

-

γ
1


)










(


r
2

×

k

2
,
a



)

T


cos


(


π
2

-

γ
2


)







k

2
,
a

T


cos


(


π
2

-

γ
2


)










(


r
3

×

k

3
,
a



)

T


cos


(


π
2

-

γ
3


)







k

3
,
a

T


cos


(


π
2

-

γ
3


)






]









(
34
)







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:










J
a

=


[




J

1
,
a







J

2
,
a







J

3
,
a





]

=

[






(


r
1

×

k

1
,
a



)

T



k

1
,
a

T



s

1
,
2






r
1









k

1
,
a

T



k

1
,
a

T



s

1
,
2











(


r
2

×

k

2
,
a



)

T



k

2
,
a

T



s

2
,
2






r
2









k

2
,
a

T



k

2
,
a

T



s

2
,
2











(


r
3

×

k

3
,
a



)

T



k

3
,
a

T



s

3
,
2






r
3









k

3
,
a

T



k

3
,
a

T



s

3
,
2







]






(
35
)







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:











J
i



$
Om


=



[




J

i
,
a







J

i
,
c





]



$
Om


=

[







l
.

i







0



]






(
36
)







Thus, the 6×6 overall Jacobian matrix of the manipulator is given by:









J
=


[




J
a






J
c




]

=


[




J

1
,
a





J

2
,
a





J

3
,
a





J

1
,
c





J

2
,
c





J

3
,
c





]

T






(
37
)







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:









{





f
a

=


[






f

1
,
a









f

2
,
a









f

3
,
a







]

T








f
f

=


[




f
xf




f
yf




f
zf




]

T









(
38
)







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:









{






l

=


[




Δ






l
1





Δ






l
2





Δ






l
3





]

T










O
m


=


[




Δ






x
Om





Δ






y
Om





Δ






z

Om










]

T









(
40
)







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.


Singularity Analysis

In the motions of the manipulator illustrated in FIGS. 1-3, there are some instantaneous poses of the structure that can induce uncontrollable DOF of the movable platform. The instantaneous poses are singularities of the manipulator. To ensure controllability and continuous motions of the movable platform in the reachable workspace, the determination and elimination of singularities is necessary for the kinematic performance analysis of the manipulator. Based on the analysis of the Jacobian matrix in Eqs. (18) and (19), there are four possible kinds of singularities that can be identified. These are:

    • 1) If Jl is not full rank and JOm is invertible, namely, det(Jl)=0, det(JOm)≠0, the poses are inverse kinematic singularities and the movable platform will lose one or more DOF. This kind of singularity cannot happen in the manipulator since the structural constant γi≠0, so that Jl is always full rank in the manipulator.
    • 2) If JOm is not full rank and Jl is invertible, namely, det(JOm)=0, det(Jl)≠0, the poses result in forward kinematic singularities. The movable platform will gain one or more DOF even when all actuators are locked. This kind of singularity can happen when J1,Om, J2,Om and J3,Om are linearly dependent, namely, two or three vectors hi are parallel to one another, or the three vectors hi lie in a common plane. In the structural configuration of the manipulator illustrated in FIGS. 1-3, two or three vectors hi cannot be parallel to one another since γi≠90° in the triangular pyramidal constraint. Furthermore, the three vectors hi cannot lie in a common plane, because of the physical interference between the guide members of the three linear actuators and the links in the star form arrangement. Thus, this kind of singularity is eliminated by the manipulator.
    • 3) If det(Jl)=det(JOm)=0, the poses are combined kinematic singularities. This also cannot happen based on the above analysis.
    • 4) If the movable platform has any rotations, the poses are constraint kinematic singularities. The design of the manipulator is developed based on displacement group theory. The continuous translational motions of the movable platform are verified by the intersection operation of the displacement subsets in Eq. (3). The rotations of the movable platform are eliminated by the triangular pyramidal constraint between the three subchains. Hence, this kind of singularity is also eliminated by the constant constraints.


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 FIG. 23.


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 FIGS. 1-3, the guide members of the three linear actuators are arranged in a star form. Thus, the unique singularity configuration in FIG. 23 is avoided. Based on the above analysis, all kinds of kinematic singularities are eliminated in the structural design of the manipulator illustrated in FIGS. 1-3, which is a fully singularity-free design in the reachable workspace.


Isotropy Analysis

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:











JJ
T

=

[



1


0


0




0


1


0




0


0


1



]








namely
,





(
44
)






{







J
i



J
i
T


=
1

,




i
=
j









J
i



J
j
T


=
0

,




i

j








(
45
)







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 FIG. 24, where the isotropic configurations happen when the movable platform is moving along the axis zf in the reachable workspace. FIG. 24 also illustrates another example of a manipulator with the guide members not co-planar, but rather angling downward from a fixed end of each guide toward a middle or intersection of the three guide members.


Dexterity Analysis

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 FIGS. 25 and 26. The contour of the kinematic manipulability is symmetric about the axis zf. The values of the manipulability decrease from the axis zf toward the outer limits of the workspace and increase along the negative direction of the axis zf. Thus, by assuming a kinematic manipulability of m≧2.00, the dexterity workspace can be defined in a cylinder with a maximal diameter of Φ=583 mm and height 300 mm between the two x-y sections at the z=−1732 mm and −1432 mm. This corresponds to a subset of the manipulator's practical workspace as shown in FIGS. 17 and 18.


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 FIGS. 1-3, an inclined planar displacement subset is defined and constrained in a triangular pyramidal constraint form in the structural design. In this manipulator, all actuations are fixed, each subchain of the manipulator includes four 1-DOF joints, the size of the movable platform is reduced and minimal, the three translational motions are decoupled, the overconstrained mechanism can be eliminated, the inverse and forward position solutions are analyzed, the workspace is evaluated with the variation of structural parameters, the reachable and practical workspaces are defined, the maximal practical workspace is obtained in a cylinder according to the optimized structural parameters, the related velocity and load Jacobian matrices are built, the manipulator is singularity free, and the isotropic configuration and the dexterity workspace are evaluated by the analysis of the Jacobian matrix.


Stiffness Analysis of a Subchain

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 FIG. 27. Thus, overall deformations of each subchain are simultaneously generated by the actuation force fi,a and the constraint couple Mi,c.


In FIG. 28, stiffness of a subchain can be considered as a serial connection of springs representing the stiffness of all links. Thus, by considering the effects of the actuation force and of the constraint couple, five components of the equivalent springs of a subchain can be identified:

    • (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 slide block AiBi, a bending spring and a torsional spring are used to represent the stiffness of the slide block of the prismatic joint Pi,0. Here torsional deformation occurs when the vectors hi is moving away from the plane AiBiGi. The compliances of the bending and torsional springs are denoted as Ci,AB and Ci,ABt respectively.
    • (4) In the prismatic joint Pi,1, the guide member and the slide block have different bending stiffnesses. Thus, the equivalent spring between the points Bi and Ci can be separated into three parts, namely guide member BiHi,m, slide block HiCi and Hi,mHi (overlapping part between the guide member and the slide block). The compliances of BiHi,m, HiCi and Hi,mHi are denoted as Ci,BH, Ci,HC and Ci,HH, respectively.
    • (5) In the link CiOm, 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,COm.


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 FIGS. 29a and 29b. The compliance of each spring can be deduced as follows.


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:












f

i
,
al




=


2


τ

i
,
a





d

i
,
a




tan


(


λ

i
,
a


+

ψ

i
,
a



)








(
48
)






{





λ

i
,
a


=


tan

-
1




(


L

i
,
a



π






d

i
,
a




)









ψ

i
,
a


=


tan

-
1




(


μ

i
,
c



cos






α

i
,
t




)










(
49
)







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 FIG. 29a, the linear displacement of the slide block AiBi is:





Δ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:










C

i
,
al


=



Δ






l
i





f

i
,
al





=



L

i
,
a




d

i
,
a




tan


(


λ

i
,
a


+

ψ

i
,
a



)




2


K


i
,

α





a















(
51
)







In FIG. 29b, based on the deformation of the constraints, the bending compliance of the guide member OfGi is:










C

i
,
GOf


=



Δ






ϕ

i
,
GOf






M

i
,
c





=




(





l
i




ma





x


-




l
i




m





i





n



)

2

-

3



(




l
i



-




l
i




m





i





n



)

2


-

3



(





l
i




ma





x


-



l
i




)

2




6



EI

ik
,
GOf




(





l
i




ma





x


-




l
i




m





i





n



)









(
52
)







where Δφi,GOf is the angular deformation of the guide member OfGi, ∥limin and ∥limax 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:










C

i
,
AB


=



Δ






ϕ

i
,
AB






M

i
,
c





=





g
i







k

i
,
c

T



[





-
sin







α
i





cos






α
i




0



]


T



EI

ik
,
AB








(
53
)







C

i
,
ABt


=



Δ






ϕ

i
,
ABt






M

i
,
c





=





g
i







k

i
,
c

T



[



0


0


1



]


T



GI

ip
,
AB








(
54
)







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:















C

i
,
BH


=



Δ






ϕ

i
,
BH






M

i
,
c





=






h
i



-



H

i
,

.
m





C
i






EI

ik
,
BH



=





h
i



-



h

i
,
d






EI

ik
,
BH










(
55
)







C

i
,
HH


=



Δ






ϕ

i
,
HH






M

i
,
c





=






h
i



-



H

i
,

.
m





C
i




-



B
i



H
i






EI

ik
,
HH



=





h

i
,
d




+



h

i
,
u




-



h

i










EI

ik
,
HH









(
56
)












C

i
,
HC


=



Δ






ϕ

i
,
HC






M

i
,
c





=






h
i



-



B
i



H
i






EI

ik
,
HC



=





h
i



-



h

i
,
u






EI

ik
,
HC










(
57
)







The bending compliance of link CiOm is:










C

i
,
COm


=



Δ






ϕ

i
,
COm






M

i
,
c





=




r
i




EI

ik
,
COm








(
58
)







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:













K

i
,
al


=



C

i
,
al


-
1








=






f

i
,
al





Δ






l
i









=




2


K

i
,

α





a






L

i
,
a




d

i
,
a




tan


(


λ

i
,
a


+

ψ

i
,
a



)











(
59
)










K

i
,
c


=



C

i
,
c


-
1








=






M

i
,
c





Δ






ϕ

i
,
c










=




(





C

i
,
GOf


+

C

i
,
AB


+

C

i
,
ABt


+

C

i
,
BH


+







C

i
,
HH


+

C

i
,
HC


+

C

i
,
COm






)


-
1









(
60
)







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

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:









{





f
f

=


[




f
xf




f
yf




f
zf




]

T








M
f

=


[




M
xf




M
yf




M
zf




]

T









(
61
)







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:









{





f
a

=


[






f

1
,
a









f

2
,
a









f

3
,
a







]

T








M
c

=


[






M

1
,
c









M

2
,
c









M

3
,
c







]

T









(
63
)







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:









{










l

=



[




Δ






l
1





Δ






l
2





Δ






l
3





]

T

=


(


J
a



)








O
m
















ϕ
c


=



[




Δ






ϕ

1
,
c






Δ






ϕ

2
,
c






Δ






ϕ

3
,
c






]

T

=


(


J
c



)








O
m











(
64
)







By applying the principle of virtual work to the overall structure, the relations of the input-output force and torque become:














w
f
T








O
m


=





f
a
T








l
a


+


M
c
T








ϕ
c









=





[







f

1
,
al





cos






ϕ
1








f

2
,
al





cos






φ
2








f

3
,
al





cos






φ
3





]



[




Δ






l
1


cos






φ
1







Δ






l
2


cos






φ
2







Δ






l
3


cos






φ
3





]


+











M
c
T








ϕ
c








=




[






f

1
,
al









f

2
,
al









f

3
,
al







]



[





cos
2



φ
1




0


0




0




cos
2



φ
2




0




0


0




cos
2



φ
3





]












[




Δ






l
1







Δ






l
2







Δ






l
3





]

+


M
c
T


Δ






φ
c









=






f
al
T



[





cos
2



φ
1




0


0




0




cos
2



φ
2




0




0


0




cos
2



φ
3





]




(


J
a



)








O
m


+












M
c
T



(


J
c



)









O
m









(
65
)










or

















w
f

=





(


J
a



)

T



[





cos
2



φ
1




0


0




0




cos
2



φ
2




0




0


0




cos
2



φ
3





]




f
al


+



(


J
c



)

T



M
c








(
66
)







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:













f
al

=




[






f

1
,
al









f

2
,
al









f

3
,
al







]

T







=




[





K

1
,
al



Δ






l
1






K

2
,
al



Δ






l
2






K

3
,
al



Δ






l
3





]

T







=




[




K

1
,
al




0


0




0



K

2
,
al




0




0


0



K

3
,
al





]



[




Δ






l
1







Δ






l
2







Δ






l
3





]








=




[




K

1
,
al




0


0




0



K

2
,
al




0




0


0



K

3
,
al





]



(


J
a



)








O
m









(
67
)










M
c

=




[






M

1
,
c









M

2
,
c









M

3
,
c







]

T







=




[





K

1
,
c



Δ






ϕ


1
,
c












K

2
,
c



Δ






ϕ

2
,
c







K

3
,
c



Δ






ϕ

3
,
c






]

T







=




[




K

1
,
c




0


0




0



K

2
,
c




0




0


0



K

3
,
c





]



[




Δ






ϕ

1
,
c








Δ






ϕ

2
,
c








Δ






ϕ

3
,
c






]








=




[




K

1
,
c




0


0




0



K

2
,
c




0




0


0



K

3
,
c





]



(


J
c



)








O
m









(
68
)







By substituting Eq. (67) and (68) into Eq. (66), the output force and torque of the movable platform is obtained:










w
f

=






(


J
a



)

T



[





cos
2



φ
1




0


0




0




cos
2



φ
2




0




0


0




cos
2



φ
3





]




[




K

1
,
al




0


0




0



K

2
,
al




0




0


0



K

3
,
al





]




(


J
a



)








O
m


+




(


J
c



)

T



[




K

1
,
c




0


0




0



K

2
,
c




0




0


0



K

3
,
c





]




(


J
c



)








O
m







(
69
)







Thus, the 6×6 stiffness matrix of the manipulator can be deduced from Eq. (69) and becomes:










K
f

=



w
f








O
m



=





(


J
a



)

T



diag


[



cos
2



φ
1


,


cos
2



φ
2


,


cos
2



φ
3



]




diag


[


K

1
,
al


,

K

2
,
al


,

K

3
,
al



]




(


J
a



)


+



(


J
c



)

T



diag


[


K

1
,
c


,

K

2
,
c


,

K

3
,
c



]




(


J
c



)



=



(

J


)

2



diag


[



cos
2



φ
1


,


cos
2



φ
2


,


cos
2



φ
3



]




diag


[


K

1
,
al


,

K

2
,
al


,

K

3
,
al


,

K

1
,
c


,

K

2
,
c


,

K

3
,
c



]




(

J






)








(
70
)







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

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.









TABLE 3







Physical Parameters of the Manipulator










Parameter
Value
Parameter
Value














Ki, αa
2.5 × 109
Nmm/rad
Iik, GOf
4.22 × 104 mm4


Li, a
6.5
mm
Iik, AB
2.12 × 104 mm4


di, a
31.5
mm
Iip, AB
6.45 × 104 mm4










αi, t
14.5°
Iik, BH
2.53 × 104 mm4


μi, c
0.2
Iik, HH
3.21 × 104 mm4











E
2.03 × 105
Mpa
Iik, HC
2.36 × 104 mm4


G
7.85 × 104
Mpa
Iik, COm
1.78 × 104 mm4


∥hi, u
900
mm


∥hi, d
900
mm









In FIGS. 30a-30f, Kf max and Kf min represent the maximal and minimal eigenvalues of the stiffness matrix. The distributions of Kf max and Kf min are analyzed, as an example, in three x-y sections take at three different z values (z=−1432, −1582, −1732 mm), respectively. The shape of the distributions is symmetric about the axis z. The maximal eigenvalues increase from the center outward. On the contrary, the minimal eigenvalues decrease from the center outward. However, both of them increase along the negative direction of axis z. Thus, by assuming that the minimal eigenvalue of the stiffness matrix is 1.25×108, the minimal stiffness workspace can be determined as a cylinder with a maximal diameter of Φ=768 mm (around the center point Of) and height 300 mm (between the two x-y sections at the z=−1432 mm and −1732 mm) as shown in FIG. 30d, which is a sub-workspace of the practical workspace.


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 FIGS. 29a-30f, the workspace and the distributions of the stiffness are generated for γi equal to 45°. In order to evaluate the variations of the workspace and the stiffness distributions or different values of γi, results of a numerical search are shown in FIGS. 31a-31c, for γi=30° and in FIGS. 31d-31f for γi=60°. Compared to the workspace shown in FIGS. 29a-30f, the sizes of the workspaces have decreased in FIGS. 31a-31f Evidently, the maximal and minimal eigenvalues of the stiffness decrease with an increase of γi. Thus, by evaluating the workspace and distributions of the maximal and minimal eigenvalues as a function of γi, it can be shown that the maximal size of the practical workspace is achieved when γi=49.8°. The maximal diameter of the cylinder of the practical workspace, in this case, is Φ=908 mm with a height of 300 mm between two x-y sections at z=−1895 mm and −1595 mm. Correspondingly, the minimal stiffness workspace can be defined as a sub-workspace of the practical workspace with a maximal diameter of Φ=848 mm and height of 300 mm when the minimal eigenvalue of the stiffness matrix is 1.05×108.


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 FIGS. 32-41f, another example of a translational parallel manipulator is illustrated. The manipulator is designed based on conical displacement subset to exhibit better kinematic characteristic. The inverse position solution is obtained through closed-loop constraint analysis and used to formulate the overall Jacobian matrix of constraints and actuations based on the theory of reciprocal screws. Furthermore, by considering the stiffness of all links, joints, actuators, fixed and movable platforms, the output stiffness matrix of the manipulator is derived by the transformations of loads and deformations in the closed-loop form. The relations between the virtual input-output displacements are analyzed by the overall Jacobian matrix and used to build the manipulator's stiffness model. Stiffness performance is evaluated by the extreme eigenvalues of the output stiffness matrix in the reachable workspace. By considering the variations of the structural parameters and the distribution of the output stiffness, the maximal stiffness workspace is obtained through numerical optimization, providing, thereby, basic constraints for the parametric design of the manipulator.


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 FIG. 32 is established based on the overall Jacobian matrix method. The general formulation of the bending stiffness matrix of the passive links is considered in the compatibility conditions of the system. The overall Jacobian matrix includes the Jacobian of constraints and actuations for the limited-DOF parallel manipulators, which was derived based on the theory of reciprocal screws. In the stiffness modeling, the stiffness of fixed and movable platforms of the manipulator are included by considering the stiffness of constraints (links) and actuations (actuators). Once the stiffness model is obtained, the stiffness performance is evaluated by the 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 maximal stiffness workspace can be obtained through numerical optimization. This information provides the basic design constraints for the parameters of the manipulator illustrate in FIG. 32.


Structural Design

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 FIGS. 32 and 33, a conical displacement subset can be built by serial joints Ri,1Pi,1Ri,2, where the prismatic joint Pi,1 connects two parallel revolute joints Ri,1 and Ri,2 under an angle (the subscript i represents the ith subchain). The serial joints Ri,1Pi,1Ri,2 namely the conical displacement subset {Co(ni,1,Coi)} can generate a rotation {R(ni,1)} around cone axis ni,1 and two translations {T(Coi)} on cone surface Coi, where a rotational axis of {R(ni,1)} can be determined as a moving direction as parallel with the cone axis ni,1. By combining a prismatic joint Pi,0 with the Ri,1Pi,1Ri,2 (the translational direction li of Pi,0 is arbitrarily related to the conical displacement subset), the structure for the Schoenflies motion {X(ni,1)} can be obtained as a subchain P-R∠P∠R. Three subchains P-R∠P∠R can be combined in a symmetric form to build the 3-DOF TPM shown in FIGS. 32 and 33. In accordance with displacement group theory, the intersection operation of the displacement subsets between the subchains is:













Z
m

=






3


i
=
1




{

X


(

n

i
,
1


)


}








=






3


i
=
1




[


{

Co


(


n

i
,
1


,

Co
i


)


}



{

T


(

l
i

)


}


]








=






3


i
=
1




[


{

T


(

Co
i

)


}



{

T


(

l
i

)


}


]








=



{
T
}








(
71
)







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 FIG. 32 include: Three identical subchains designed and arranged symmetrically in a non-Cartesian constraint configuration; only four 1-DOF joints are included in each subchain (no universal or spherical joints are involved); the movable platform is connected with three revolute joints instead of universal or cylindrical joints (a relatively small size of the movable platform can be realized); and all actuation is accomplished through linear actuators and placed on the fixed platform.


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

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 FIG. 34, a fixed reference frame Of-xfyfzf is placed at a center of the fixed platform, and a parallel moving reference frame Om-xmymzm is defined at the center of the movable platform. The dashed lines OfOfi (i=1, 2, 3) are projection lines of the guide members OfGi of the three linear actuators along the axis zf in the plane xfOfyf. The intersection angle between Of Ofi and OfGi is αPi. The lines OfOfi are arranged along the axis xf with intersection angles α1, α2 and α3, respectively. The prismatic joints and revolute joints Pi,0, Ri,1, Pi,1 and Ri,2 are connected in sequence. The basic structural parameters are αi, αPi, αRi, γi and ∥ri∥, where αm is the intersection angle between the axis of Ri,1 and the moving direction of Pi,0, γi represents the intersection angle between the axis of Ri,1 and the moving direction of Pi,1, while ∥ri∥ is the size of the movable platform between points Om and Bi which is parallel to the axis of Ri,1. The joint variables of Pi,0, Ri,1, Pi,1 and Ri,2 are ∥li∥, θi,u, ∥hi∥ and θi,d, respectively. The input variables are the lengths of travel ∥li∥ of the linear actuators between points Of and Ai which is along the three guide members, while the output variable is the position vector ro (x, y, z) of the movable platform between points Of and Om. In a subchain, the kinematic constraint of the closed loop is:






l
i
=r
o
+r
i
+h
i  (72)


where the constituent vectors are defined as:











(
73
)







{






l
i

=




O
f



A
i




=


[







l
i




cos






α
Pi


cos






α
i








l
i




cos






α
Pi


sin






α
i








l
i




sin






α
Pi





]

T















r
o

=




O
f



O
m




=


[



x


y


z



]

T

















r
i

=





O
m



B
i










=






O
f



B
i




-



O
f



O
m











=




[




r
i





cos


(


α
Pi

-

α
Ri


)



cos






α
i









r
i





cos


(


α
Pi

-

α
Ri


)



sin






α
i









r
i




sin






(


α
Pi

-

α
Ri


)


]

T







=



n
i












Thus, the vector hi can be deduced as:













h
i

=





B
i



A
i










=




l
i

-

r
i

-

r
O








=



[






(





l
i




cos






α
Pi


-




r
i





cos
(






α
Pi

-

α
Ri


)



)


cos






α
i


-
x








(





l
i




cos






α
Pi


-




r
i





cos
(






α
Pi

-

α
Ri


)



)


sin






α
i


-
y










l
i




sin






α
Pi


-




r
i





sin
(






α
Pi

-

α
Ri


)


-
z




]








(
74
)







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:














n
i

·

h
i


=






r
i





cos


(


α
Pi

-

α
Ri


)



cos






α
i












(



(





l
i




cos






α
Pi


-




r
i





cos


(


α
Pi

-

α
Ri


)




)


cos






α
i


-
x

)

+













r
i





cos


(


α
Pi

-

α
Ri


)



sin






α
i












(



(





l
i




cos






α
Pi


-




r
i





cos


(


α
Pi

-

α
Ri


)




)


sin






α
i


-
y

)

+













r
i





sin


(


α
Pi

-

α
Ri


)




(





l
i




sin






α
Pi


-




r
i





sin


(


α
Pi

-

α
Ri


)



-
z

)








=






n
i







h
i




cos






γ
i








=






r
i




cos






γ
i









(



(





l
i




cos






α
Pi


-




r
i





cos


(


α
Pi

-

α
Ri


)




)


cos






α
i


-
x

)

2

+








(



(





l
i




cos






α
Pi


-




r
i





cos


(


α
Pi

-

α
Ri


)




)


sin






α
i


-
y

)

2

+







(





l
i




sin






α
Pi


-




r
i





sin


(


α
Pi

-

α
Ri


)



-
z

)

2













(
75
)







To solve Eq. (75) with respect to the unknown parameter ∥li∥, the inverse kinematic position solution of the manipulator can be obtained as:












l
i



=


(








r
i




cos






α
Ri



sin
2



γ
i


+


E
Bi


cos






α
Ri


-



E
Ai



cos
2



γ
i


±













(





r
i




cos






α
Ri



sin
2



γ
i


+


E
Bi


cos






α
Ri


-


E
Ai



cos
2



γ
i



)

2

-






(



cos
2



α
Ri


-


cos
2



γ
i



)






(



(




r
i



+

E
Bi


)

2

-


cos
2




γ
i



(








r
i



2

+

x
2

+

y
2

+







z
2

+

2




r
i





E
Bi






)




)








)




cos
2



α
Ri


-


cos
2



γ
i








(
76
)







where EAi and EBi are:









{





E
Ai

=


x





cos






α
Pi


cos






α
i


+

y





cos






α
Pi


sin






α
i


+

z





sin






α
Pi










E
Bi

=





x






cos


(


α
Pi

-

α
Ri


)



cos






α
i


+

y






cos


(


α
Pi

-

α
Ri


)



sin






α
i


+






z






sin


(


α
Pi

-

α
Ri


)














(
77
)







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.


Overall Jacobian Matrix

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:









{




ω
=


[




ω
xf




ω
yf




ω
zf




]

T







v
=


[




v
xf




v
yf




v
zf




]

T









(
78
)







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 FIG. 35, the unit vector si,j that is along the jth joint axis of the ith subchain is given by:















s

i
,
1


=



l
i




l
i




=


[




cos






α
Pi


cos






α
i





cos






α
Pi


sin






α
i





sin






α
Pi





]

T







(
80
)










s

i
,
2


=



s

i
,
4








=




r
i




r
i










=




[




cos






(


α
Pi

-

α
Ri


)


cos






α
i






cos
(






α
Pi

-

α
Ri


)


sin






α
i





sin






(


α
Pi

-

α
Ri


)





]

T








(
81
)















s

i
,
3


=




h
i




h
i











=




[






(





l
i




cos






α
Pi


-




r
i





cos
(






α
Pi

-

α
Ri


)



)


cos






α
i


-
x








(





l
i




cos






α
Pi


-




r
i





cos
(






α
Pi

-

α
Ri


)



)


sin






α
i


-
y










l
i




sin






α
Pi


-




r
i





sin
(






α
Pi

-

α
Ri


)


-
z




]








(



(





l
i




cos






α
Pi


-




r
i





cos


(


α
Pi

-

α
Ri


)




)


cos






α
i


-
x

)

2

+








(



(





l
i




cos






α
Pi


-




r
i





cos


(


α
Pi

-

α
Ri


)




)


sin






α
i


-
y

)

2

+







(





l
i




sin






α
Pi


-




r
i





sin


(


α
Pi

-

α
Ri


)



-
z

)

2













(
82
)







where ∥li∥ can be obtained from Eq. (76). Thus, the unit screws {circumflex over ($)}i,j of Eq. (79) are:











$
^


i
,
1


=

[



0





s

i
,
1





]





(
83
)








$
^


i
,
2


=


[




s

i
,
2










O
m



A
i




×

s

i
,
2






]

=

[




s

i
,
2








(


r
i

+

h
i


)

×

s

i
,
2






]






(
84
)








$
^


i
,
3


=

[



0





s

i
,
3





]





(
85
)








S
^


i
,
4


=

[




s

i
,
4







0
×

s

i
,
4






]





(
86
)







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:











$
^


i
,
c


=


[



0





k

i
,
c





]

=


[



0







s

i
,
2


×

s

i
,
3







s

i
,
2


×

s

i
,
3









]

=

[



0







s

i
,
2


×

s

i
,
3






sin






γ
i








]







(
87
)







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











=

[



0


0


0


1


0


0




0


0


0


0


1


0




0


0


0


0


0


1




1


0


0


0


0


0




0


1


0


0


0


0




0


0


1


0


0


0



]






(
89
)







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:










J
c

=


[




J

1
,
c







J

2
,
c







J

3
,
c





]

=

[




k

1
,
c

T



0


0


0





k

2
,
c

T



0


0


0





k

3
,
c

T



0


0


0



]






(
90
)







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.:














$
^


i
,
a


=



[




k

i
,
a








r
i

×

k

i
,
a






]







=



[






k

i
,
c


×

s

i
,
3







k

i
,
c


×

s

i
,
3












r
i

×

(



k

i
,
c


×

s

i
,
3







k

i
,
c


×

s

i
,
3






)





]







=



[





k

i
,
c


×

s

i
,
3









r
i

×

(


k

i
,
c


×

s

i
,
3



)





]








(
93
)







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:











J

i
,
a




$
Om


=



[






(


r
i

×

k

i
,
a



)

T



k

i
,
a

T



s

i
,
1








k

i
,
a

T



k

i
,
a

T



s

i
,
1







]



$
Om


=




i
.

i








(
95
)







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:













J
a

=



[




J

1
,
a







J

2
,
a







J

3
,
a





]







=



[






(


r
1

×

k

1
,
a



)

T



k

1
,
a




s

1
,
1








k

1
,
a

T



k

1
,
a




s

1
,
1











(


r
2

×

k

2
,
a



)

T



k

2
,
a




s

2
,
1








k

2
,
a

T



k

2
,
a




s

2
,
1











(


r
3

×

k

3
,
a



)

T



k

3
,
a




s

3
,
1








k

3
,
a

T



k

3
,
a




s

3
,
1







]








(
96
)







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:











J
i



$
Om


=



[




J

i
,
a







J

i
,
c





]



$
Om


=

[







i
.

i







0



]






(
97
)







Thus, the 6×6 overall Jacobian matrix of the manipulator is given by:









J
=


[




J
a






J
c




]

=


[




J

1
,
a





J

2
,
a





J

3
,
a





J

1
,
c





J

2
,
c





J

3
,
c





]

T






(
98
)







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.


Stiffness Analysis of a Subchain

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 FIG. 35. Thus, the overall deformations of each subchain are simultaneously generated by the actuation force fi,a and the constraint couple Mi,c.


In FIG. 36, stiffness of a subchain can be considered as comprising of a serial connection of springs representing the stiffness of all links. Thus, by considering the effects of the actuation force and of the constraint couple, the following four components of the equivalent springs of a subchain can be identified:


(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 FIGS. 37a and 37b. The compliance of each spring can be deduced as follows.


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:












f

i
,
al




=


2






τ

i
,
a





d

i
,
a




tan


(


λ

i
,
a


+

ψ

i
,
a



)








(
100
)






{





λ

i
,
a


=


tan

-
1




(


L

i
,
a



π






d

i
,
a




)









ψ

i
,
a


=


tan

-
1




(


μ

i
,
c



cos






α

i
,
t




)










(
101
)







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 FIG. 37a, the linear displacement of the slide block is:





Δ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:










C

i
,
al


=



Δ






l
i





f

i
,
al





=



L

i
,
a




d

i
,
a




tan


(


λ

i
,
a


+

ψ

i
,
a



)




2






K

i
,

α





a










(
103
)







In FIG. 37b, based on the deformation of the constraints, the bending compliance of the guide member OfGi is:













C

i
,
GOf


=




Δ






ϕ

i
,
GOf






M

i
,
c











=









(





l
i



max

-




l
i



min


)

2

-







3



(




l
i



-




l
i



min


)

2


-






3



(





l
i



max

-



l
i




)

2






6







EI

ik
,
GOf




(





l
i



max

-




l
i



min


)











(
104
)







where Δφi,GOf is the angular deformation of the guide member OfGi, ∥limin and ∥limax 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:













C

i
,
AH


=




Δ






ϕ

i
,
AH






M

i
,
c











=







h
i



-



H

i
,
m




B
i






EI

ik
,
AH









=







h
i



-



h

i
,
d






EI

ik
,
AH










(
105
)










C

i
,
HH


=




Δ






ϕ

i
,
HH






M

i
,
c











=







h
i



-



H

i
,
m




B
i




-



A
i



H
i






EI

ik
,
HH









=







h

i
,
d




+



h

i
,
u




-



h
i





EI

ik
,
HH










(
106
)










C

i
,
HB


=




Δ






ϕ

i
,
HB






M

i
,
c











=







h
i



-



A
i



H
i






EI

ik
,
HB









=







h
i



-



h

i
,
u






EI

ik
,
HB










(
107
)







The bending compliance of link BiOm is:










C

i
,
BOm


=



Δ






ϕ

i
,
BOm






M

i
,
c





=




r
i




EI

ik
,
BOm








(
108
)







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:













K

i
,
al


=



C

i
,
al


-
1








=






f

i
,
al





Δ






l
i









=




2






K

i
,

α





a






L

i
,
a




d

i
,
a




tan


(


λ

i
,
a


+

ψ

i
,
a



)











(
109
)










K

i
,
c


=



C

i
,
c


-
1








=






M

i
,
c





Δ






ϕ

i
,
c










=




(


C

i
,
GOf


+

C

i
,
AH


+

C

i
,
HH


+

C

i
,
HB


+

C

i
,
BOm



)


-
1









(
110
)







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

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:









{





f
f

=


[




f
xf




f
yf




f
zf




]

T








M
f

=


[




M
xf




M
yf




M
zf




]

T









(
111
)







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:









{





f
a

=


[







f

1
,
a









f

2
,
a









f

3
,
a








]

T








M
c

=

[








M

1
,
c









M

2
,
c









M

3
,
c







]

T










(
113
)







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:









{





Δ





l

=



[




Δ






l
1





Δ






l
2





Δ






l
3





]

T

=


(


J
a



)


Δ






O
m










Δ






ϕ
c


=



[




Δ






ϕ

1
,
c






Δ






ϕ

2
,
c






Δ






ϕ

3
,
c






]

T

=


(


J
c



)


Δ






O
m











(
114
)







By applying the principle of virtual work to the overall structure, the relations of the input-output force and torque become:















w
f
T


Δ






O
m


=





f
a
T


Δ






l
a


+


M
c
T


Δ






ϕ
c









=



[







f

1
,
al





cos






φ
1








f

2
,
al





cos






φ
2








f

3
,
al





cos






φ
3





]











[




Δ






l
1


cos






φ
1







Δ






l
2


cos






φ
2







Δ






l
3


cos






φ
3





]

+


M
c
T



Δϕ
c









=




[






f

1
,
al









f

2
,
al









f

3
,
al







]



[





cos
2



φ
1




0


0




0




cos
2



φ
2




0




0


0




cos
2



φ
3





]












[




Δ






l
1







Δ






l
2







Δ






l
3





]

+


M
c
T



Δϕ
c









=




f
al
T



[





cos
2



φ
1




0


0




0




cos
2



φ
2




0




0


0




cos
2



φ
3





]














(


J
a



)

T


Δ






O
m


+



M
c
T



(


J
c



)



Δ






O
m

















namely


:






(
115
)












w
f

=





(


J
a



)

T



[





cos
2



φ
1




0


0




0




cos
2



φ
2




0




0


0




cos
2



φ
3





]




f
al


+



(


J
c



)

T



M
c








(
116
)







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:













f
al

=




[






f

1
,
al









f

2
,
al









f

3
,
al







]

T







=




[





K

1
,
al



Δ






l
1






K

2
,
al



Δ






l
2






K

3
,
al



Δ






l
3





]

T







=




[




K

1
,
al




0


0




0



K

2
,
al




0




0


0



K

3
,
al





]



[




Δ






l
1







Δ






l
2







Δ






l
3





]








=




[




K

1
,
al




0


0




0



K

2
,
al




0




0


0



K

3
,
al





]



(


J
a



)


Δ






O
m









(
117
)










M
c

=




[






M

1
,
c









M

2
,
c









M

3
,
c







]

T







=




[





K

1
,
c




Δϕ

1
,
c







K

2
,
c



Δ






ϕ

2
,
c







K

3
,
c



Δ






ϕ

3
,
c






]

T







=




[




K

1
,
c




0


0




0



K

2
,
c




0




0


0



K

3
,
c





]



[




Δ






ϕ

1
,
c








Δ






ϕ

2
,
c








Δ






ϕ

3
,
c






]








=




[




K

1
,
c




0


0




0



K

2
,
c




0




0


0



K

3
,
c





]



(


J
c



)


Δ






O
m









(
118
)







By substituting Eq. (117) and (118) into Eq. (116), the output force and torque of the movable platform is obtained:










w
f

=






(


J
a



)

T



[





cos
2



φ
1




0


0




0




cos
2



φ
2




0




0


0




cos
2



φ
3





]




[




K

1
,
al




0


0




0



K

2
,
al




0




0


0



K

3
,
al





]




(


J
a



)


Δ






O
m


+




(


J
a



)

T



[




K

1
,
c




0


0




0



K

2
,
c




0




0


0



K

3
,
c





]




(


J
c



)


Δ






O
m







(
119
)







Thus, the 6×6 stiffness matrix of the manipulator can be deduced from Eq. (119) and becomes:










K
f

=



w
f


Δ






O
m



=




(


J
a



)

T



diag


[



cos
2



φ
1


,


cos
2



φ
2


,


cos
2



φ
3



]




diag


[


K

1
,
al


,

K

2
,
al


,

K

3
,
al



]




(


J
a



)


+



(


J
c



)

T



diag


[


K

1
,
c


,

K

2
,
c


,

K

3
,
c



]




(


J
c



)








(
120
)







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

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:










θ

i
,
u


=


-

θ

i
,
d



=

arccos


(



s

i
,
2


×


[



0


0



-
1




]

T

×


s

i
,
2


·



A
i



C
i











A
i



C
i







)







(
121
)







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:









{








l
i



min





l
i








l
i



max











h
i



min





h
i








h
i



max









θ

i
,
min




θ

i
,
u



=




θ

i
,
d






θ

i
,
max









z
<
0








(
123
)







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 FIG. 38. The shape of the reachable workspace is symmetric about axis zf. In one example, the coordinates of the extreme values of the reachable workspace are: xε[−457,457], yε[−421,402], zε[−1262,−572] (the unit is mm). In FIG. 39, three x-y sections of the reachable workspace are generated. The three regions represent the x-y sections at z=−1100 mm, −1000 mm and −900 mm, respectively. The three x-y sections have different shapes and sizes. By considering the practical motion ranges of the movable platform and the general applications of the manipulator, the practical workspace (namely, the sub-workspace of the reachable workspace) can be defined in a cylinder with a height of 200 mm (between the two x-y sections at the z=−1100 mm and −900 mm), where the maximal diameter of the cylinder is Φ=460 mm (around the center point Of). The stiffness and its distributions throughout the practical workspace of the manipulator will be discussed hereinafter.









TABLE 4







Structural Parameters of the Manipulator












Parameter
Value
Parameter
Value







α1
 90°
∥limin
 400 mm



α2
210°
∥limax
1250 mm



α3
330°
∥himin
 600 mm



αPi
−35°
∥himax
1200 mm



αRi
−35°
θi, min
−90°



γi
−30°
θi, max
 90°



∥ri
100 mm










Stiffness Evaluation

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.









TABLE 5







Physical parameters of the Manipulator










Parameter
Value
Parameter
Value














Ki, αa
2.5 × 109
Nmm/rad
Iik, GOf
4.22 × 104 mm4


Li, a
6.5
mm
Iik, AH
2.53 × 104 mm4


di, a
31.5
mm
Iik, HH
3.21 × 104 mm4










αi, t
14.5°
Iik, HB
2.36 × 104 mm4


μi, c
0.2
Iik, BOm
1.78 × 104 mm4











E
2.03 × 105
Mpa
∥hi, u
600 mm










∥hi, d
400 mm










In FIGS. 40a-40f, Kf max and Kf min represent the maximal and minimal eigenvalues of the stiffness matrix. The distributions of Kf max (see FIGS. 40a-40c) and Kf min (see FIGS. 40d-40f) are analyzed, as an example, in three x-y sections (z=−900, −1000, −1100 mm), respectively. The shape of the distributions is symmetric about axis z. The maximal eigenvalues are increased from the center outward, and increased along the positive direction of axis z. From the center outward, the minimal eigenvalues are decreased, and then increased. In each x-y section, the inner part of decreased minimal eigenvalues are decreased along the positive direction of axis z, while the outward part of increased minimal eigenvalues are increased along the positive direction of axis z. Thus, by assuming that the minimal eigenvalue of the stiffness matrix is 1.4×1010, the maximal stiffness workspace can be determined as a cylinder with a maximal diameter of Φ=410 mm (around the center point Of) and height 200 mm (between the two x-y sections at the z=−900 mm and −1100 mm) as shown in FIG. 40d, which is a sub-workspace of the practical workspace.


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 FIGS. 38-40f, the workspace and the distributions of the stiffness are generated for γi equal to −30°. In order to evaluate the variations of the workspace and the stiffness distributions by different values of γi, results of a numerical search are shown in FIGS. 41a-41c, for γi=−40° and FIGS. 41d-41f for γi=−50°. Compared to the workspace shown in FIGS. 38 and 39, the sizes of the workspaces have increased in FIGS. 41a-41f. Evidently, the maximal and minimal eigenvalues of the stiffness are decreased with an increase of γi. Thus, by evaluating the workspace and distributions of the maximal and minimal eigenvalues as a function of γi, it can be shown that the maximal size of the practical workspace is achieved when γi=−42.5°. The maximal diameter of the cylinder of the practical workspace, in this case, is Φ=540 mm with a height of 230 mm between two x-y sections at z=−1050 mm and −1280 mm. Correspondingly, the maximal stiffness workspace can be defined as a sub-workspace of the practical workspace with a maximal diameter of Φ=450 mm and height of 230 mm when the minimal eigenvalue of the stiffness matrix is 1.1×1010.


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 FIG. 42, one example of a control system adapted to control and operate any of the manipulators illustrated and describe herein, or other equivalents and alternatives, is illustrated. It should be understood that this system is only one of many possible control systems capable of controlling the manipulators disclosed herein and presenting this exemplary control system assists with understanding the principles of the present disclosure. The disclosed exemplary system is not intended to be limiting in any manner to the present disclosure. It should also be understood that the example of the manipulator illustrated in the this system is not intended to be limiting and is provided purely as an example of the many types of manipulators that may be controlled and operated within and by the system.


With continued reference to FIG. 42, the system includes various levels of controls and associated hardware and software. The system is capable of including any quantity of hardware, software or a combination of hardware and software at any of the levels, and all of such possibilities are intended to be within the spirit and scope of the present disclosure. In this example, the control system includes an operation level, a local control level, an actuation level, an equipment or manipulator level, and a feedback level. The operation level includes a conventional computer, computing device, or the like adapted to perform all the necessary control, transmit and receive data as necessary, and other functions and capabilities of a conventional computer. The actuation level includes a plurality of servo drivers and a plurality of servo motors. In one example, the system includes three sets of servo drivers and motors in order to drive or actuate the three subchains of the manipulators. In one example, the fixed prismatic joints coupled directly to the guide members are the driven joints and are driven by the servo drivers and motors. The manipulator level includes any one of the possible manipulators and is controlled to perform a desired process, functionality or operation. The feedback level includes a plurality of position feedback sensors associated with manipulator to relay data associated with positions of the manipulator to the computer. In one example, the system includes three position feedback sensors, one for each of the three subchains of the manipulator. The feedback level also includes a load cell or other load measuring device that transmit data to the computer pertaining to a load on the movable platform. The feedback level also includes a conventional remote input/output (I/O) device capable of transmitting data to the computer. The feedback level is also capable of including other devices that may be used to assist with control of the manipulator as desired based on the application of the manipulator.


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.

Claims
  • 1. A translational parallel manipulator comprising: a fixed platform including three guide members, wherein the three guide members include first ends and second ends, and wherein 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;a movable platform spaced-apart from the fixed platform; andthree serial subchains coupled between the three guide members and the movable platform, wherein at least one of the three serial subchains is comprised of a first prismatic joint,a first revolute joint,a second prismatic joint, anda second revolute joint.
  • 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 three serial subchains are different in structure.
  • 8. The translational parallel manipulator of claim 1, wherein the at least one of the three serial subchains includes no more joints than the first prismatic joint, the first revolute joint, the second prismatic joint and the second revolute joint.
  • 9. The translational parallel manipulator of claim 8, wherein the first prismatic joint, the first revolute joint, the second prismatic joint and the second revolute joint are all one degree-of-freedom joints.
  • 10. The translational parallel manipulator of claim 9, wherein 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.
  • 11. The translation parallel manipulator of claim 1, wherein the first prismatic joint is a driven prismatic joint.
  • 12. The translational parallel manipulator of claim 11, wherein the first revolute joint, the second prismatic joint, and the second revolute joint are passive joints.
  • 13. The translational parallel manipulator of claim 11, wherein the first prismatic joint is driven by at least one of a lead screw and a linear motor.
  • 14. The translational parallel manipulator of claim 1, wherein the three serial subchains each include no more than four one degree-of-freedom joints.
  • 15. 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 is a driven joint, and wherein at least one of the first prismatic joint, the first revolute joint, the second prismatic joint and the second revolute joint is a passive joint.
  • 16. The translational parallel manipulator of claim 15, wherein the driven joint is driven by at least one of a lead screw and a linear motor.
  • 17. The translational parallel manipulator of claim 15, wherein the first prismatic joint is the driven joint.
  • 18. The translational parallel manipulator of claim 17, wherein the first revolute joint, the second prismatic joint, and the second revolute joint are passive joints.
RELATED APPLICATIONS

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.

Provisional Applications (1)
Number Date Country
61814922 Apr 2013 US
Continuations (1)
Number Date Country
Parent 14259815 Apr 2014 US
Child 15040156 US