Open access peer-reviewed chapter

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

By Massimo Callegari

Published: April 1st 2008

DOI: 10.5772/5368

Downloaded: 2861

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.

Figure 1.

Architecture of the assembly system based on two cooperating parallel robots

Advertisement

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.

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.

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.

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.

Figure 5.

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

Figure 6.

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

Figure 7.

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

Figure 8.

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

Figure 9.

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

Figure 10.

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

Figure 11.

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

Figure 12.

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

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

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 Ai, i=1,2,3intersect 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 Aiand has a variable length bidue to the presence of the prismatic joint Di: the second link (2)of the leg is set parallel the said cylindrical pair. The universal joint Biis composed by two revolute pairs with orthogonal axes: one is perpendicular to leg’s plane while the other intersects at a common point Pwith the corresponding joints of the other limbs; such directions, for the legs i=1,2,3orderly, are aligned to the axes u, v, w respectively of a (mobile) Cartesian frame, located in Pand attached to the rotating platform. For a successful functioning of the mechanism, such manufacturing conditionsmust 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 aiof 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 biof 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 ai, i=1,2,3will 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^1iw^4iP
  2. w^3iw^1i,w^4iw^3iw^4i=0
    w^3iw^1i=0E1
  3. w^2iw^1iw^1i×w^2i0^w^1iw^2i=0

Making reference to Fig. 14b, if the point Pis considered belonging to the ithleg, its velocity can be written in three different ways as follows:

P˙=P˙2i+P˙rifori=1,2,3,E2

whereP˙2iis the velocity of point Pif considered fixed to link 2:

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

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

ω2i=θ˙1iw^1iE5

In the same way, with obvious meaning of the symbols, the vectorB˙ican be expressed as:

B˙i=B˙1i+B˙rifori=1,2,3E6

where:

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

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

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

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

w^3iP˙=0E9

that can be differentiated to yield:

w^3iP¨+w^˙3iP˙=0E10

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

M[P˙P¨]=0E11

where the 6x6 matrix M can be partitioned as:

M=[HOH˙H]E12

with:

H=[w^31Tw^32Tw^33T]=[w31iw31jw31kw32iw32jw32kw33iw33jw33k]E13

and O being the 3x3 null matrix.

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

P˙=P¨=0E14

which means that the point Pdoes 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=0E15

that leads to:

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

Equation (17) is satisfied only when the three unit vectorsw^31,w^32,w^33are linearly dependent; therefore the platform incurs in a translation singularityif 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β]E17

Moreover, a local frame Oi(xi, yi, zi), i=1,2,3is 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,3E18

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

[ai00]+[0bicθ1ibisθ1i]+[c00]+(PBi)i=0fori=1,2,3E19

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 Oi(xi, yi, zi):

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

where the introduced terms assume the following values:

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

In inverse kinematics the values of α, β, γCardan angles (or equivalently the elements rijof the rotation matrixRPO) are know and the joint variables aimust be found; loop closure equations (21) for i=1,2,3represent three decoupled systems of non linear algebraic equations in the unknowns ai, θ1iand bi, 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θ13E23

The direct kinematic problem, on the other hand, assumes the knowledge of joint variables ai, i=1,2,3and 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 rijgiven in (18), it is obtained:

{cβsγ=ca1d=k1sαcβ=ca2d=k2cαsβcγsαsγ=ca3d=k3E24

where the ki, i=1,2,3are 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=0E25

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

cβ=k1sγsα=k2k1sγE26

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 JacobianJA 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[α˙β˙γ˙]E27

The geometric JacobianJG 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β][α˙β˙γ˙]E28
[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]E29

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]E30

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α±β=±π2E31

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 d3: 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 β=γ=0is 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.

Figure 16.

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

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.

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.

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θ13E32

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

r32r13r21=r22r33r11E33

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=0E34

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]E35

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 ithlimb while the first subscript j(j=1,2) refers to the first or second link respectively. Namely, mjiand Ijiare the mass and (central) inertia tensor of the jthmember of the ithlimb; ωjiis its angular velocity and vjiis the linear velocity of its centre of mass; mpl, Ipl, ωpl, vplare the same quantities referred to the mobile platform.

The total wrench of active and inertial effects acting on the centre of mass of jthmember of the ithlimb is written as:

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

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]E37

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))=0E38

where the vector xji gathers the position of the centre of mass of jthmember of the ithlimb 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δtE39

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δφE40

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)]=0E41

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

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

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φ(φ)E43

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.

Figure 20.

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

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 -50and +50because the sphere of 50radius 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:

τTτ=1E44

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

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

having defined:

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

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(φ)φ˙E47
ω˙=E(φ)φ¨+ω˙1(φ,φ˙)E48
Ifφ¨is taken out of (58) and substituted in (55) it is then obtained:
τ=JTMφE1(ω˙+ω˙bias)E49

having defined:

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

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

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

with obvious meaning of the introduced terms:

Ω˙=ω˙+ω˙bias=ω˙ω˙1+EMϕ1JTMϕ1(Cφφ˙+Gφ+JplTh)E52
Γ(φ)=ETMϕTJ1JTMφE1E53

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Γ(φ)ω˙=1E54

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.

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 /s2

  • spatial resolution: 0.01

  • overall dimensions of the machine: maximum volume of 1 m3.

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

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(Γ(φ))E55

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:

i=λminλmaxE56

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

Figure 24.

Plots of the index of dynamic manipulability as a function of actuators strokes on the three coordinate planesa1=0(a),a2=0(b),a3=0(c)

Figure 25 shows sample plots of the index of dynamic manipulability as a function of actuators strokes aion 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.0341respectively, while it has been obtained a mean value of iave=0.502over the central ±30span of the workspace. Table 1 summarises the final geometrical values used for the design, with hbeing 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.

Figure 25.

Sketch of spherical wrist’s prototype

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

Advertisement

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.

© 2008 The Author(s). Licensee IntechOpen. This chapter is distributed under the terms of the Creative Commons Attribution-NonCommercial-ShareAlike-3.0 License, which permits use, distribution and reproduction for non-commercial purposes, provided the original is properly cited and derivative works building on this content are distributed under the same license.

How to cite and reference

Link to this chapter Copy to clipboard

Cite this chapter Copy to clipboard

Massimo Callegari (April 1st 2008). Design and Prototyping of a Spherical Parallel Machine Based on 3-CPU Kinematics, Parallel Manipulators, New Developments, Jee-Hwan Ryu, IntechOpen, DOI: 10.5772/5368. Available from:

chapter statistics

2861total chapter downloads

2Crossref citations

More statistics for editors and authors

Login to your personal dashboard for more detailed statistics on your publications.

Access personal reporting

Related Content

This Book

Next chapter

Quantitative Dexterous Workspace Comparison of Serial and Parallel Planar Mechanisms

By Geoff T. Pond and Juan A. Carretero

Related Book

First chapter

Control of Cable Robots for Construction Applications

By Alan Lytle, Fred Proctor and Kamel Saidi

We are IntechOpen, the world's leading publisher of Open Access books. Built by scientists, for scientists. Our readership spans scientists, professors, researchers, librarians, and students, as well as business professionals. We share our knowledge and peer-reveiwed research papers with libraries, scientific and engineering societies, and also work with corporate R&D departments and government entities.

More About Us