InTech uses cookies to offer you the best online experience. By continuing to use our site, you agree to our Privacy Policy.

Robotics » Robotics and Automation » "Parallel Manipulators, New Developments", book edited by Jee-Hwan Ryu, ISBN 978-3-902613-20-2, Published: April 1, 2008 under CC BY-NC-SA 3.0 license. © The Author(s).

Chapter 9

Design and Prototyping of a Spherical Parallel Machine Based on 3-CPU Kinematics

By Massimo Callegari
DOI: 10.5772/5368

Article top

Overview

Architecture of the assembly system based on two cooperating parallel robots
Figure 1. Architecture of the assembly system based on two cooperating parallel robots
Limb of connectivity 5 able to generate a spherical motion of the platform
Figure 2. Limb of connectivity 5 able to generate a spherical motion of the platform
Limb with subgroup RRR able to generate the subgroup of planar displacements
Figure 3. Limb with subgroup RRR able to generate the subgroup of planar displacements
Merge of two adjacent joints able to yield universal (a) or cylindrical (b) pairs
Figure 4. Merge of two adjacent joints able to yield universal (a) or cylindrical (b) pairs
Synthesis of URU limbs (a) and sketch of the 3-URU mechanism (b)
Figure 5. Synthesis of URU limbs (a) and sketch of the 3-URU mechanism (b)
Synthesis of CRU and URC limbs (a) and sketch of the 3-CRU mechanism (b)
Figure 6. Synthesis of CRU and URC limbs (a) and sketch of the 3-CRU mechanism (b)
Synthesis of UPU limbs (a) and sketch of the 3- UPU mechanism (b)
Figure 7. Synthesis of UPU limbs (a) and sketch of the 3- UPU mechanism (b)
Synthesis of CPU and UPC limbs (a) and sketch of the 3- CPU mechanism (b)
Figure 8. Synthesis of CPU and UPC limbs (a) and sketch of the 3- CPU mechanism (b)
Synthesis of CRC limbs (a) and sketch of the 3- CRC mechanism (b)
Figure 9. Synthesis of CRC limbs (a) and sketch of the 3- CRC mechanism (b)
Setting of the 3 axes normal to limbs’ planes: coplanar (a) and orthogonal (b)
Figure 10. Setting of the 3 axes normal to limbs’ planes: coplanar (a) and orthogonal (b)
Concept of a 3-URU (a) and 3-CRU (b) spherical parallel machine (home pose)
Figure 11. Concept of a 3-URU (a) and 3-CRU (b) spherical parallel machine (home pose)
Concept of a 3-UPU (a) and 3-CPU (b) spherical parallel machine (home pose)
Figure 12. Concept of a 3-UPU (a) and 3-CPU (b) spherical parallel machine (home pose)
Concept of a 3-CRC spherical parallel machine (home pose)
Figure 13. Concept of a 3-CRC spherical parallel machine (home pose)
Placement of reference frames (home pose) (a) and geometry of a single limb (b)
Figure 14. Placement of reference frames (home pose) (a) and geometry of a single limb (b)
Setting of local limb frames
Figure 15. Setting of local limb frames
Projection of direct kinematics singularity surface on several coordinate planes: α=0  (a), α=40  (b), α=80  (c), β=0  (d), β=45  (e), β=89  (f)
Figure 16. Projection of direct kinematics singularity surface on several coordinate planes: α=0 (a), α=40 (b), α=80 (c), β=0 (d), β=45 (e), β=89 (f)
Determinant of the geometric Jacobian matrix on the planes α=0  (a),  α=40  (b),  α=80  (c) and representation of manipulator configurations.
Figure 17. Determinant of the geometric Jacobian matrix on the planes α=0 (a), α=40 (b), α=80 (c) and representation of manipulator configurations.
Singularity surface in the α,β,γ space (a); colour map representing local determinant values (b) and close-up view of a connected singularity-free region.
Figure 18. Singularity surface in the α,β,γ space (a); colour map representing local determinant values (b) and close-up view of a connected singularity-free region.
Singularity-free regions inside workspace for twist angle equal to 20  (a) and 60  (b)
Figure 19. Singularity-free regions inside workspace for twist angle equal to 20 (a) and 60 (b)
Values of mass matrix’ elements for null roll angle, i.e. γ=0 (note the different scales of the plots)
Figure 20. Values of mass matrix’ elements for null roll angle, i.e. γ=0 (note the different scales of the plots)
Plots of mass matrix’ elements, normalised by determinant value, for null roll angle, i.e. γ=0 (note that all the scales of the graphs are multiplied by 10-6 but M(1,2) and M(2,3) which are multiplied by 10-7)
Figure 21. Plots of mass matrix’ elements, normalised by determinant value, for null roll angle, i.e. γ=0 (note that all the scales of the graphs are multiplied by 10-6 but M(1,2) and M(2,3) which are multiplied by 10-7)
Dynamic manipulability ellipsoids at different poses (α,β,γ): (0 ,0 ,0 ) (a), (20 ,20 ,-5 ) (b), (40 ,40 ,10 ) (c), (54 ,53 ,10 ) (d)
Figure 22. Dynamic manipulability ellipsoids at different poses (α,β,γ): (0 ,0 ,0 ) (a), (20 ,20 ,-5 ) (b), (40 ,40 ,10 ) (c), (54 ,53 ,10 ) (d)
Main geometrical parameters
Figure 23. Main geometrical parameters
Plots of the index of dynamic manipulability as a function of actuators strokes on the three coordinate planes a
						
							1
						
						=0 (a), a
						
							2
						
						=0 (b), a
						
							3
						
						=0 (c)
Figure 24. Plots of the index of dynamic manipulability as a function of actuators strokes on the three coordinate planes a 1 =0 (a), a 2 =0 (b), a 3 =0 (c)
Sketch of spherical wrist’s prototype
Figure 25. Sketch of spherical wrist’s prototype
Fixture for axes alignment during mounting
Figure 26. Fixture for axes alignment during mounting

Design and Prototyping of a Spherical Parallel Machine Based on 3-CPU Kinematics

Massimo Callegari1

1. Introduction

Parallel kinematics machines, PKMs, are known to be characterised by many advantages like a lightweight construction and a high stiffness but also present some drawbacks, like the limited workspace, the great number of joints of the mechanical structure and the complex kinematics, especially for 6-dof machines. Therefore Callegari et al. (2007) proposed to decompose full-mobility operations into elemental sub-tasks, to be performed by separate minor mobility machines, like done already in conventional machining operations. They envisaged the architecture of a mechatronic system where two parallel robots cooperate in order to perform a complex assembly task: the kinematics of both machines is based upon the 3-CPU topology but the joints are differently assembled so as to obtain a translating parallel machines (TPM) with one mechanism and a spherical parallel machine (SPM) with the other.

In one case, joints’ axes are set in space so that the mobile platform can freely translate (without rotating) inside its 3D workspace: this is easily obtained by arranging the universal joint of each limb so that the axis of the outer revolute joint is parallel to the base cylindrical joint; such three directions are mutually orthogonal to maximise the workspace and grant optimal manipulability. With a different setting of the joints, three degrees of freedom of pure rotation are obtained at the terminal of the spherical wrist: in this case the axes of the cylindrical joints and those of the outer revolute pairs in the universal joints all intersect at a common point, which is the centre of the spherical motion.

This solution, at the cost of a more sophisticated controller, would lead to the design of simpler machines that could be used also stand-alone for 3-dof tasks and would increase the modularity and reconfigurability of the robotised industrial process. The two robots have been developed till the prototypal stage by means of a virtual prototyping environment and a sketch of the whole system is shown in Fig. 1: while the translating machine has been presented already elsewhere (Callegari & Palpacelli, 2008), the present article describes the design process of the orienting device and the outcoming prototype.

media/image1.png

Figure 1.

Architecture of the assembly system based on two cooperating parallel robots

2. Kinematic synthesis

The design of parallel kinematics machines able to perform motions of pure rotation, also called Spherical Parallel Machines, SPM’s, is a quite recent research topics: besides the pioneering researches by Asada and Granito (1985), the most important mechanism of this type is the agile eye by Gosselin and Angeles (1989), upon which many prototype machines have been designed since then. Few other studies on the subject are available during the 90’s, among which the work of Lee and Chang (1992), Innocenti and Parenti-Castelli (1993) and Alizade et al. (1994). In the new millennium, however, a growing interest on spherical parallel wrists produced many interesting results, as new kinematic architectures or powerful design tools. The use of synthesis methods based on or screw theory, for instance, has been exploited by Kong and Gosselin (2004aa and 2004b) that provide comprehensive listings of both overconstrained and non-overconstrained SPM’s; Hervé and Karouia, on the other hand, use the theory of Lie group of displacements to generate novel architectures, as the four main families in (Karouia & Hervè, 2002) or the 3-RCC, 3-CCR, 3-CRC kinematics specifically treated in (Karouia & Hervè, 2005); Fang and Tsai (2004) use the theory of reciprocal screws to present a systematic methodology for the structural synthesis of a class of 3-DOF rotational parallel manipulators. More interesting architectures, as the 3-URC, the 3-RUU or the 3-RRS, have been studied by Di Gregorio (2001a, 2001b and 2004) and also by other researchers.

Following the approach outlined in (Karouia & Hervè, 2000), Callegari et al. (2004) proposed a new wrist architecture, based on the 3-CPU structure; it is noted also that the 3-CRU variant is characterised by a much more complex kinematics but can be useful in view of a possible prototyping at a mini- or micro- scale, as shown by Callegari et al. (2008). The main synthesis steps of the 3-CPU parallel wrist are outlined in the following paragraphs.

First of all, it is noted that only non-overconstrained mechanisms have been searched in order to avoid the strict dimensional and geometric tolerances needed by overconstrained machines during manufacturing and assembly phases. Moreover, the use of passive spherical pairs directly joining the platform to the base has been avoided as well and for economic reasons only modular solutions characterised by three identical legs have been considered. It must be said that these advantages are usually paid with a more complex structure and the possible presence of singular configurations (translation singularities) in which the spherical constraint between platform and base fails.

media/image2.png

Figure 2.

Limb of connectivity 5 able to generate a spherical motion of the platform

Aiming at this kind of spherical machines, a simple mobility analysis shows that a parallel mechanism able to generate 3-dof motions must be composed by three limbs of connectivity 5. Without losing generality, it is supposed that each single limb consists of 4 links and 5 revolute (R) or prismatic (P) joints that connect the links among them and the limb itself to the fixed frame and to the mobile platform. If each limb’s kinematic chain has 3 revolute pairs whose axes intersect at a common point, that is the centre O of the SPM, therefore the moving platform can rotate around the fixed point O: in this way, each limb generates a 5-dimensional manifold that must contain the 3-dimensional group of spherical motions around the point O. If the other two lower pairs are locked, the kinematic chain of the overconstrained Gosselin and Angeles wrist (1989) is obtained, see Fig. 2.

media/image3.png

Figure 3.

Limb with subgroup RRR able to generate the subgroup of planar displacements

By analysing the described configuration, it is seen that the spherical motion can be obtained also by using 5 revolute pairs R1-R5 where the axes of the joints R1, R3 and R5 still intersect at a common point while the axes of pairs R2 and R4 are parallel to the direction of R3. In such a way, the 3 joints R2, R3 and R4 will generate the 3-dimensional subgroup of planar displacements G(П), i.e. the set of translations lying in П and rotations around axes perpendicular to П. The same subgroup G(П) is generated also in case the axis of revolute joint R3 is still perpendicular to plane П but does not cross the rotation centre O, as shown in Fig. 3, therefore also with this limb kinematics a spherical wrist can be obtained.

On the other hand, by following the same line of reasoning, the same subgroup of planar displacements G(П) can be generated by substituting one or two revolute joints among the R2, R3, R4 set with prismatic pairs whose axes lie in the plane П, thus obtaining limbs whose central joints are characterised by one of the sequences PRR, RPR, PPR, PRP, RRP, RPP. Of course, two adjacent joints in limbs kinematics can be merged to yield simpler architectures with fewer links: for instance two revolute joints with orthogonal axes can be superimposed to give a universal (U) joint, while the set of one revolute joint and one prismatic pair with the same axes are equivalent to a cylindrical (C) joint, as shown in Fig. 4.

media/image4.png

Figure 4.

Merge of two adjacent joints able to yield universal (a) or cylindrical (b) pairs

The kinematic chains described above prevent the ith limb’s end from translating in the direction normal to the plane Пi, i=1,2,3; therefore, if three such chains are used for the limbs and the three normals to the planes Пi, are linearly independent, all the possible translations in space are locked and the mobile platform, attached to the three limbs, can only rotate around a fixed point.

In this way, seven alternative design concepts have been considered, which are: 3-URU, 3-CRU, 3-URC, 3-UPU, 3-CPU, 3-UPC, 3-CRC. Figures 5-9 show the mentioned synthesis steps leading to the specific limb topology (a) and sketch a first guess arrangement of the introduced joints (b). In particular, the second picture in each one of these figures, labelled (b), shows the simplest possible setting of the limbs, that all lie within vertical planes: unfortunately in this case the 3 normals to limbs’ planes are all parallel to the horizontal plane and therefore result linearly dependent, allowing the platform to translate along the vertical direction, see Fig. 10a. Among all the possible setting of these normal axes in space that grant them to be linearly independent, it has been chosen to tilt the limbs’ planes so that they are mutually orthogonal in the initial configuration (or “home” position of the wrist), Fig. 10b, thus greatly simplifying the kinematics relations that will be worked out later on; moreover, even if this arrangement changes during operation of the machine, this configuration is the most far from the singular setting previously outlined, therefore granting a better kinematic manipulability of the wrist. The sketch of the outcoming mechanisms are drawn in Fig. 11-13.

media/image5.png

Figure 5.

Synthesis of URU limbs (a) and sketch of the 3-URU mechanism (b)

media/image6.png

Figure 6.

Synthesis of CRU and URC limbs (a) and sketch of the 3-CRU mechanism (b)

media/image7.png

Figure 7.

Synthesis of UPU limbs (a) and sketch of the 3- UPU mechanism (b)

media/image8.png

Figure 8.

Synthesis of CPU and UPC limbs (a) and sketch of the 3- CPU mechanism (b)

media/image9.png

Figure 9.

Synthesis of CRC limbs (a) and sketch of the 3- CRC mechanism (b)

media/image10.png

Figure 10.

Setting of the 3 axes normal to limbs’ planes: coplanar (a) and orthogonal (b)

media/image11.png

Figure 11.

Concept of a 3-URU (a) and 3-CRU (b) spherical parallel machine (home pose)

media/image12.png

Figure 12.

Concept of a 3-UPU (a) and 3-CPU (b) spherical parallel machine (home pose)

media/image13.png

Figure 13.

Concept of a 3-CRC spherical parallel machine (home pose)

The kinematics of such machines has been investigated and in view of the design of a physical prototype the 3-CPU concept has been retained, see Fig. 14: this has been mainly due to the relative simplicity of the kinematics relations that will be worked out in next section, to the compactness of the concept, that allows an easy actuation and finally to the novelty of the kinematics, that has been proposed by Olivieri first (2003) and then studied by Callegari et al. (2004). Before studying the kinematics of the 3-CPU SPM it is marginally noted that the same limb’s topology, with a different joints arrangement, is able to provide motions of pure translation (Callegari et al., 2005); moreover, the 3-CRU mechanism is extensively studied in (Callegari et. al., 2008) in view of the realisation of a SPM for miniaturized assembly tasks.

3. Kinematic analysis

3.1. Description of geometry and frames setting

media/image14.png

Figure 14.

Placement of reference frames (home pose) (a) and geometry of a single limb (b)

Making reference to Fig. 14, the axes of cylindrical joints A i , i=1,2,3 intersect at point O (centre of the motion) and are aligned to the axes x, y, z respectively of a (fixed) Cartesian frame located in O. The first member of each link (1) is perpendicular to A i and has a variable length b i due to the presence of the prismatic joint D i : the second link (2) of the leg is set parallel the said cylindrical pair. The universal joint B i is composed by two revolute pairs with orthogonal axes: one is perpendicular to leg’s plane while the other intersects at a common point P with the corresponding joints of the other limbs; such directions, for the legs i=1,2,3 orderly, are aligned to the axes u, v, w respectively of a (mobile) Cartesian frame, located in P and attached to the rotating platform. For a successful functioning of the mechanism, such manufacturing conditions must be accompanied by a proper mounting condition: assembly should be operated in such a way that the two frames O(x,y,z) and P(u,v,w) come to coincide. Finally, it is assumed an initial configuration such that the linear displacements a i of the cylindrical joints are equal to the constant length c (that is the same for all the legs): in this case also the linear displacements b i of the prismatic joints are equal to the constant length d. It is also evident that, for practical design considerations, SPM’s based on the 3-CPU concept are efficiently actuated by driving the linear displacements of the cylindrical pairs coupling the limbs with the frame: therefore in the following kinematic analysis it will be made reference to this case (i.e. joint variables a i , i=1,2,3 will be considered the actuation parameters).

3.2. Analysis of mobility

From the discussion of previous section, it is now evident that in case the recalled manufacturing and assembly conditions are satisfied, the mobile platform is characterised by motions of pure rotation; the mentioned conditions can be geometrically expressed by:

  1. w^1i and w^4i incident in P;
  2. w^3i perpendicular to the plane w^1i,w^4i , i.e. w^3iw^4i=0 and
  3. w^2i not parallel to w^1i and therefore: w^1i×w^2i0^ (for simplicity, the condition w^1iw^2i=0 has been posed).

Making reference to Fig. 14b, if the point P is considered belonging to the i th leg, its velocity can be written in three different ways as follows:

P˙=P˙2i+P˙rifori=1,2,3,
(2)

where P˙2i is the velocity of point P if considered fixed to link 2:

P˙2i=B˙i+ω2i×(PBi)=B˙i+ω2i×d w^4i
(3)
and P˙ri is the velocity of point P relative to a frame fixed to link 2 and with origin in B i :
P˙ri=θ˙3iw^3i×(PBi)=θ˙3iw^3i×dw^4i
(4)

In (2), ω2i is the angular velocity of link 2:

ω2i=θ˙1iw^1i
(5)

In the same way, with obvious meaning of the symbols, the vector B˙i can be expressed as:

B˙i=B˙1i+B˙rifori=1,2,3
(6)

where:

B˙1i=a˙iw^1i+ω1i×(BiAi)=a˙iw^1i+θ˙1iw^1i×(aiw^1idw^4i)=a˙iw^1iθ˙1iw^1i×dw^4i
(7)
B˙ri=b˙iw^2i
(8)

If (2)-(7) are substituted back in (1), it is found:

P˙=b˙iw^2i+a˙iw^1i+θ˙3iw^3i×dw^4i for i=1,2,3

By dot-multiplying (8) by w^3i and by taking into account the conditions (i)-(iv), it is finally obtained:

that can be differentiated to yield:

w^3iP¨+w^˙3iP˙=0
(10)

Equations (9-10), written for the 3 legs, build up a system of 6 linear algebraic equations in 6 unknowns, the scalar components of P˙ and P¨ . Such a system can be written in matrix form as follows:

where the 6x6 matrix M can be partitioned as:

with:

H=[w^31Tw^32Tw^33T]=[w31iw31jw31kw32iw32jw32kw33iw33jw33k]
(13)

and O being the 3x3 null matrix.

If the matrix M is not singular, the system (11) only admits the trivial null solution:

which means that the point P does not move in space, i.e. the moving platform only rotates around P. The singular configurations, on the other hand, can be identified by posing:

det(M)=[det(H)] 2=0
(15)

that leads to:

det(H)=w^31w^32×w^33=0
(16)

Equation (17) is satisfied only when the three unit vectors w^31 , w^32 , w^33 are linearly dependent; therefore the platform incurs in a translation singularity if and only if:

  • the planes containing the three legs are simultaneously perpendicular to the base plane;

  • such planes are coincident with the base plane (configuration not reachable);

  • at least two out of the three aforementioned planes admit parallel normal unit vectors.

This justifies the choice previously operated of having the legs laid on mutual orthogonal planes: in fact this configuration is the most far from singularities.

3.3. Orientation kinematics

Orientation kinematics is based on the definition of the relative rotation between fixed frame O(x,y,z) and the mobile frame P(u,v,w), where is always P≡O, see Fig. 14; to this aim the following set of Cardan angles is used:

RPO(α,β,γ)=Rx(α)Ry(β)Rz(γ)=[cβcγcβsγsβsαsβcγ+cαsγsαsβsγ+cαcγsαcβcαsβcγ+sαsγcαsβsγ+sαcγcαcβ]
(17)

Moreover, a local frame O i(xi, yi, zi), i=1,2,3 is defined for each leg, as shown in Fig. 15: the xi axis is aligned with cylindrical joint’s axis and the yi axis is chosen parallel to limb’s first link, when it is laid in the initial configuration.

One loop-closure equation can be written for each leg as follows:

(AiP)+(DiAi)+(BiDi)+(PBi)=0fori=1,2,3
(18)

Equation (19) can be easily expressed in the local frame O i(xi, yi, zi), i=1,2,3:

[ai00]+[0bicθ1ibisθ1i]+[c00]+(PBi)i=0fori=1,2,3
(19)
media/image57.png

Figure 15.

Setting of local limb frames

The last term in (20) is actually evaluated in the global frame O(x,y,z), then it is transported to limb’s frame O i(xi, yi, zi):

(PBi)i=RPi (PBi)P=ROi RPO (PBi)Pfor i=1,2,3
(20)

where the introduced terms assume the following values:

RO1=[100010001]RO2=[010001100]RO1=[001100010]
(21)
(PB1)P=d[010]T,(PB2)P=d[001]T(PB3)P=d[100]T
(22)

In inverse kinematics the values of α, β, γ Cardan angles (or equivalently the elements r ij of the rotation matrix RPO ) are know and the joint variables a i must be found; loop closure equations (21) for i=1,2,3 represent three decoupled systems of non linear algebraic equations in the unknowns a i , θ 1i and b i , that can be solved to find the single solution:

{a1=cdr12θ11=atan2(r32,r22)b1=dr22cθ11{a2=cdr23θ12=atan2(r13,r33)b2=dr33cθ12{a3=cdr31θ13=atan2(r21,r11)b3=dr11cθ13
(23)

The direct kinematic problem, on the other hand, assumes the knowledge of joint variables a i , i=1,2,3 and aims at finding the corresponding attitudes of the platform in the space. The analysis is performed by means of simple trigonometric manipulations: by substituting in (28-30) the expression of r ij given in (18), it is obtained:

{cβsγ=ca1d=k1sαcβ=ca2d=k2cαsβcγsαsγ=ca3d=k3
(24)

where the k i , i=1,2,3 are known values. The 3 equations in (31) can be solved to find up to 4 admissible values for :

(2k3k2k1k22+1+k22k12)s4γ+(k32k22k121)s2γ+k12=0
(25)

For each angle γ that solves (32), 2 different values can be found for angles β and α:

cβ=k1sγsα=k2k1sγ
(26)

therefore system (31) admits up to 16 different solutions: direct kinematics of the mechanism, however, is characterised by a maximum number of 8 different configurations, since angle β can be restricted in the range [-π/2, π/2] without any loss of information.

3.4. Differential kinematics

By direct differentiation of the first 3 equations in (28-30), the expression of the analytic Jacobian JA is directly derived:

[a˙1a˙2a˙3]=d[0sβsγcβcγcαcβsαsβ0sαsβcγcαsγcαcβcγcαsβsγsαcγ][α˙β˙γ˙]=JA[α˙β˙γ˙]
(27)

The geometric Jacobian JG can be worked out by expressing the relation between the derivatives of Cardan angles and the components of angular velocity ω:

[ωxωyωz]=[10sβ0cαsαcβ0sαcαcβ][α˙β˙γ˙]
(28)
[a˙1a˙2a˙3]=d[0cαsβsγsαcγcαcγsαsβsγcαcβ0sβsαsβcγcαsγcβcγ0][ωxωyωz]=JG[ωxωyωz]
(29)

It is noted that the geometric Jacobian JG is not a function of geometric parameters, therefore machine’s manipulability cannot be optimised by a proper selection of functional dimensions.

3.5. Analysis of singular poses

Limbs’ structure does not allow for inverse kinematics singularities, while direct kinematics singularities can be found by letting the determinant of JG vanish:

det(JG)=d3[sβ2(cαcγsαsβsγ)2]
(30)

The zeros of (38) all lie on closed surfaces in the 3-dimensional space α, β, γ: their intersections with the coordinate planes are straight lines (see also Fig. 16), as given by:

{α=0β±γ=±π2β=0α=±π2,  γ=±π2γ=0α±β=±π2
(31)

The analysis of singular configurations has been performed also by means of numerical simulations. Figure 17 shows the value of the determinant of the geometric Jacobian matrix, normalised within the range [-1, +1] after division by the constant d 3 : the black regions are characterised by determinant values in the range [-0,05, +0,05]. All the singularity maps are plot against the β and γ angles, α being a parameter of the representation; the configuration of the mechanism for β=γ=0 is represented aside. Figure 18a plots the singularity surface in the α,β,γ space but it is a hardly readable graph. In Fig. 18b, on other hand, the workspace volumes whose determinant assumes values in the range [-0,05, +0,05] have been taken out of the representation, while the colour map still represents the local determinant value: it is now more appreciable the extent of singularity-free regions inside the workspace, Fig. 18c, where the planning of a motion could be performed: e.g. for the mechanism under design a sphere with a radius of about 50 can be internally inscribed.

media/image71.png

Figure 16.

Projection of direct kinematics singularity surface on several coordinate planes: α=0 (a), α=40 (b), α=80 (c), β=0 (d), β=45 (e), β=89 (f)

media/image72.png

Figure 17.

Determinant of the geometric Jacobian matrix on the planes α=0 (a), α=40 (b), α=80 (c) and representation of manipulator configurations.

The sphere representation of singularity-free regions given in Fig. 18c is suggestive but it is expressed in a space (the α,β,γ Cardan angles) whose geometrical meaning is rather obscure. For many industrial tasks, on the other hand, it may be useful to use the spherical parallel machine for orienting a device or a part within a possibly large 2-dimensional space, identified by the axis of finite rotation, while the need for a further twist around the axis itself may not be urgent or at least only limited rotations may be required. In this case, the geometric Jacobian may be readily represented by a colour map on the surface of a unit sphere. Figure 19, for instance, uses lighter colours to render higher determinant values while black regions represent almost singular configurations; in this figure the orientation of the platform can be easily read through its elevation and azimuth, with the twist around the central axis is taken as a parameter of the representation: it is noted that in this case, at the expense of reduced twist rotations, greater pointing motions can be accomplished in the other 2 space directions.

media/image73.png

Figure 18.

Singularity surface in the α,β,γ space (a); colour map representing local determinant values (b) and close-up view of a connected singularity-free region.

media/image74.png

Figure 19.

Singularity-free regions inside workspace for twist angle equal to 20 (a) and 60 (b)

Turning to translation singularities, the singular configurations found in (17) can be easily expressed as a function of articular coordinates θ 1i :

sθ11sθ12sθ13=cθ11cθ12cθ13
(32)

and taking into consideration inverse kinematics (28-30) it is obtained:

r32r13r21=r22r33r11
(33)

Equation (41) is a useful expression of translation singularities in task space, where the elements of the rotation matrix are used; by using the definition of the rotation matrix in (18) and after some trigonometric manipulation, an alternative expression can be obtained in function of Cardan angles α, β, γ :

sβ2(cαcγsαsβsγ)2=0
(34)

It is noted that (42) vanishes in the same configurations of (38), therefore translation singularities coincide with direct kinematics singularities, i.e. no additional singular surfaces are present inside workspace.

3.5. Analysis of static loads

The static analysis is useful in the first phases of machine design for the selection of machine’s motors and for a first design of the links, with the related connecting bearings.

The base relation is provided as usual by the well known duality between kinematics and statics, which allows a straightforward assessment of the actuation efforts τ needed to balance a moment npl applied at the mobile platform:

[τ1τ2τ3]=JGT[nplxnplynplz]
(35)

It must be noted that the application of a force fpl at the centre of the spherical motion does not require balancing forces by the actuators but it is entirely born by frame bearings: the internal reactions at the bearings caused by the application of the mentioned external wrench have been evaluated as well and used during structural design.

4. Dynamics

4.1. Inverse dynamics model

In this section an inverse dynamics model of the 3-CPU mechanism is worked out by using the virtual work principle: it is assumed that frictional forces at the joints are negligible, therefore the work produced by the constraint forces at the joints is zero and only active forces (including the gravitational effects) must be accounted in the developments.

In the derivation of the model, the notation is based on Fig. 14b and the second subscript i (i=1,2,3) indicates the i th limb while the first subscript j (j=1,2) refers to the first or second link respectively. Namely, m ji and I ji are the mass and (central) inertia tensor of the j th member of the i th limb; ω ji is its angular velocity and v ji is the linear velocity of its centre of mass; m pl , I pl , ω pl , v pl are the same quantities referred to the mobile platform.

The total wrench of active and inertial effects acting on the centre of mass of j th member of the i th limb is written as:

Fji=˙[fjinji]=[mjigmjiv˙jiIjiω˙jiωji×(Ijiωji)]
(36)

In the same manner, the total wrench acting on the centre of mass of the mobile platform is:

Fpl=˙[fplnpl]=[mpl(gv˙pl)+feIplω˙plωpl×(Iplωpl)+ne]
(37)

where fe and ne are the external force and moment applied to its centre of mass; it is accidentally noted that the centre of mass of the platform does not coincide with the fixed point O. If τ is the vector of the actuation forces and q are the corresponding displacements, the principle of virtual work can be written for the present case:

(δq)Tτ+(δxpl)TFpl+i=13(j=12((δxji)TFji))=0
(38)

where the vector xji gathers the position of the centre of mass of j th member of the i th limb and the orientation of the same link and xpl expresses the position of the centre of mass of the mobile platform and its orientation. It is noted that all the infinitesimal rotations appearing in (46) must be expressed as functions of the angular velocity of the respective link, e.g. for the platform:

δxpl=[vplxvplyvplzωplxωplyωplz]Tδt
(39)

Since all the virtual displacements in (47) must be compatible with the constraints, they are not independent but can rather be expressed as functions of an independent set of Lagrangian coordinates; if the Cardan angles φ=[α, β, γ]T of the mobile platform are chosen for this purpose, the following relations hold between the introduced virtual displacements:

δq=Jδφδxji=Jjiδφδxpl=Jplδφ
(40)

where J, Jji and Jpl are proper Jacobian matrices that can be found through the usual velocity analysis of the mechanism. Equation (46) can be written again as:

δφT[JTτ+JplTFpl+i=13(j=12JjiTFji)]=0
(41)

Since (51) is valid for any virtual displacement δφ of the platform, in non-singular configurations it is:

τ=JT(JplTFpl+i=13(j=12JjiTFji))
(42)

Equation (52) completely describes manipulator’s dynamics; all the elements in it have been worked out and the resulting model has been proofed by comparison with commercial packages’ output, see (Callegari & Marzetti, 2006).

4.2. Dynamic analysis in the task space

The dynamic expression (52) is usefully re-worked in order to explicit the dependency on a proper set of Lagrangian coordinates and its derivatives. In the case of parallel kinematics machines, the dynamic model results quite naturally written in the task space, due to the (usually) difficult expression of DKP; therefore in the present case, after some cumbersome manipulation, it is obtained:

τϕJplTh=Mφ(φ)φ¨+Cφ(φ,φ˙)φ˙+Gφ(φ)
(43)

with: τϕ=JTτ , moments acting at the end-effector and corresponding to actual forces τ at actuated joints; Mφ(φ) , Cartesian mass matrix of the manipulator; Cφ(φ,φ˙) , vector of centrifugal and Coriolis terms; Gφ(φ) , vector of gravity moments; h, vector of external forces and moments acting at the centre of mass of the mobile platform.

media/image91.png

Figure 20.

Values of mass matrix’ elements for null roll angle, i.e. γ=0 (note the different scales of the plots)

media/image92.png

Figure 21.

Plots of mass matrix’ elements, normalised by determinant value, for null roll angle, i.e. γ=0 (note that all the scales of the graphs are multiplied by 10-6 but M(1,2) and M(2,3) which are multiplied by 10-7)

In view of the realisation of possible control schemes based on the inversion of manipulator’s dynamics, it is useful to study the variability of mass matrix throughout the workspace. In fact, a major simplification of the model would be yielded by neglecting the 6 non-diagonal terms of the mass matrix, whether actually allowed by their comparative magnitude; otherwise, all the elements in M ϕ and C ϕ could be considered constant. First simulation results show that in this case both simplifying assumptions could be taken into consideration, even if the validity of the reduced models weakens when the operating trajectories get closer to singularity surfaces, as expected.

Figure 21, for instance, shows the values of mass matrix’ elements in different workspace configurations characterised by null roll angle, i.e. γ=0: for robot’s parameters it has been made reference to the virtual prototype, whose mass properties, presented in the following Tab. 2, are very similar to physical prototype. In Fig. 22 the same plots have been normalised by dividing the matrix element by the (local) value of matrix determinant, to allow a relative comparison among elements that have very different magnitudes. It can be seen that near the isotropic point (α=β=γ=0) the diagonal elements are dominant and matrix variability is limited, while off-diagonal elements show a stronger influence when getting closer to workspace boundaries; moreover, element M(3,1) is generally an order of magnitude greater than M(2,1) and M(2,3). Such behaviour gets even more evident if one moves away from the plane γ=0. The plots have been traced for pitch and yaw angles varying between -50 and +50 because the sphere of 50 radius in the Cardan angles space is completely free of singularities, as shown already in Fig. 18.

Other kinds of tests have been performed, aiming at identifying the relative contribute of various dynamic terms: for instance it seems that, even for high dynamics manoeuvres, the contribute of gravity is never negligible, while Coriolis and centrifugal forces account for 10%-16% maximum; on the other hand, the mass and inertia of the mobile platform affect very slightly the overall dynamic behaviour of the machine, possibly allowing for a major simplification of system’s model.

4.3. Dynamic manipulability

The dynamic manipulability ellipsoids introduced by Yoshikawa (1985, 2000) are a useful means to study the dynamic properties of a mechanism: they express graphically the capability of a given device to yield accelerations in all the directions stemming from one attitude of its workspace. As a matter of fact, many other measures of manipulability have been proposed by different researchers since that pioneering work but very few applications dealt with orienting devices.

Let us consider all the actuation forces τ with unit norm:

By manipulating (53) in order to work out τ, it is obtained:

τ=JTMφ(φ¨+φ¨bias)
(45)

having defined:

φ¨bias=Mϕ1(Cφφ˙+Gφ+JplTh)
(46)

A meaningful formulation of dynamic manipulability must be expressed as a direct function of the angular acceleration ω˙ , therefore the mapping between the rate of change of the Cardan angles φ˙ and the angular velocity ω must be made explicit:

[ωxωyωz]=[10sβ0cαsαcβ0sαsαcβ][α˙β˙γ˙]ω=E(φ)φ˙
(47)
ω˙=E(φ)φ¨+ω˙1(φ,φ˙)
(48)
If φ¨ is taken out of (58) and substituted in (55) it is then obtained:
τ=JTMφE1(ω˙+ω˙bias)
(49)

having defined:

ω˙bias=ω˙1+EMϕ1JTMϕ1(Cφφ˙+Gφ+JplTh)
(50)

The constraint expressed by (54) can be finally written in the following quadratic form:

Ω˙TΓ(φ)Ω˙=1
(51)

with obvious meaning of the introduced terms:

Ω˙=ω˙+ω˙bias=ω˙ω˙1+EMϕ1JTMϕ1(Cφφ˙+Gφ+JplTh)
(52)
Γ(φ)=ETMϕTJ1JTMφE1
(53)

The inspection of (62-64) shows that gravity merely induces a translation of the dynamic manipulability ellipsoid while in general velocity has a complex, non-negligible effect on manipulability. Making reference to the remarkable case of a fixed platform ( φ˙=0 ) with no external or gravity action applied (h=Gφ=0), (61) provides:

ω˙TΓ(φ)ω˙=1
(54)

The quadratic form (64) represents an ellipsoid in the Cartesian space of the angular accelerations: its eigenvalues express the square root of the maximum and minimum accelerations that can be developed with unit actuator forces while the eigenvectors represent the associated directions in the orientation space. Figure 23 represents graphically some dynamic manipulability ellipsoids of the robot in the poses sketched aside.

media/image108.png

Figure 22.

Dynamic manipulability ellipsoids at different poses (α,β,γ): (0 ,0 ,0 ) (a), (20 ,20 ,-5 ) (b), (40 ,40 ,10 ) (c), (54 ,53 ,10 ) (d)

5. Prototype design

The design of a first prototype has been developed, aiming at obtaining high dynamics performances; as reference figures, the following requirements have been posed:

  • orientation range (elevation and azimuth): 150

  • maximum angular velocity: 500 /s

  • maximum angular acceleration: 5 000 /s 2

  • spatial resolution: 0.01

  • overall dimensions of the machine: maximum volume of 1 m 3 .

The particular form of the Jacobian matrix (35) does not allow for a mechanical design based on the optimisation of kinematic properties, since JG is not function of robot’s geometry, therefore heuristic considerations have been made in a first phase, in order to limit wrist’s overall dimensions. By looking at Fig. 24 and taking into consideration (31), it is noted that the value of length c does not affect actuators’ stroke but only their initial position. The value of length d, instead, is directly proportional to the motors’ run needed to attain an assigned configuration in space and by decreasing its value a more compact design is obtained: on the other hand, a lower limit is provided by the need to accommodate the universal joints on the mobile platform and to grant a limit positioning accuracy in the task space. By means of computer simulation, all the geometrical parameters represented in Fig. 24 have been made to change, in order to take into account the above considerations and to assess the resulting geometry; in the end, it has been decided to refine the mechanical design by taking into account the concept of dynamic optimisation, enabled by the availability of the inverse dynamics model.

media/image109.png

Figure 23.

Main geometrical parameters

Two dynamic figures have been used to drive the design of the machine. The measure of the dynamic manipulability, w, defined as:

w=det(Γ(φ))
(55)

results proportional to the volume of the manipulation ellipsoid and therefore yields an overall information on the global manipulation capabilities, but fails to capture the closeness to singular configurations or even the anisotropy of local dynamics. On the other hand, the index of dynamic manipulability, i, can be defined as:

with λ min , λ max minimum and maximum eigenvalues of the matrix Γ(φ) : the index (66) is independent from the volume of the ellipsoid and vanishes close to singular configurations.

media/image113.png

Figure 24.

Plots of the index of dynamic manipulability as a function of actuators strokes on the three coordinate planes a 1 =0 (a), a 2 =0 (b), a 3 =0 (c)

Figure 25 shows sample plots of the index of dynamic manipulability as a function of actuators strokes a i on the three coordinate planes for the final design. With specific Matlab routines, a dynamic optimisation of the design has been performed, trying to maximise the global dynamic manipulability of the wrist while still guaranteeing a minimum threshold of the local features. For instance, in the configurations shown in Fig. 23a-23d the indexes assume the values: 0.7755, 0.1374, 0.3571, 0.0341 respectively, while it has been obtained a mean value of i ave =0.502 over the central ±30 span of the workspace. Table 1 summarises the final geometrical values used for the design, with h being the total length of the lower part of the three limbs. It must be said that, as a general rule, in this case the optimisation routines tend to concentrate all the masses in the centre of the spherical motion, that is only too natural.

Figure 26 on the left shows a sketch of the design of final prototype meeting the posed requirements; on the right side, a picture of the machine is presented. The limbs are made of avional (an aluminium-copper alloy) in order to join good mechanical properties with a lightweight construction. The mobile platform is made of bronze, therefore allowing the precise machining in a single placement of the 3 journal bearings that have to meet orthogonally in a single point: in this way it has been a high stiffness together with precise geometrical alignments. It must be noted that such revolute joints are idle, since no rotation occurs at all if all the manufacturing and mounting conditions are correctly satisfied. In order to allow the precise mounting of the robot in the initial (home) configuration, the special fixture shown in Fig. 27 has been realised.

media/image114.png

Figure 25.

Sketch of spherical wrist’s prototype

media/image115.png

Figure 26.

Fixture for axes alignment during mounting

The actuation is based on 3 induction linear motors Phase WVS 20.6.3, able to provide a maximum thrust of 184 N at the speed of 6 m/s, with a maximum acceleration of 14.3 g and is controlled by Nation Instrument hardware (Flexmotion/PXI architecture). The first tests of motion are currently under development, while wrist’s controller is under design.

d m]c [mm]h [mm]a imin [mm]a imax [mm]b imin [mm]b imax [mm]
210490280319661130210

Table 1.

Main geometrical data of spherical wrist design

linkm (mass, kg)I 11 (x-x moment of inertia, kg-m2)I 22 (y-y moment of inertia, kg-m2)I 33 (z-z moment of inertia, kg-m2)
upper limb2.500.0160.0160.0013
lower limb7.500.0700.0700.0014
platform5.350.0300.0300.060

Table 2.

Mass properties of spherical wrist design

6. Conclusions

The article has described an innovative spherical parallel wrist developed at the Polytechnic University of Marche in Ancona, revisiting all the main design steps, from kinematic synthesis up to physical prototyping.

Machine kinematics has been worked out in closed form and all the singularity surfaces have been analysed: it has been pointed out that the mechanism does not possess inverse kinematics singularities, while direct kinematics singularities and translation singularities lie on the same closed surface. The inner space, where motion paths can be safely planned, has been identified and unfortunately it cannot be enlarged by kinematics optimisation because machine’s Jacobian does not depend on geometrical parameters.

For this reason, it was decided to drive machine design by dynamic optimisation concepts and an inverse dynamics model has been developed: the study of machine’s dynamic manipulability, by means of different algebraic tools, led to the final design of the wrist, that has been also verified with structural analysis packages. The availability of the dynamic model, on the other hand, will be useful for the development of model based control systems, able to exploit the high potentials of direct drive actuation: a first dynamic analysis, moreover, shows that simplified models could be used, since the non-diagonal terms of mass matrix are much smaller than diagonal terms and platform’s inertia could be neglected, at least when manipulator is far from singular configurations.

All design steps have been performed in a virtual prototyping environment, that allowed to take into consideration simultaneously the constraints of the mechanics and the problems of the controller, allowing to assess the performances of the closed-loop system. The physical prototyping of the machine, however, allowed to validate the good properties envisaged during the design phase but also to experience the disadvantages of the concept itself: they are mainly due to the scarce accessibility of the centre of the spherical motion, which is common to most parallel wrists, and to the difficult assembly, which requires a precise alignment of joints axes: this problem has been partially overcome by the manufacturing of specific fixtures that are characterised by very high accuracy and are used while assembling the machine.

The machine has been moved so far only through motors drives and a conventional PID position controller is actually being developed: more advanced control systems, able to exploit the high dynamics of the design and the power of direct actuation, will be studied soon.

References

1 - R. I. Alizade, N. R. Tagiyev, J. Duffy, 1994 A forward and reverse displacement analysis of an in-parallel spherical manipulator, Mechanism and Machine Theory, 29 1 125 137 , 0009-4114X
2 - H. Asada, C. Granito, 1985 Kinematic and static characterization of wrist joints and their optimal design, Proc. IEEE Conf. Robotics and Automation, 244 250 , St. Louis, USA, March 25-28.
3 - M. Callegari, P. Marzetti, 2006 Inverse Dynamics Model of a Parallel Orienting Device, Proc. 8th Intl. IFAC Symposium on Robot Control: SYROCO 2006, Bologna, Italy, Sept. 6 8 .
4 - M. Callegari, M. Palpacelli, C. , 2008 Prototype design of a translating parallel robot, Meccanica (accepted for publication), 0025-6455
5 - M. Callegari, A. Gabrielli, M. Ruggiu, 2008 Kineto-Elasto-Static Synthesis of a 3 -CRU Spherical Wrist for Miniaturized Assembly Tasks, Meccanica, 0025-6455
6 - M. Callegari, A. Gabrielli, M. C. Palpacelli, M. Principi, 2007 Design of Advanced Robotic Systems for Assembly Automation, Intl J. of Mechanics and Control, 8 1 Dec. 2007). 3 8 , 1590-8844
7 - M. Callegari, P. Marzetti, B. Olivieri, 2004 Kinematics of a Parallel Mechanism for the Generation of Spherical Motions, In: On Advances in Robot Kinematics, J. Lenarcic and C. Galletti (Eds), 449 458 , Kluwer, 1-40202-248-4
8 - M. Callegari, M. C. Palpacelli, M. Scarponi, 2005 Kinematics of the 3-CPU parallel manipulator assembled for motions of pure translation, Proc. Intl. Conf. Robotics and Automation, 4031 4036 , Barcelona, Spain, April 18-22.
9 - R. Di Gregorio, 2001a Kinematics of a new spherical parallel manipulator with three equal legs: the 3-URC wrist, J. Robotic Systems, 18 5 Apr. 2001), 213 219 , 0741-2223
10 - R. Di Gregorio, 2001b A new parallel wrist using only revolute pairs: the 3-RUU wrist, Robotica, 19 3 Apr. 2001), 305 309 , 0263-5747
11 - R. Di Gregorio, 2004 The 3-RRS Wrist: A New, Simple and Non-Overconstrained Spherical Parallel Manipulator, J. of Mechanical Design, 126 5 (Sept. 2004) 850 855 , 1050-0472
12 - Y. Fang, L. W. Tsai, 2004 Structure synthesis of a class of 3-DOF rotational parallel manipulators, IEEE Trans. on Robotics and Automation, 20 1 (Feb. 2004) 117 121 , 0882-4967
13 - C. Gosselin, J. Angeles, 1989 The optimum kinematic design of a spherical three-degree-of-freedom parallel manipulator, J. Mechanisms, Transmissions and Automation in Design, 111 2 202 207 , 0738-0666
14 - C. Innocenti, V. Parenti-Castelli, 1993 Echelon form solution of direct kinematics for the general fully-parallel spherical wrist, Mechanism and Machine Theory, 28 4 553 561 , 0009-4114X
15 - M. Karouia, J. M. Hervè, 2000 A three-dof tripod for generating spherical rotation, In: Advances in Robot Kinematics, J.L. Lenarcic & M.M. Stanisic (Eds.), 395 402 , Kluwer, 0-79236-426-0
16 - M. Karouia, J. M. Hervè, 2002 A Family of Novel Orientational 3-DOF Parallel Robots, Proc. 14th RoManSy, 359 368 , Udine, Italy, July 1-4.
17 - M. Karouia, J. M. Hervé, 2006 Non-overconstrained 3-dof spherical parallel manipulators of type: 3-RCC, 3-CCR, 3-CRC, Robotica, 24 1 January 2006, 85 94 , 0263-5747
18 - X. Kong, C. M. Gosselin, 2004 Type synthesis of 3-DOF spherical parallel manipulators based on screw theory, J. of Mechanical Design, 126 1 (Jan. 2004), 101 108 , 1050-0472
19 - X. Kong, C. M. Gosselin, 2004 Type synthesis of three-degree-of-freedom spherical parallel manipulators, Intl J. of Robotics Research, 23 3 (March 2004) 237 245 , 0278-3649
20 - J. J. Lee, S. Chang, L. , 1992 On the kinematics of the UPS wrist for real time control, Proc. 22nd ASME Biennal Mechanisms Conference: Robotics, Spatial Mechanisms and Mechanical Systems, 305 312 , Scottsdale, USA, Sept. 13-16.
21 - B. Olivieri, 2003 Study of a novel parallel kinematics spherical robot for cooperative applications, Tesi di laurea (in Italian), Università Politecnica delle Marche, Ancona, Italy.
22 - T. Yoshikawa, 1985 Dynamic Manipulability of Robot Manipulators. J. Robotic Systems, 2 113 124 , 0741-2223
23 - T. Yoshikawa, 2000 Erratum to “Dynamic Manipulability of Robot Manipulators”. J. Robotic Systems, 17 8 (Aug. 2000), 449 0741-2223