Open AccessArticle

Mixed Position and Twist Space Synthesis of 3R Chains

Neda Hassanzadeh

¹ and

Alba Perez-Gracia

^1,2,*

Department of Mechanical Engineering, Idaho State University, Pocatello, ID 83209, USA

Department of Mechanical Engineering, Universitat Politecnica de Catalunya, 08028 Barcelona, Spain

Author to whom correspondence should be addressed.

Robotics 2022, 11(1), 13; https://doi.org/10.3390/robotics11010013

Submission received: 15 November 2021 / Revised: 30 December 2021 / Accepted: 6 January 2022 / Published: 10 January 2022

(This article belongs to the Special Issue Kinematics and Robot Design IV, KaRD2021)

Download

Browse Figures

Figure 1
The spatial 3R chain. Forward kinematics is the product of the relative displacement <math display="inline"><semantics> <msub> <mi>D</mi> <mrow> <mn>3</mn> <mi>R</mi> </mrow> </msub> </semantics></math> and the displacement to the reference configuration <math display="inline"><semantics> <msub> <mi>D</mi> <mn>0</mn> </msub> </semantics></math>. Twist of the end-effector expressed in the fixed frame is <math display="inline"><semantics> <msub> <mi mathvariant="sans-serif">W</mi> <mrow> <mi>e</mi> <mi>e</mi> </mrow> </msub> </semantics></math>. "> Figure 2
Locus of the direction of the axes from the twist conditions. A general case (left) and a case in which the elliptic cone degenerates to two planes (right). "> Figure 3
Solutions can be found as the intersection of the elliptic cone, the unit sphere and the relative position condition. Here, the curves are depicted for one solution value of the angle <math display="inline"><semantics> <msub> <mi>θ</mi> <mn>2</mn> </msub> </semantics></math>. Green curve: intersection of the elliptic cone with the unit sphere. Red curve: intersection of the elliptic cone and the relative position condition. Blue curve: intersection of the unit sphere and the relative position condition. The intersections of the curves are the solutions for the direction of the second joint axes, <math display="inline"><semantics> <msub> <mi>s</mi> <mn>2</mn> </msub> </semantics></math>. "> Figure 4
Example 1: The 3R robot reaching the two positions shown in <a href="#robotics-11-00013-t003" class="html-table">Table 3</a>. The joint axes are shown as dashed lines and link colors are those of <a href="#robotics-11-00013-f001" class="html-fig">Figure 1</a>. Notice that two of the axes intersect at a point. "> Figure 5
Example 1: Twists of the end effector. Left: subspaces of dimension 2 corresponding to the angular velocities of the end-effector at positions 1 and 2. Right: plots corresponding to the linear velocities. At position 2, the linear velocity subspace is of dimension 1. "> Figure 6
Example 1: A second 3R robot solution for Example 1 showing the first and third axes intersection at the second position. "> Figure 7
Example 2: One 3R robot solution at the first and second positions (top) and during the movement (bottom). "> Figure 8
Example 3: Solution 3R robot for a specified angular twist space at the origin. Dotted lines correspond to the joint axes at each position. ">

Versions Notes

Abstract

Mixed-position kinematic synthesis is used to not only reach a certain number of precision positions, but also impose certain instantaneous motion conditions at those positions. In the traditional approach, one end-effector twist is defined at each precision position in order to achieve better guidance of the end-effector along a desired trajectory. For one-degree-of-freedom linkages, that suffices to fully specify the trajectory locally. However, for systems with a higher number of degrees of freedom, such as robotic systems, it is possible to specify a complete higher-dimensional subspace of potential twists at particular positions. In this work, we focus on the 3R serial chain. We study the three-dimensional subspaces of twists that can be defined and set the mixed-position equations to synthesize the chain. The number and type of twist systems that a chain can generate depend on the topology of the chain; we find that the spatial 3R chain can generate seven different fully defined twist systems. Finally, examples of synthesis with several fully defined and partially defined twist spaces are presented. We show that it is possible to synthesize 3R chains for feasible subspaces of different types. This allows a complete definition of potential motions at particular positions, which could be used for the design of precise interaction with contact surfaces.

Keywords:

kinematic synthesis of robots; mixed-position synthesis; twist systems

1. Introduction

Mixed-position synthesis, in which a combination of finite and infinitesimal positions are defined for the dimensional synthesis, appears as an extension of Burmester’s theory for planar motion [1]. Mixed-position approximate synthesis for planar linkages can be found in [2,3]. In [4], exact synthesis for planar linkages includes higher-order derivatives applied to envelope a planar curve with a tangent line.

The problem was studied for spatial dyads and their combined linkages by Chen and Roth [5,6] to unify the formulation for finite and infinitesimal positions, and later by Tsai and Roth [7], who used the spatial triangle. In all cases, it is applied to define one rigid-body velocity per position at a set of desired positions of the end-effector. The objectives are, among others, to achieve better guidance of the end-effector along a trajectory or to obtain a more accurate approximation to a desired motion curve. Second-order derivatives were included in the synthesis of spatial mechanisms in [8], and related to the curvature of contacts for planar mechanisms in [9].

First- and second-order derivatives can describe contact conditions in the synthesis problem [10], associating first- and second-order kinematics to curvatures and forces at the points of contact [11]. So far, this identification has mainly been used for the design of robotic hands. In [12], multiple rigid-body velocities were used at finite positions in order to synthesize hands for local manipulation conditions. The numerical synthesis allowed to fully or partially define the set of potential directions of motion for the fingertips at specified points. Optimized fingers for grasping objects with a minimally articulated hand were designed in [13] using these type of constraints.

On the other hand, subspaces of twists and wrenches have been used as a design tool for the structural or type synthesis of parallel robots. The potential motions of the platform are found by intersecting the twist or wrench subspace generated by each of the supporting legs; see, for instance, [14].

In this work, we explore the relation between the twist subspaces that can be defined in combination with finite positions, and the topology and geometry of the kinematic chain that imposes the restrictions on the motion. The interest is on defining the twist systems that a given chain can generate, and on stating the set of synthesis equations that are created when the subspace of twists is fully defined at a position. This study is applied to one simple but significant spatial linkage, the 3R spatial chain. The finite-position synthesis of the spatial 3R chain was partially solved in [15,16]. In [17], interval analysis was applied to obtain a set of solutions for the exact synthesis problem, and in [18], numerical algebraic geometry was used to obtain the number of solutions of the problem and to numerically solve the set of equations, which are based on a vector formulation. While algebraic solutions for the finite-position synthesis of spatial chains tends to be a very complex problem, it is possible to state a simpler set of equations for the mixed-position synthesis. The resulting set of equations can be easily solved using the numerical Groebner basis and eigensystem methods.

2. The 3R Serial Chain

Let

S_{i} = s_{i} + ϵ s_{i}^{0}

be the Plücker coordinates of the ith joint axis of the chain shown in Figure 1, with

i = 1, 2, 3

, at the reference configuration. Let

θ_{i}

be the joint variables measured from the reference configuration and

{\dot{θ}}_{i}

be the joint rates at each of the axes

i = 1, 2, 3

2.1. Forward and Inverse Kinematics of the 3R Chain

The forward and inverse kinematics of the 3R chain can be computed using different methods and mathematical tools. Here, we present the approach that is most suited to use them as a first step in the creation of the synthesis equations.

Dual quaternion algebra is used in the development of these equations because it allows for a direct identification of the joint axes. We denote a dual quaternion as

\hat{Q} = q_{w} + ϵ q_{w 0} + Q

, where Q is the six-dimensional dual vector.

The relative displacements of the 3R serial chain can be expressed using the product of exponentials,

{\hat{D}}_{3 R} = e^{S_{1} \frac{θ_{1}}{2}} e^{S_{2} \frac{θ_{2}}{2}} e^{S_{3} \frac{θ_{3}}{2}}

(1)

and arranged as a linear system on the product of joint angles,

{\hat{D}}_{3 R} = [\begin{matrix} \hat{I} & {\hat{S}}_{1} & {\hat{S}}_{2} & {\hat{S}}_{3} & {\hat{S}}_{12} & {\hat{S}}_{13} & {\hat{S}}_{23} & {\hat{S}}_{123} \end{matrix}] \{\begin{matrix} c_{θ_{1}} c_{θ_{2}} c_{θ_{3}} \\ s_{θ_{1}} c_{θ_{2}} c_{θ_{3}} \\ c_{θ_{1}} s_{θ_{2}} c_{θ_{3}} \\ c_{θ_{1}} c_{θ_{2}} s_{θ_{3}} \\ s_{θ_{1}} s_{θ_{2}} c_{θ_{3}} \\ s_{θ_{1}} c_{θ_{2}} s_{θ_{3}} \\ c_{θ_{1}} s_{θ_{2}} s_{θ_{3}} \\ s_{θ_{1}} s_{θ_{2}} s_{θ_{3}} \end{matrix}\},

(2)

where

{\hat{S}}_{i}

are the pure dual quaternions corresponding to the joint axes,

{\hat{S}}_{i j}

is the product

{\hat{S}}_{i} {\hat{S}}_{j}

using the dual quaternion product, and

s_{θ_{i}}

c_{θ_{i}}

are the sin and cosine of the half angle

θ_{i}

Equating to a target position

\hat{P} = p_{w} + ϵ p_{w 0} + P

of the end-effector, we obtain a system with

2^{3} = 8

unknowns on the joint variables. We use the notation

x_{1} = c_{θ_{1}} c_{θ_{2}} c_{θ_{3}}

x_{8} = s_{θ_{1}} s_{θ_{2}} s_{θ_{3}}

, where these variables are related by 3 independent bilinear conditions. The system, with a degree of over-determination of 3, is shown below:

\begin{matrix} \hat{I} x_{1} + {\hat{S}}_{1} x_{2} + {\hat{S}}_{2} x_{3} + {\hat{S}}_{3} x_{4} + {\hat{S}}_{1} {\hat{S}}_{2} x_{5} + {\hat{S}}_{1} {\hat{S}}_{3} x_{6} + {\hat{S}}_{2} {\hat{S}}_{3} x_{7} + {\hat{S}}_{1} {\hat{S}}_{2} {\hat{S}}_{3} x_{8} = \hat{P}, \\ x_{1} x_{5} = x_{2} x_{3}, \\ x_{1} x_{8} = x_{4} x_{5}, \\ x_{2} x_{7} = x_{3} x_{6}, \end{matrix}

(3)

It is possible to solve the 8 linear equations directly for the unknowns; the resulting unique solution will comply with the quadratic conditions only if the position belongs to the workspace.

A smaller system of equations is obtained if we post-multiply by the inverse of the last rotation in order to split in 2R and 1R sides,

[\begin{matrix} \hat{I} & {\hat{S}}_{1} & {\hat{S}}_{2} & {\hat{S}}_{1} {\hat{S}}_{2} \end{matrix}] \{\begin{matrix} c_{θ_{1}} c_{θ_{2}} \\ s_{θ_{1}} c_{θ_{2}} \\ c_{θ_{1}} s_{θ_{2}} \\ s_{θ_{1}} s_{θ_{2}} \end{matrix}\} = [\begin{matrix} \hat{P} & - \hat{P} {\hat{S}}_{3} \end{matrix}] \{\begin{matrix} c_{θ_{3}} \\ s_{θ_{3}} \end{matrix}\},

(4)

so that the total of unknowns is 6. Denote

x_{1} = c_{θ_{1}} c_{θ_{2}}

x_{2} = s_{θ_{1}} c_{θ_{2}}

x_{3} = c_{θ_{1}} s_{θ_{2}}

x_{4} = s_{θ_{1}} s_{θ_{2}}

, and

x_{5} = c_{θ_{3}}

x_{6} = s_{θ_{3}}

, then we have the system

\begin{matrix} \hat{I} x_{1} + {\hat{S}}_{1} x_{2} + {\hat{S}}_{2} x_{3} + {\hat{S}}_{1} {\hat{S}}_{2} x_{4} = \hat{P} x_{5} - \hat{P} {\hat{S}}_{3} x_{6}, \\ x_{1} x_{4} = x_{2} x_{3} . \end{matrix}

(5)

This system of equations can be used to solve the inverse kinematics of the chain, as well as to state the kinematic synthesis equations.

2.2. Space of Potential Twists of the End-Effector

Let us consider the twist as the six-dimensional vector

W = (w, v)

, where w is the angular velocity of the body and v is the velocity of a point belonging to the body. The set of twists of the end-effector at position i can be defined as

W_{e e}^{i} = S_{1}^{i} {\dot{θ}}_{1}^{i} + S_{2}^{i} {\dot{θ}}_{2}^{i} + S_{3}^{i} {\dot{θ}}_{3}^{i},

(6)

where

S_{j}^{i}

is the jth joint axis at a configuration defined by i, and

{\dot{θ}}_{j}^{i}

is its angular joint rate.

This is, in the most general case, a three-dimensional subspace of the six-dimensional space of twists. For a given configuration of the robot, defining three end-effector twists,

W_{1}

W_{2}

, and

W_{3}

, fully specifies the subspace of potential twists of the end-effector at position i,

W_{e e}^{i} = λ_{1} W_{1} + λ_{2} W_{2} + λ_{3} W_{3},

(7)

as the linear combination of the three independent twists. However, for a generic twist subspace such as Equation (7) to coincide with the subspace of twists of the end-effector of the robot, some additional conditions are needed. The dimension of the specified twist space must be equal to the dimension of the space spanned by the joint axes at that configuration, and also some conditions on the principal pitches of the screw system must be satisfied, as explained in Section 3 and Section 4.

3. Twist Spaces of Dimension 3 for the Serial 3R Chain

The classification used for the screw systems of dimension 3 follows [19,20]. There are 12 different types of screw systems of dimension 3, counting special sub-types. Each type comprises screw systems with different pitch values that define equivalence classes up to rigid motion. Twists belonging to the end-effector of a kinematic chain such as those shown in Equation (6) form a twist system.

3.1. Finite and Infinitesimal Motion

The completion group of a screw system is defined by the exponential map of the smallest Lie subalgebra containing the screw system; see, for instance, [20] for the completion subgroups of the different types of screw systems.

For any twist system generated by a kinematic chain, the finite motion of the chain must belong to the completion group of the system, which is a subgroup of

S E (3)

Some twist subspaces are invariant. Invariant twist systems are closed under the Lie bracket, that is, they are subalgebras of

s e (3)

. These systems are symmetric under the action of a rigid motion by a screw belonging to the system. They guarantee full-cycle mobility for closed chains, and exhibit remarkable invariance properties [21].

For those twists systems generated by a kinematic chain, this means that the screw system will remain constant along the motion of the chain. For the case in which the dimension of the twist space coincides with the global degrees of freedom of the chain, this implies that its finite motion must belong to the corresponding subgroup of

S E (3)

If the twist system remains of the same type and also keeps the pitches of the principal screws, but it does not remain constant along the motion, then it is a persistent screw system [21,22]. Those undergo a displacement when changing the configuration of the kinematic chain that generates them, that is, remain within the equivalence class. Invariant systems can be considered as particular cases of persistent systems [23].

While the composition of two revolute joints creates persistent twist systems, in general, for three revolute joints in series this is not the case, and the twist system may change when passing from one configuration of the chain to another. For this most general case, we say that the chain has a variable screw system corresponding to the subspace of twists at different configurations.

Along this work, we will refer to the twist system when denoting the screw system corresponding to a given twist subspace.

3.2. Kinematic Generators of a Twist System

A set of screws

S_{1}

, …,

S_{n}

corresponding to the twists of kinematic pairs connected in series span a screw system, and the chain is the instantaneous kinematic generator of the twist subspace corresponding to that system. Every twist system of dimension 3 can be obtained by specializing the instantaneous kinematic generator formed by three cylindrical joints assembled in series. In any case, the individual twist of each of the joints belongs to the twist system at a given configuration.

In the case of the 3R serial robot, the pitch is zero for each screw corresponding to a joint, and this limits the twist systems that can be generated and correspondingly, the combination of finite and infinitesimal positions that we can define.

The concept of instantaneous kinematic generators has its equivalence in finite motion using the kinematic bond, which is the set of allowed relative displacements between two rigid bodies, belonging to a given kinematic chain. The mechanical generator of the bond is the kinematic chain (that is, the set of kinematic pairs and their connectivity) that generates the bond [24].

3.3. Feasible Screw Systems for the 3R Serial Chain

We consider a screw system as feasible by a given mechanical generator when the instantaneous kinematic generator can span the screw system at a given configuration of the chain.

The identification of those systems of twists of dimension 3 that are feasible for a spatial 3R chain is presented in Table 1. In this table, we present all screw systems of dimension 3 according to the classification in [20], with their pitches and normal form in a particular reference frame, the identification of their completion group, and their invariance properties (whether they are invariant, persistent or variable by the set of instantaneous kinematic generators presented in the normal form). For each system, we include in the last column its feasibility as generated by a 3R mechanical generator.

In the table, we can see that a 3R chain can be designed with specific geometry to have some invariant twist systems, with the corresponding subgroup of motion, and also can be designed for several variable twist systems that allow general motion in

S E (3)

. However, the 3R chain cannot be designed to generate a persistent twist system of dimension 3 that is not invariant. This agrees with the results in [23].

The methodology to prove the feasibility of the 3R chain to generate these twist systems, at any or some particular configuration, is presented in Section 4, and it is used in the subsection below, in particular the matrix formulation presented in Equations (18)–(22).

3.4. Proofs of Feasibility

The principal screws [25] for a 3-twist system can be computed and written, after a coordinate transformation, as

W_{p 1} = \{\begin{matrix} θ_{1} \\ 0 \\ 0 \\ t_{1} \\ 0 \\ 0 \end{matrix}\}, W_{p 2} = \{\begin{matrix} 0 \\ θ_{2} \\ 0 \\ 0 \\ t_{2} \\ 0 \end{matrix}\}, W_{p 3} = \{\begin{matrix} 0 \\ 0 \\ θ_{3} \\ 0 \\ 0 \\ t_{3} \end{matrix}\} .

(8)

We use this form as well as the equivalent normal form [26] used in classifications [19] and presented in Table 1 to derive the reachability conditions for some special cases. For this, we consider the pitch

h_{i} = t_{i} / θ_{i}

The minors of matrices used to prove linear dependence, described in detail in Section 4, can be obtained for the principal screws of the system and the joint axes

S_{j}^{i}

[M_{p i}] = [\begin{matrix} S_{1}^{i} & W_{p 1} & W_{p 2} & W_{p 3} \end{matrix}],

(9)

The computation of the corresponding

4 x 4

minors provides us with simplified equations in terms of the pitches of principal screws,

\begin{matrix} s_{x} t_{1} - s_{x}^{0} θ_{1} = 0, \\ s_{y} t_{2} - s_{y}^{0} θ_{2} = 0, \\ s_{z} t_{3} - s_{z}^{0} θ_{3} = 0 . \end{matrix}

(10)

For twist systems with finite pitch, the Plücker conditions on the moment of the lines,

s s^{0} = 0

, yield the equations,

h_{1} s_{x}^{2} + h_{2} s_{y}^{2} + h_{3} s_{z}^{2} = 0 .

(11)

For the case of one or more pitches being infinite or zero, the minors’ conditions are modified as detailed below.

Table 1 also shows the pitches of the generator screws as

h_{1}

h_{2}

h_{3}

. Using Equations (10) and (11), we can conclude which of the screw systems are reachable for a 3R system.

Screw System $I I D$ : From the ∞ condition for the three pitches, we conclude that

θ_{i}

i = 1, 2, 3

is 0, and from Equation (10) we conclude that

\{\begin{matrix} s_{x} \\ s_{y} \\ s_{z} \end{matrix}\} = \{\begin{matrix} 0 \\ 0 \\ 0 \end{matrix}\},

(12)

for every joint axis. That proves that this system is not feasible for a 3R system.

Screw System $I I A (h = 0)$ : The 0 condition on all three pitches implies

s_{i}^{0} = 0

for each joint

S_{i}

, which means that all three axes must intersect at the center of the twist system. They must also be independent in order for the dimension to be three. The system is feasible.

Screw System $I I C (h = 0)$ : A similar strategy for this system reveals that, for the normal form of the table,

s_{y}

s_{z}

and

s_{x 0}

must be zero, while

s_{x}

is not restricted. The joint axes have direction x and are parallel, located anywhere in the perpendicular plane. The system is feasible.

Screw System $I I C (h \neq 0)$ : In this system also using Equation (10), we conclude that

s_{y}

and

s_{z}

must be zero, so the joint axes must be directed along the x axis. Imposing Equation (11) gives

h_{1} s_{x}^{2} = 0,

(13)

and thus,

s_{x}

is also zero, which proves that the system is not feasible.

Screw System $I C (h \neq 0)$ : In this system, since the screw system is not in the principal form, we use Equation (9) to conclude

s_{y} = 0

s_{z} = 0

p s_{x}^{0} = s_{z}^{0}

. Imposing from the Plücker coordinate condition of

s_{i} s_{i}^{0} = 0

, we have

s_{x} s_{x}^{0} = 0

and since

s_{x} \neq 0

, we get

s_{x}^{0} = s_{z}^{0} = 0

. This will result in the

S_{i}

being

S_{i} = \{\begin{matrix} 1 \\ 0 \\ 0 \end{matrix}\} + ϵ \{\begin{matrix} 0 \\ s_{y}^{0} \\ 0 \end{matrix}\} .

(14)

The resulting axes are clearly linearly dependent and create a 2-system, which will not be able to generate linear velocity, for instance, in the x direction, although they are contained in this screw system. We can conclude that the system is not completely feasible, only a subspace of twists is.

Screw System $I C^{0}$ : Similar to system

I C

, the conditions for this system result in three linearly dependent axes of the same form as the previous one, forming a subspace of dimension two. The system cannot be fully generated by a 3R chain.

Screw System $I I B$ : In this system, Equation (10) provides that

s_{z} = 0

, and Equation (11) turns to

h (s_{x}^{2} + s_{y}^{2}) = 0,

(15)

for which

s_{x}

and

s_{y}

must be zero and makes the system not feasible by the 3R chain.

Screw System $I I B^{0}$ : Applying linear dependence, we obtain that

s_{z} = 0

s_{x 0} = s_{y 0} = 0

. A 3R chain with axes on the

x - y

plane can generate this system.

Screw System $I B_{0} (h_{1} \neq h_{2})$ : In this case, imposing linear dependence yields the equations

\begin{matrix} s_{z} = 0, \\ s_{y 0} - h_{1} s_{y} = 0, \\ h_{2} (h_{1} s_{x} - s_{x 0}) + s_{z 0} = 0, \end{matrix}

(16)

which means that we have three free parameters to define the three independent joint axes in order to generate the twist system. From the equations, we can see that

s_{x} \neq 0

Screw System $I B_{3} (h_{1} \neq h_{2})$ : A similar approach provides

s_{z} = 0

and

h_{1} s_{x}^{2} + h_{2} s_{y}^{2} = 0

. This makes the twist feasible with the condition that the pitches of the imposed screw system have opposite signs.

Screw System $I I A ((h \neq 0)$ : For this system, the condition from Equation (11) yields

h (s_{x}^{2} + s_{y}^{2} + s_{z}^{2}) = 0,

that requires

s = 0

, which cannot span a revolute joint, or

h = 0

, which is a different screw system. The system is not feasible.

Screw System $I A_{2} (h_{1} \neq h_{2})$ : Equation (11) for this system gives

h_{1} s_{x}^{2} + h_{2} (s_{y}^{2} + s_{z}^{2}) = 0

. It is possible to create three revolute joints to obtain this twist system, with

s_{x} \neq 0

and as long as the pitches have opposite signs.

Screw System $I A_{1} (h_{1} \neq h_{2} \neq h_{3})$ : This is the most general three-dimensional screw system. In this case, we obtain

h_{1} s_{x}^{2} + h_{2} s_{y}^{2} + h_{3} s_{z}^{2} = 0

, which is feasible when one of the pitches has an opposite sign to the other two.

3.5. The 3R Chain as a Kinematic Generator of Twists

A 3R chain can generate those twists systems that are feasible, for at least one particular configuration of the chain. The interesting information of Table 1 is that it shows the twist systems of dimension 3 (with the corresponding completion subgroup of

S E (3)

) and whether or not they can be realized with a spatial 3R chain.

In general, the relative finite motion defined by

D_{3 R}

in Equation (1) must be obtained from the twist of the end-effector,

W_{e e}

in Equation (6) at the initial configuration. When the complete twist space is defined at that position, the subsequent finite motion must belong to the completion group of the twist system.

4. Synthesis with a Specified Twist Space

Once the feasible twist spaces that can be generated by a 3R chain are identified, we can state a synthesis problem in which finite precision positions, as well as the full subspace of potential velocities at those positions, are imposed to the chain. The type of twist system (whether it is invariant, persistent or variable), as well as the completion group of the targeted system, are important inputs in this process.

One important point to consider is that we can define arbitrary finite motions of the chain for synthesis purposes only in the cases for which the completion group of the imposed twist system is the whole

S E (3)

. This consideration is not necessary if we only partially specify the twist system.

Another important point is that if we specify an invariant or persistent screw system, it is enough to specify it at the reference configuration, which simplifies the equations.

In this section, we derive the synthesis equations that can be imposed for the twist system and the finite solutions, and how to solve the overall system of equations.

Let us consider a 3R chain with joint axes

S_{j}^{i}

j = 1, 2, 3

. The superscript i indicates the configuration of the chain. Each revolute joint axis

S_{j}

can apply an angular velocity of magnitude

{\dot{θ}}_{j}

Assume that, at a given position i, we impose a twist system given by twists

W_{k}

k = 1, 2, 3

if we fully specify the 3D twist system. The matching of the twists at position i,

S_{1}^{i} {\dot{θ}}_{1 k}^{i} + S_{2}^{i} {\dot{θ}}_{2 k}^{i} + S_{3}^{i} {\dot{θ}}_{3 k}^{i} = W_{k}, k = 1, 2, 3,

(17)

is equivalent to the condition on the rank of the space spanned by the axes and the twists,

r a n k [\begin{matrix} S_{1}^{i} & S_{2}^{i} & S_{3}^{i} & W_{1} & W_{2} & W_{3} \end{matrix}] = 3 .

(18)

This condition can be simplified. In order for the 3R chain to be able to perform the twists defined in Equation (7), each of the joint rotations

S_{j}^{i} {\dot{θ}}_{j}^{i}

must belong to the subspace

W^{i}

, in particular with angular velocity equal to one. To study the solutions of the problem, note that the specified twists can be defined at any configuration of the robot, in particular at the reference configuration; it is always possible to switch the reference configuration as needed.

This allows us to write the three conditions for the minors of matrices

M_{j}

, with

[M_{j}] = [\begin{matrix} S_{j} & W_{1} & W_{2} & W_{3} \end{matrix}],

(19)

such that

r a n k ([M_{j}]) = 3, j = 1, 2, 3 .

(20)

Notice that this condition implies only that the twist system of the three axes is contained in the specified twist system,

< S_{1}, S_{2}, S_{3} > \subseteq < W_{1}, W_{2}, W_{3} > .

(21)

In order to impose equality, we need the condition that the three twists of the screw axes are independent,

r a n k ([\begin{matrix} S_{1} & S_{2} & S_{3} \end{matrix}]) = 3 .

(22)

However, this condition is implied in the additional finite-position synthesis equations.

The 3 independent minors per axis are linear in the Plücker coordinates of the axes, for a total of 9 linear equations.

To this condition for the twist system at the reference configuration, we add the condition that the chain must pass through two exact positions. The finite-position synthesis equations are written using Equation (5) and considering the six-dimensional dual vector part only, for one relative position of dual vector P,

I c_{θ_{1}} c_{θ_{2}} + S_{1} s_{θ_{1}} c_{θ_{2}} + S_{2} c_{θ_{1}} s_{θ_{2}} + S_{1} S_{2} s_{θ_{1}} s_{θ_{2}} = P c_{θ_{3}} - P S_{3} s_{θ_{3}},

(23)

where

c_{θ_{i}}

and

s_{θ_{i}}

denote the cosine and sine of the half angle for each joint variable.

In summary, the exact synthesis for a specified twist space of dimension 3 at a position can be stated for the 3R serial chain if the chain must reach two exact positions, having a fully defined compatible twist space in one of them, in particular in position 1, which will be taken as the reference configuration.

Solving the System of Equations

The nine linear equations obtained for the twist space from Equation (20) can be used to express some of the Plücker coordinates of the joints as a function of the others. For instance, we can keep as independent the directions of the joint axes

s_{i}

, with

\begin{matrix} s_{i}^{0} = \frac{1}{w_{1} \cdot w_{2} \times w_{3}} & (v_{1} s_{i} \cdot w_{2} \times w_{3} + v_{2} s_{i} \cdot w_{3} \times w_{1} + v_{3} s_{i} \cdot w_{1} \times w_{2}), \\ i = 1, 2, 3 . \end{matrix}

(24)

The selection of variables in this step depends on the twist system that we define for the end-effector; the procedure presented here could be used, for instance, for the most general

I A_{1}

system.

The Plücker conditions on the moment of the lines,

s_{i} s_{i}^{0} = 0

, yield three homogeneous quadratic equations with identical coefficients when substituting the values of Equation (24),

\begin{matrix} k_{1} s_{i x}^{2} + k_{2} s_{i y}^{2} + k_{3} s_{i z}^{2} + k_{4} s_{i x} s_{i y} + k_{5} s_{i x} s_{i z} + k_{6} s_{i y} s_{i z} = 0, \\ i = 1, 2, 3 . \end{matrix}

(25)

This corresponds to the three directions lying on a real elliptic cone. In addition, the directions must be unit, so they also lie on the unit sphere,

s_{i x}^{2} + s_{i y}^{2} + s_{i z}^{2} = 1, i = 1, 2, 3 .

(26)

The intersection of these two surfaces is a spheroconic, an elliptic quartic curve, and it is shown in Figure 2. Notice that the directions can be arbitrarily assigned to either one or the other intersection curves.

The system of equations for one relative position in (23) contains eight quartic equations, six of them being independent once the Plücker conditions for the axes are imposed.

In all, we obtain a set of 12 equations (15 if we make the cosine and sine of the angles algebraic by imposing

c_{θ_{i}}^{2} + s_{θ_{i}}^{2} = 1

), which can be solved to obtain the solutions of the system. The system is summarized in Equation (27), where the forward kinematics are separated in two sets, one for the real and another one for the dual part of the equations:

\begin{matrix} k_{1} s_{i x}^{2} + k_{2} s_{i y}^{2} + k_{3} s_{i z}^{2} + k_{4} s_{i x} s_{i y} + k_{5} s_{i x} s_{i z} + k_{6} s_{i y} s_{i z} = 0, \\ s_{i x}^{2} + s_{i y}^{2} + s_{i z}^{2} = 1, \\ c_{θ_{i}}^{2} + s_{θ_{i}}^{2} = 1, i = 1, 2, 3; \\ s_{1} s_{θ_{1}} c_{θ_{2}} + s_{2} c_{θ_{1}} s_{θ_{2}} + s_{1} \times s_{2} s_{θ_{1}} s_{θ_{2}} = p c_{θ_{3}} - (p_{w} s_{3} + p \times s_{3}) s_{θ_{3}}, \\ s_{1}^{0} s_{θ_{1}} c_{θ_{2}} + s_{2}^{0} c_{θ_{1}} s_{θ_{2}} + (s_{1} \times s_{2}^{0} + s_{1}^{0} \times s_{2}) s_{θ_{1}} s_{θ_{2}} = \\ p^{0} c_{θ_{3}} - (p_{w 0} s_{3} + p^{0} \times s_{3} + p \times s_{3}^{0}) s_{θ_{3}}, \end{matrix}

(27)

where we substitute

s_{i}^{0}

with their expressions as a function of

s_{i}

in Equation (24). Variables can also be further eliminated using standard techniques for a graphical representation of the solutions, see Figure 3.

The multiple solutions contain a subset, which generates the twist system at the first position but does not reach the second position. Those are due to the lack of information in the selected equations about the conjugation of the third axes, and can be eliminated by checking the forward kinematics. They account for a reduction to half the number of solutions. The remaining set contains repeated solutions due to the sign duplication in each axes, and to the cosine and sine of the half angles. The final set corresponds to

1 / 2^{6}

of the initial solution set.

The final number of solutions obtained depends on the screw system selected; for the most general type, we obtain 4 non-repeated solutions.

5. Design for Lower-Dimensional Twist Spaces

Even though the maximum number of twists we can define per position is three, we can also specify two or one twist, for instance, for trajectory guidance purposes. We are not targeting singularity placement here, but rather incompletely defined infinitesimal motion.

In the example below (Example 1), a generic 3R robot was designed for reaching two positions; for one of them, the twist of the end-effector is generated by two perpendicular angular velocities only, and for the other one, a single twist is defined, corresponding to angular velocity about an independent axis. The positions and twists are specified in Table 2.

A total of 12 different solutions was obtained. The resulting joint axes at the reference configuration for the robot in Figure 4 are shown in Table 3.

In Figure 4, the 3R robot is shown at two positions. Notice how the first two of the axes intersect. It is interesting to notice that five of the solutions have the first and second axes

S_{1}

and

S_{2}

intersecting, while the rest have generally oriented axes for which axes

S_{1}

and

S_{3}

intersected at the second position.

Figure 5 shows the subspace of potential twists of the end-effector at the first and second positions for the selected solution, matching the specifications for the span of the two angular velocities at the points.

Figure 6 shows another of the solution robots for which axes

S_{1}

and

S_{3}

intersect at the second position only.

6. Design for Fully Specified Twist Space

Designing for velocity subspaces allows for complete control of the motion of multi-DoF systems at particular positions. It can also be used for the design of non-general robots, for instance with parallel axes, without having possible degeneracy problems and without adding geometric constraints between axes.

The equations obtained with the elimination process can be solved with exact coefficients to obtain the complete set of solutions by using the numerical Groebner basis, and the results are obtained in a few seconds using symbolic software. Other numerical solvers, such as the Levenberg–Marquardt optimizer, can be used to obtain one solution at a time for a faster result.

6.1. Example 2: Arbitrary Finite Motion and General Twist System

For two random positions and three random twists defined at the first position, the system of equations yields four real solutions. Table 4 shows the input positions and twist system, and Figure 7 shows the motion of one of those robots from position 1 to position 2. Its resulting axes at the reference configuration are shown in Table 5.

6.2. Example 3: Invariant Twist System–Motion within a Subgroup of SE(3)

For this example, a 3R robot is to be synthesized in order to have a twist space of angular velocities only, as shown in Table 6. The compatible finite positions must belong to the subgroup of pure rotations

S O (3)

The twist system equations immediately yield

s i 0 = \vec{0}

for all three axes, which only have to enforce the unit conditions. The finite position equations for the relative displacement reduce to the quaternion equations. The joint axes at the reference configuration are shown in Table 7. All three axes intersect at the origin as expected without the need to enforce this condition in the synthesis equations. Figure 8 shows the robot reaching the two positions and the intersecting joint axes that ensure the twist of the end-effector to be as defined and, in addition, invariant.

7. Conclusions

The synthesis of spatial 3R chains with the prescribed twist space at particular configurations is studied in this work, extending the current technique of defining a single velocity for guidance along a trajectory. The mixed-position synthesis with fully specified twist spaces allows for full control of the motion in proximity of key positions. In addition, it allows for the synthesis of planar, spherical or other robots with specific geometry within the same synthesis process. Algebraic equations as well as numerical results are presented, and the compatibility between finite positions and potential twists is studied, concluding that the spatial 3R chain can have potential motions corresponding to seven different twist systems of dimension three, among them the two invariant systems corresponding to SO(3) and SE(2) finite motions; in these cases, positions for the chain cannot be defined arbitrarily, as they need to belong to the same completion group. An interesting extension could be finding the conditions to impose lower-dimensional subspaces at particular configurations in order to place singularities at desired locations.

Author Contributions

Conceptualization, N.H. and A.P.-G.; methodology, N.H. and A.P.-G.; software, N.H. and A.P.-G.; validation, N.H.; formal analysis, N.H. and A.P.-G.; investigation, N.H. and A.P.-G.; resources, N.H. and A.P.-G.; data curation, N.H.; writing—original draft preparation, A.P.-G.; writing—review and editing, N.H. and A.P.-G.; visualization, N.H.; supervision, A.P.-G.; project administration, A.P.-G.; funding acquisition, A.P.-G. All authors have read and agreed to the published version of the manuscript.

Funding

This research was partially supported by the National Science Foundation under Grant No. 1208385. The content is solely the authors’ responsibility.

Informed Consent Statement

Not applicable.

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

References

Sandor, G.; Freudenstein, F. Higher-order plane motion theories in kinematic synthesis. J. Eng. Ind. 1967, 89, 223–230. [Google Scholar] [CrossRef]
Kramer, R.S.S. Selective precision synthesis of planar mechanisms satisfying position and velocity constraints. Mech. Mach. Theory 1979, 14, 161–170. [Google Scholar]
Holte, J.; Chase, T.; Erdman, A. Approximate velocities in mixed exact-approximate position synthesis of mechanisms. AMSE J. Mech. Des. 2001, 123, 388–394. [Google Scholar] [CrossRef]
Sathyadev, D.; Soni, A. Synthesis of planar mechanisms for coupler tangent-line envelope generation: An alternative to coupler point-path generation. ASME J. Mech. Des. 1988, 110, 122–129. [Google Scholar] [CrossRef]
Chen, P.; Roth, B. A unified theory for the finitely and infinitesimally separated position problems of kinematic synthesis. ASME J. Eng. Ind. 1969, 91, 203–208. [Google Scholar] [CrossRef]
Chen, P.; Roth, B. Design equations for finitely and infinitesimally separated position synthesis of binary link and combined link chains. ASME J. Eng. Ind. 1969, 91, 209–219. [Google Scholar] [CrossRef]
Tsai, L.W.; Roth, B. Design of dyads with helical, cylindrical, spherical, revolute and prismatic joints. Mech. Mach. Theory 1972, 7, 85–102. [Google Scholar] [CrossRef]
Robson, N.; McCarthy, J. Second order task specifications used in the geometric design of spatial mechanical linkages. Int. J. Mod. Eng. 2010, 11, 5–11. [Google Scholar]
Robson, N.; Chen, B. Geometric Design with Multiple Realizable Motion Directions in the Vicinity of a Planar Mechanism-Environment Contact. In Proceedings of the ASME 2018 International Design Engineering Technical Conferences and Computers and Information in Engineering Conference IDETC/CIE 2018, Quebec City, QC, Canada, 26–29 August 2018. [Google Scholar]
Moon, H.; Robson, N.; Langari, R. Approximating elbow constrained hand paths via kinematic synthesis with contact specifications. In Advances in Robot Kinematics; Lenarcic, J., Khatib, O., Eds.; Springer: Berlin/Heidelberg, Germany, 2014. [Google Scholar]
Robson, N.; Soh, G.S. Kinematic Synthesis of Planar Multi-limb Mechanisms for Multi-directional Interaction with Bodies in the Environment. In Advances in Robot Kinematics 2018; Lenarcic, J., Parenti-Castelli, V., Eds.; Springer International Publishing: Berlin/Heidelberg, Germany, 2018; pp. 356–363. [Google Scholar]
Hasanzadeh, N.; Gosh, S.; Robson, N.; Perez-Gracia, A. Velocity-field tasks for in-hand manipulative synthesis. In Advances in Robot Kinematics; Merlet, J., Lenarcic, J., Eds.; Springer: Berlin/Heidelberg, Germany, 2016. [Google Scholar]
Robson, N.; Ghosh, S.; Soh, G.S. Kinematic Synthesis and Design of the Robust Closed Loop Articulated Minimally actuated (CLAM) Hand. Robotica 2019, 38, 1921–1939. [Google Scholar] [CrossRef]
Tian, C.; Fang, Y.; Ge, Q.J. Structural synthesis of parallel manipulators with coupling sub-chains. Mech. Mach. Theory 2017, 118, 84–99. [Google Scholar] [CrossRef]
Lee, E.; Mavroidis, C. Solving the geometric design problem of spatial 3r robot manipulators using polynomial homotopy continuation. ASME J. Mech. Des. 2002, 124, 652–661. [Google Scholar] [CrossRef]
Lee, E.; Mavroidis, C. An elimination procedure for solving the geometric design of spatial 3r manipulators. ASME J. Mech. Des. 2006, 128, 142–146. [Google Scholar] [CrossRef]
Lee, E.; Mavroidis, C.; Merlet, J. Five precision point synthesis of spatial rrr manipulators using interval analysis. ASME J. Mech. Des. 2004, 126, 842–850. [Google Scholar] [CrossRef]
Hauenstein, J.D.; Wampler, C.W.; Pfurner, M. Synthesis of three-revolute spatial chains for body guidance. Mech. Mach. Theory 2017, 110, 61–72. [Google Scholar] [CrossRef]
Gibson, C.; Hunt, K. Geometry of screw systems–2: Classification of screw systems. Mech. Mach. Theory 1990, 25, 11–27. [Google Scholar] [CrossRef]
Selig, J.M. Geometric Fundamentals of Robotics Monographs in Computer Science, 2nd ed.; Springer: Berlin/Heidelberg, Germany, 2005. [Google Scholar]
Carricato, M.; Zlatanov, D. Persistent Screw Systems. Mech. Mach. Theory 2014, 73, 296–313. [Google Scholar] [CrossRef]
Carricato, M.; Rico-Martinez, J. Persistent screw systems. In Advances in Robot Kinematics: Motion in Man and Machine; Lenarcic, J., Stanisic, M., Eds.; Springer: Berlin/Heidelberg, Germany, 2010; pp. 185–194. [Google Scholar]
Carricato, M.; Rico-Martinez, J. Persistent screw systems of Dimension 3. In Proceedings of the 13th World Congress in Mechanism and Machine Science, Guanajuato, Mexico, 19–23 June 2011. [Google Scholar]
Huynh, P.; Hervé, J.M. Equivalent Kinematic Chains of Three Degree-of-Freedom Tripod Mechanisms with Planar-Spherical Bonds. J. Mech. Des. 2005, 127, 95–102. [Google Scholar] [CrossRef]
Tsai, M.; Lee, H. On the Special Bases of Two- and Three-Screw Systems. ASME J. Mech. Des. 1993, 115, 540–546. [Google Scholar] [CrossRef]
Donelan, P.; Gibson, C. On the hierarchy of Screw Systems. Acta Appl. Math. 1993, 32, 267–296. [Google Scholar] [CrossRef]

Figure 1. The spatial 3R chain. Forward kinematics is the product of the relative displacement

D_{3 R}

and the displacement to the reference configuration

D_{0}

. Twist of the end-effector expressed in the fixed frame is

W_{e e}

Figure 1. The spatial 3R chain. Forward kinematics is the product of the relative displacement

D_{3 R}

and the displacement to the reference configuration

D_{0}

. Twist of the end-effector expressed in the fixed frame is

W_{e e}

Figure 2. Locus of the direction of the axes from the twist conditions. A general case (left) and a case in which the elliptic cone degenerates to two planes (right).

Figure 3. Solutions can be found as the intersection of the elliptic cone, the unit sphere and the relative position condition. Here, the curves are depicted for one solution value of the angle

θ_{2}

. Green curve: intersection of the elliptic cone with the unit sphere. Red curve: intersection of the elliptic cone and the relative position condition. Blue curve: intersection of the unit sphere and the relative position condition. The intersections of the curves are the solutions for the direction of the second joint axes,

s_{2}

Figure 3. Solutions can be found as the intersection of the elliptic cone, the unit sphere and the relative position condition. Here, the curves are depicted for one solution value of the angle

θ_{2}

s_{2}

Figure 4. Example 1: The 3R robot reaching the two positions shown in Table 3. The joint axes are shown as dashed lines and link colors are those of Figure 1. Notice that two of the axes intersect at a point.

Figure 5. Example 1: Twists of the end effector. Left: subspaces of dimension 2 corresponding to the angular velocities of the end-effector at positions 1 and 2. Right: plots corresponding to the linear velocities. At position 2, the linear velocity subspace is of dimension 1.

Figure 6. Example 1: A second 3R robot solution for Example 1 showing the first and third axes intersection at the second position.

Figure 7. Example 2: One 3R robot solution at the first and second positions (top) and during the movement (bottom).

Figure 8. Example 3: Solution 3R robot for a specified angular twist space at the origin. Dotted lines correspond to the joint axes at each position.

Table 1. Twist systems of dimension 3 [20] and their synthesis properties.

Completion Group	Gibson Hunt Type	Normal Form	$h_{1}$	$h_{2}$	$h_{3}$	Invariance	Feasible
		$(0, 0, 0, 1, 0, 0)$
$R^{3}$	$I I D$	$(0, 0, 0, 0, 1, 0)$	∞	∞	∞	Invariant	NO
		$(0, 0, 0, 0, 0, 1)$
		$(1, 0, 0, 0, 0, 0)$
$S O (3)$	$I I A$ $(h = 0)$	$(0, 1, 0, 0, 0, 0)$	0	0	0	Invariant	YES
		$(0, 0, 1, 0, 0, 0)$
		$(1, 0, 0, 0, 0, 0)$
$S E (2)$	$I I C$ $(h = 0)$	$(0, 0, 0, 0, 1, 0)$	0	∞	∞	Invariant	YES
		$(0, 0, 0, 0, 0, 1)$
		$(1, 0, 0, h, 0, 0)$
$H_{p} ⋉ R^{2}$	$I I C$ $(h \neq 0)$	$(0, 0, 0, 0, 1, 0)$	h	∞	∞	Invariant	NO
		$(0, 0, 0, 0, 0, 1)$
		$(1, 0, 0, 0, 0, 0)$
$S E (2) ⋉ R$	$I C$ $(h \neq 0)$	$(0, 0, 0, 0, 1, 0)$	0	∞	∞	Variable	NO
		$(0, 0, 0, 1, 0, h)$
		$(1, 0, 0, 0, 0, 0)$
$S E (2) ⋉ R$	$I C^{0}$	$(0, 0, 0, 0, 1, 0)$	0	∞	∞	Persistent	NO
		$(0, 0, 0, 1, 0, 0)$
		$(1, 0, 0, h, 0, 0)$
$S E (3)$	$I I B$	$(0, 1, 0, 0, h, 0)$	h	h	∞	Variable	NO
		$(0, 0, 0, 0, 0, 1)$
		$(1, 0, 0, 0, 0, 0)$
$S E (3)$	$I I B^{0}$	$(0, 1, 0, 0, 0, 0)$	0	0	∞	Variable	YES
		$(0, 0, 0, 0, 0, 1)$
		$(1, 0, 0, h_{1}, 0, 0)$
$S E (3)$	$I B_{0}$ $(h_{1} \neq h_{2})$	$(0, 1, 0, 0, h_{1}, 0)$	$h_{1}$	$h_{1}$	∞	Variable	YES
		$(0, 0, 0, 1, 0, h_{2})$
		$(1, 0, 0, h_{1}, 0, 0)$
$S E (3)$	$I B_{3}$ $(h_{1} \neq h_{2})$	$(0, 1, 0, 0, h_{2}, 0)$	$h_{1}$	$h_{2}$	∞	Variable	YES
		$(0, 0, 0, 0, 0, 1)$					$S i g n (h_{1}) \neq S i g n (h_{2})$
		$(1, 0, 0, h, 0, 0)$
$S E (3)$	$I I A$ $(h \neq 0)$	$(0, 1, 0, 0, p, 0)$	h	h	h	Variable	NO
		$(0, 0, 1, 0, 0, h)$
		$(1, 0, 0, h_{1}, 0, 0)$
$S E (3)$	$I A_{2}$ $(h_{1} \neq h_{2})$	$(0, 1, 0, 0, h_{2}, 0)$	$h_{1}$	$h_{2}$	$h_{2}$	Variable	YES
		$(0, 0, 1, 0, 0, h_{2})$					$S i g n (h_{1}) \neq S i g n (h_{2})$
		$(1, 0, 0, h_{1}, 0, 0)$
$S E (3)$	$I A_{1}$ $(h_{1} \neq h_{2} \neq h_{3})$	$(0, 1, 0, 0, h_{2}, 0)$	$h_{1}$	$h_{3}$	$h_{2}$	Variable	YES
		$(0, 0, 1, 0, 0, h_{3})$					$S i g n (h_{i}) \neq S i g n (h_{j})$

Table 2. Example 1: Input positions, expressed as dual quaternions, and end-effector twists.

Position	End-Effector Twists
$0.18 - 0.72 i - 0.63 j - 0.21 k$	$W_{1}^{1} = (0.29, 0, 0, 0, 0, 0, 0)$
$+ ϵ (- 0.28 i + 0.33 j - 0.27 k - 0.28)$
$0.99 + 0.01 i - 0.02 j$	$W_{1}^{2} = (0, 0.12, 0, 0, 0, 0)$
$+ ϵ (0.40 i - 0.73 j - 0.10 k - 0.02)$	$W_{2}^{2} = (0, 0, 0.27, 0, 0, 0)$

Table 3. Example 1: Plücker coordinates of the joint axes of one of the solutions of the 3R robot at the reference configuration.

Axes	Plücker Coordinates
$S_{1}$	$(0.843, - 0.161, 0.514) + (- 0.864, - 0.750, 1.182)$
$S_{2}$	$(- 0.640, 0.133, 0.757) + (- 0.998, 0.634, - 0.956)$
$S_{3}$	$(0.879, - 0.191, - 0.436) + (0.490, - 0.904, 1.386)$

Table 4. Example 2: Input positions, expressed as dual quaternions, and end-effector twists.

Position	End-Effector Twists $W_{1}^{1}, W_{2}^{1}, W_{3}^{1}$
$0.18 - 0.72 i - 0.63 j - 0.21 k$	$(1.67, 1.84, - 0.11, 0.12, 0.29, 3.42)$
$+ ϵ (- 0.28 i + 0.33 j - 0.27 k - 0.28)$	$(2.39, 3.42, 0.35, 0.46, - 0.72, 6.87)$
	$(- 4.84, 0.13, 3.86, 1.57, - 9.34, 3.33)$
$1.0 + 0.01 i - 0.025 j - 0.004 k$
$+ ϵ (0.40 i - 0.73 j - 0.10 k - 0.02)$

Table 5. Example 2: Plücker coordinates of the joint axes of the 3R robot at the reference configuration.

Axes	Plücker Coordinates
$S_{1}$	$(0.76, - 0.09, - 0.65) + ϵ (- 0.20, 1.70, - 0.46)$
$S_{2}$	$(0.58, 0.81, 0.08) + ϵ (0.08, - 0.21, 1.55)$
$S_{3}$	$(0.81, 0.51, - 0.30) + ϵ (- 0.19, 0.52, 0.39)$

Table 6. Example 3: Input positions, expressed as dual quaternions, and end-effector twists.

Position	End-Effector Twists
$0.999 + 0.017 i$
$0.701 + 0.397 i + 0.131 j - 0.577 k$	$W_{1}^{2} = (1, 0, 0, 0, 0, 0)$
	$W_{2}^{2} = (0, 1, 0, 0, 0, 0)$
	$W_{3}^{2} = (0, 0, 1, 0, 0, 0)$

Table 7. Example 3: Plücker coordinates of the joint axes of the 3R robot at the reference configuration.

Axes	Plücker Coordinates
$S_{1}$	$(- 0.507, - 0.025, 0.861) + ϵ (0, 0, 0)$
$S_{2}$	$(0.704, 0.168, 0.690) + ϵ (0, 0, 0)$
$S_{3}$	$(0.025, - 0.973, - 0.229) + ϵ (0, 0, 0)$

Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

© 2022 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https://creativecommons.org/licenses/by/4.0/).

Share and Cite

MDPI and ACS Style

Hassanzadeh, N.; Perez-Gracia, A. Mixed Position and Twist Space Synthesis of 3R Chains. Robotics 2022, 11, 13. https://doi.org/10.3390/robotics11010013

AMA Style

Hassanzadeh N, Perez-Gracia A. Mixed Position and Twist Space Synthesis of 3R Chains. Robotics. 2022; 11(1):13. https://doi.org/10.3390/robotics11010013

Chicago/Turabian Style

Hassanzadeh, Neda, and Alba Perez-Gracia. 2022. "Mixed Position and Twist Space Synthesis of 3R Chains" Robotics 11, no. 1: 13. https://doi.org/10.3390/robotics11010013

APA Style

Hassanzadeh, N., & Perez-Gracia, A. (2022). Mixed Position and Twist Space Synthesis of 3R Chains. Robotics, 11(1), 13. https://doi.org/10.3390/robotics11010013

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Menu

Mixed Position and Twist Space Synthesis of 3R Chains

Abstract

1. Introduction

2. The 3R Serial Chain

2.1. Forward and Inverse Kinematics of the 3R Chain

2.2. Space of Potential Twists of the End-Effector

3. Twist Spaces of Dimension 3 for the Serial 3R Chain

3.1. Finite and Infinitesimal Motion

3.2. Kinematic Generators of a Twist System

3.3. Feasible Screw Systems for the 3R Serial Chain

3.4. Proofs of Feasibility

3.5. The 3R Chain as a Kinematic Generator of Twists

4. Synthesis with a Specified Twist Space

Solving the System of Equations

5. Design for Lower-Dimensional Twist Spaces

6. Design for Fully Specified Twist Space

6.1. Example 2: Arbitrary Finite Motion and General Twist System

6.2. Example 3: Invariant Twist System–Motion within a Subgroup of SE(3)

7. Conclusions

Author Contributions

Funding

Informed Consent Statement

Data Availability Statement

Conflicts of Interest

References

Share and Cite

Article Metrics

Article Access Statistics

Further Information

Guidelines

MDPI Initiatives

Follow MDPI