1042-Kinematics-of-line-plane-subassemblies-in-Stewart-platforms.pdf

6
 Kinemat ics of Line-Plane Subass embli es in Stewar t Platf orms Júli a Borr às and Feder ico Thomas  Abstract Whe n the attac hment s of ve legs in a Ste war t platform are collinear on one side and coplanar on the other, the platform is said to contain a line-plane subassembly. This paper is devoted to the kinematics analysis of this subassembly paying par tic ular att ent ion to the pr obl em of movin g the afor eme ntion ed attac hmen ts witho ut alter ing the sing ulari ty locus of the platform. It is shown how this is always possible pr ovi ded that some cr oss-ratio s bet wee n li nes —de ne d by poi nts in the pla ne— are ke pt equ al to other cr oss -ratio s bet ween poi nts in the line . Thi s re sul t lea ds to two simpl e motio n rule s upon which comple x chang es in the locatio n of the attachments can be performed. These rules have interesting pract ical consequ ences as they permit a desi gner to optimize aspects of a parallel robot containing the analyzed subassembly, such as its manipul abili ty in a give n reg ion, without alteri ng its singularity locus.  Index TermsPara llel mani pulat ors, robo t kine matic s, ar- chitectural singularities, kinematics singularities, manipulator design. I. INTRODUCTION The kinematic analysis of a Stewart platform gets greatly simplied when it contains rigid subassemblies. When this happens the platform forward kinematics can be solved in a modu lar fash ion and the cont rib utio n of each subassembly to the singularity locus of the platform can be easily singled out . The re are fou r bas ic rig id sub ass emb lie s in Ste war t platforms involving linear geometric elements such as points, li nes, and pl anes (Fig. 1) . This pa pe r is de vo te d to the kinematics analysis of the line-plane subassembly with the aim of (a) obtaining a simple characterization of its archi- tect ural singular itie s, and (b) giv ing simp le and comp lete rule s for modifyi ng the locatio n of the leg atta chme nts in the subassembly without altering the singularity locus of the platform. The number of pos sibly ov erlapp ing subass emb lies in which a Stewart platform can be decomposed was analyzed by Ko ng and Gossel in [1]. Ga o and col. ex te nded this analysis to generalized Stewart platforms involving distances between points, lines and planes instead of only six pairwise distances between points [2]. Zhang and Song solved, for the rst time, the forward kinematics of general Stewart platform containing a line-plane subassembly [3]. They showed how the line in the line-plane subassembly of such a platform can have up to eight congurations with respect to the plane and, as a consequence, the platform can have up to 16 assembly mode s. The eight congura tions of the line corr espon d to The authors are with the Institut de Robòtica i Informàtica Industrial, CSIC-UPC. Llorens Artigas 4-6, 08028 Barcelona, Spain. E-mails: {jborras, ftho mas}@iri. upc.e du. This work has been part iall y supp orte d by the Spanish Ministry of Education and Science, under the I+D project DPI2007- 60858. Fig. 1. Fou r rigi d subassemb lies inv olvi ng linear geomet ric element s. the roots of a bi-q uart ic poly nomi al. Therefor e, the exis- tence of an algebraic expression for these congurations in function of the ve input distances was proved. Husty and Karg er studi ed the conditions for this subassembly being arch itec tura lly singu lar and found two alge brai c condi tion s that must be simultaneously satised [4]. To the best of our knowledge, no further insights into the analysis of the line- plane subassembly have been presented. This work ca n be seen as a cont inuation of the one presented in [5], where we studied the line-line subassem- bly kinemat ics and wher e the role of cross-ratios between atta chme nts in the char acte riza tion of arch itec tura l singu - larities, and in the singularity invariant modication of the atta chme nts loca tion s, was rst ackn owl edged . We sho w her ein how the se ide as can be exten ded to the li ne- pla ne subassembly. The pape r is or ga ni ze d as foll ows. The next se ct ion int rod uce s the notation used thr oug hou t this pap er, and presents some preliminaries concerning the factorization of the Jac obi an for a pla tfo rm con ta ini ng a lin e-p lan e sub - asse mbly. Sect ion III deal s with architectural singu lari ties and pre sen ts a ne w simple geo me tri c con dit ion , in terms of cross-ratios, to decide if a given line-plane subassembly is architecturally singular. Section IV shows how to change the location of the attachments in a line-plane subassembly with out chan ging the sing ular itie s of the plat form. Sect ion V presents a simple formulation to compute the lengths of the legs resulti ng from changin g thei r atta chme nts, usin g the tran sfor mati ons pres ente d in the pre viou s sect ion, in terms of the lengths of the original legs. Section VI shows how the forward kine mati cs of a line -pla ne suba ssembly can be fully formulated in terms of distances and solved in terms of trilaterations. Finally, Section VII summarizes the contributions of this work. 2009 IEEE International Conference on Robotics and Automation Kobe International Conference Center Kobe, Japan, May 12-17, 2009 978-1-4244-2789-5/09/$25.00 ©2009 IEEE 4094 Authorized licensed use limited to: UNIVERSITAT POLITÈCNICA DE CATALUNYA. Downloaded on December 1, 2009 at 09:44 from IEEE Xplore. Restrictions apply.

Transcript of 1042-Kinematics-of-line-plane-subassemblies-in-Stewart-platforms.pdf

  • Kinematics of Line-Plane Subassemblies in Stewart Platforms

    Jlia Borrs and Federico Thomas

    Abstract When the attachments of five legs in a Stewartplatform are collinear on one side and coplanar on the other,the platform is said to contain a line-plane subassembly. Thispaper is devoted to the kinematics analysis of this subassemblypaying particular attention to the problem of moving theaforementioned attachments without altering the singularitylocus of the platform. It is shown how this is always possibleprovided that some cross-ratios between lines defined bypoints in the plane are kept equal to other cross-ratiosbetween points in the line. This result leads to two simplemotion rules upon which complex changes in the location ofthe attachments can be performed. These rules have interestingpractical consequences as they permit a designer to optimizeaspects of a parallel robot containing the analyzed subassembly,such as its manipulability in a given region, without alteringits singularity locus.

    Index Terms Parallel manipulators, robot kinematics, ar-chitectural singularities, kinematics singularities, manipulatordesign.

    I. INTRODUCTIONThe kinematic analysis of a Stewart platform gets greatly

    simplified when it contains rigid subassemblies. When thishappens the platform forward kinematics can be solved in amodular fashion and the contribution of each subassemblyto the singularity locus of the platform can be easily singledout. There are four basic rigid subassemblies in Stewartplatforms involving linear geometric elements such as points,lines, and planes (Fig. 1). This paper is devoted to thekinematics analysis of the line-plane subassembly with theaim of (a) obtaining a simple characterization of its archi-tectural singularities, and (b) giving simple and completerules for modifying the location of the leg attachments inthe subassembly without altering the singularity locus of theplatform.

    The number of possibly overlapping subassemblies inwhich a Stewart platform can be decomposed was analyzedby Kong and Gosselin [1]. Gao and col. extended thisanalysis to generalized Stewart platforms involving distancesbetween points, lines and planes instead of only six pairwisedistances between points [2]. Zhang and Song solved, for thefirst time, the forward kinematics of general Stewart platformcontaining a line-plane subassembly [3]. They showed howthe line in the line-plane subassembly of such a platform canhave up to eight configurations with respect to the plane and,as a consequence, the platform can have up to 16 assemblymodes. The eight configurations of the line correspond to

    The authors are with the Institut de Robtica i Informtica Industrial,CSIC-UPC. Llorens Artigas 4-6, 08028 Barcelona, Spain. E-mails: {jborras,fthomas}@iri.upc.edu. This work has been partially supported by theSpanish Ministry of Education and Science, under the I+D project DPI2007-60858.

    Fig. 1. Four rigid subassemblies involving linear geometric elements.

    the roots of a bi-quartic polynomial. Therefore, the exis-tence of an algebraic expression for these configurations infunction of the five input distances was proved. Husty andKarger studied the conditions for this subassembly beingarchitecturally singular and found two algebraic conditionsthat must be simultaneously satisfied [4]. To the best of ourknowledge, no further insights into the analysis of the line-plane subassembly have been presented.

    This work can be seen as a continuation of the onepresented in [5], where we studied the line-line subassem-bly kinematics and where the role of cross-ratios betweenattachments in the characterization of architectural singu-larities, and in the singularity invariant modification of theattachments locations, was first acknowledged. We showherein how these ideas can be extended to the line-planesubassembly.

    The paper is organized as follows. The next sectionintroduces the notation used throughout this paper, andpresents some preliminaries concerning the factorization ofthe Jacobian for a platform containing a line-plane sub-assembly. Section III deals with architectural singularitiesand presents a new simple geometric condition, in termsof cross-ratios, to decide if a given line-plane subassemblyis architecturally singular. Section IV shows how to changethe location of the attachments in a line-plane subassemblywithout changing the singularities of the platform. SectionV presents a simple formulation to compute the lengths ofthe legs resulting from changing their attachments, usingthe transformations presented in the previous section, interms of the lengths of the original legs. Section VI showshow the forward kinematics of a line-plane subassemblycan be fully formulated in terms of distances and solved interms of trilaterations. Finally, Section VII summarizes thecontributions of this work.

    2009 IEEE International Conference on Robotics and AutomationKobe International Conference CenterKobe, Japan, May 12-17, 2009

    978-1-4244-2789-5/09/$25.00 2009 IEEE 4094

    Authorized licensed use limited to: UNIVERSITAT POLITCNICA DE CATALUNYA. Downloaded on December 1, 2009 at 09:44 from IEEE Xplore. Restrictions apply.

  • II. NOTATION AND PRELIMINARIES

    Let us consider the line-plane subassembly contained inthe Stewart platform appearing in Fig. 2. We assume thatno four points in the plane are collinear. Otherwise, thissubassembly would contain a line-line subassembly thatcould be studied separately [5]. We also assume that no twoattachments, either in the plane or in the line, are coincident.

    PSfrag replacements

    i

    p

    a1

    a2

    a3

    a4

    a5

    a6

    b1b2

    b3b4

    b5

    b6

    Fig. 2. Stewart platform containing a line-plane subassembly.

    The attachments in the plane have coordinates ai =(xi, yi, 0), for i = 1, . . . , 5. The pose of the line withrespect to the plane can be described by the position vectorp = (x, y, z) and the unit vector i = (u, v, w) in the directionof the line. Thus, the coordinates of the attachments in theline, expressed in the base reference frame, can be writtenas bi = p + zii. Without loss of generality, we can setx1 = y1 = y2 = z1 = 0 by properly locating the basereference frame. In order to lighten the notation, an slightabuse of language is made by using the same symbol todenote a point and its position vector.

    Then, the Plcker coordinates of the five leg lines in theline-plane subassembly can be written as:

    li = (bi ai, (bi ai) ai)

    =

    x + ziu xiy + ziv yi

    z + ziwyi(z + ziw)xi(z + ziw)

    yi(x + ziu xi) xi(y + ziv yi)

    ,(1)

    and that of the sixth leg, simply as l6 = (v,m)T .The singularity locus of the platform is defined as the root

    locus of det(J) [6], where J is the matrix J = (l1, . . . , l6).It can be checked that this determinant factors as follows:

    det(J) = det(T)K(a6,b6), (2)

    where K(a6,b6) is zero if, and only if, a6 lies on the

    platform plane, and T is:

    wz w(zu xw) w(zv yw) z(xw zu) z(yw zv)z2 x2 0 x2z2 0z3 x3 y3 x3z3 y3z3

    z4 x4 y4 x4z4 y4z4

    z5 x5 y5 x5z5 y5z5

    .

    (3)Therefore, the root locus of det(J) can be decomposed

    into the root locus due to the line-plane subassembly and thatintroduced by the sixth leg. The part of the singularity locusdue to the line-plane subassembly corresponds to the rootlocus of the polynomial resulting from expanding det(T),i.e.,

    C1wz + C2w(zu xw) + C3w(zv yw)+

    C4z(xw zu) + C5z(yw zv) = 0, (4)

    where Ci, for i = 1, . . . 5, is the cofactor of the element i ofthe first row of T.

    III. ARCHITECTURAL SINGULARITIESIn the particular case in which det(T) is identically zero,

    independently of the pose of the line with respect to theplane, the subassembly is said to be architecturally singular[7]. Next, we concentrate ourselves in the characterizationof this kind of singularities.

    Note that det(T) is zero independently of the pose ofthe line if, and only if, all the coefficients in equation (4)are zero. Since such coefficients are the cofactors of elementsof the first row of T, we can say that det(T) is identicallyzero if, and only if, the submatrix formed by the last fourrows of T, say T, is rank defective. This circumstance canbe easily detected by applying Gaussian elimination on T.

    After performing standard Gaussian elimination on T, thelast row of the resulting matrix is:

    1

    D

    (0 0 0 C4 C5

    )(5)

    where Ci are the same cofactors appearing in (4), and

    D =

    z2 x2 0z3 x3 y3z4 x4 y4

    . (6)Thus, if C4 = C5 = 0, the line-plane subassembly will bearchitecturally singularity. It can be shown that, by permutingthe indices of the attachment, we can always find a value forD different from zero.

    It can be checked that the conditions C4 = 0 and C5 =0 are one-to-one equivalent to the two algebraic conditionspresented in [4, Theorem 1.6].

    If we would perform Gaussian elimination on the verti-cally mirrored version of T, the last row in the resultingmatrix would be:

    1

    z2x2y3y4(z3 z4)

    (0 0 0 C1 C2.

    )(7)

    Thus, we can alternatively say that a line-plane subassemblyis architecturally singular if, and only if, C1 = C2 = 0.Actually, by permuting the columns of T, we can conclude

    4095

    Authorized licensed use limited to: UNIVERSITAT POLITCNICA DE CATALUNYA. Downloaded on December 1, 2009 at 09:44 from IEEE Xplore. Restrictions apply.

  • that a line-plane subassembly is architecturally singular if,and only if, any two cofactors are zero. In any case, to avoidan undefined quotient, the denominator resulting from theapplied Gaussian elimination must be different from zero,which is always possible by permuting the indices of theattachments.

    It has been proved that a line-line subassembly is architec-turally singular if, and only if, the cross-ratios between theattachments in both lines are equal [5]. It is interesting tosee how the condition C1 = C2 = 0 can also be interpretedgeometrically in terms of cross-ratios.

    Given four collinear points with coordinates pi =(ni, 0, 0), for i = 1, . . . 4, their cross-ratio is defined as:

    CR(p1,p2,p3,p4) =(n3 n1)(n4 n2)

    (n4 n1)(n3 n2). (8)

    Likewise, for a set of four coplanar and concurrent lines,l1, l2, l3, l4, their cross-ratio CRl(l1, l2, l3, l4) is defined asthe cross-ratio of the four points resulting from intersectingthese four lines with an arbitrary line, in general position,lying in the same plane [8, Section IV.3].

    PSfrag replacements

    a1

    a2

    a3

    a4

    a5

    b1b2

    b3b4

    b5

    s2

    s3

    s4

    s5

    r1r3

    r4

    r5

    Fig. 3. A line-plane subassembly is architecturally singular if, and only if,CR(b2,b3,b4,b5) = CRl(s2, s3, s4, s5) and CR(b1,b3,b4,b5) =CRl(r1, r3, r4, r5). By permuting indices, up to ten equivalent sets ofconditions can be derived.

    A line-plane subassembly is architecturally singular if,and only if, CR(b2,b3,b4,b5) = CRl(s2, s3, s4, s5) andCR(b1,b3,b4,b5) = CRl(r1, r3, r4, r5) (Fig.3). By per-muting indices, up to ten equivalent sets of conditions canbe derived. It can be proved that all of them are equivalentto the corresponding cofactor conditions Ci = Cj = 0 fori, j {1, ..., 5}, i 6= j (in Fig.3, C1 = C2 = 0).

    IV. CHANGING ATTACHMENTS WITHOUT CHANGINGSINGULARITIES

    Let us consider the multilinear equation

    ax + by + cz + dxz + eyz + f = 0, (9)

    which implicitly defines a hypersurface in the space definedby (x, y, z) R3. The attachments of leg i of our line-planesubassembly define a point, (xi, yi, zi), in this hypersurface.Since we have five legs (i.e., five points in this hypersurface),

    the coefficients a, b, c, e, and f are uniquely determined.Actually, (9) can be expressed in terms of these five pointsas:

    z x y xz yz 1z1 x1 y1 x1z1 y1z1 1z2 x2 y2 x2z2 y2z2 1z3 x3 y3 x3z3 y3z3 1z4 x4 y4 x4z4 y4z4 1z5 x5 y5 x5z5 y5z5 1

    = 0.

    Observe that, if we substitute one of the chosen five pointsby any other point in the hypersurface, the resulting equationwill have the same coefficients up to a scalar multiple.

    Since in our case x1 = y1 = z1 = y2 = 0, the aboveequation yields

    z x y xz yzz2 x2 0 x2z2 0z3 x3 y3 x3z3 y3z3z4 x4 y4 x4z4 y4z4z5 x5 y5 x5z5 y5z5

    = 0. (10)

    In other words,

    C1z + C2x + C3y + C4zx + C5zy = 0 (11)

    where Ci are the cofactors referred in the previous section,i.e., the same coefficients appearing in (4).

    Now, if we change the attachments of one leg so thatthe coordinates of the new attachments satisfy (10), thecoefficients of the singularity polynomial in (4) remain thesame up to a constant multiple and, as a consequence, its rootlocus remains invariant. This simple observation gives us theclue to change the attachments in a line-plane subassemblywithout changing the platform singularity locus.

    PSfrag replacements

    a1

    a2

    a3

    a4

    a5

    b1b2

    b3b4

    b5

    Bz1

    Bz2

    Bz3

    Bz4

    Bz5

    B

    Fig. 4. The one-to-one correspondence between the attachments in the lineand the lines of the pencil centered at B. Each value of zi defines a pointin the line, bi = p + zii, and a line in the plane Bzi .

    Equation (10) implicitly defines a one-to-one correspon-dence between points in the line and lines in the plane.Indeed, given an attachment in the plane with coordinates(x, y, 0), we conclude from equation (10) that there is aunique corresponding attachment in the line with coordinatez. On the way round, given an attachment in the line, a line

    4096

    Authorized licensed use limited to: UNIVERSITAT POLITCNICA DE CATALUNYA. Downloaded on December 1, 2009 at 09:44 from IEEE Xplore. Restrictions apply.

  • PSfrag replacements

    a1

    a2

    a3

    a4

    ai

    b1b2

    b3b4

    bi

    B

    aibiBzi

    Bzi

    PSfrag replacements

    a1

    a2

    a3

    a4

    ai b1b2

    b3b4b4

    bi

    B

    ai

    bi

    Bzi

    Bzi

    PSfrag replacements

    a1

    a2

    a3

    a4

    ai b1b2

    b3b4

    biB

    ai

    bi

    Bzi

    Bzi

    (a) (b) (c)Fig. 5. It is possible to move an attachment in the plane to any arbitrary location by following three steps (see text for details).

    is defined in the plane through equation (10). It is importantto realize that, as z varies, a pencil of lines is generated inthe plane. In other words, the generated lines intersect at asingle point whose coordinates are:(

    C3C1C2C5 C4C3

    ,C2C1

    C2C5 C4C3, 0

    ). (12)

    In what follows, the point with the above coordinates willbe called the center of the correspondence. It will be denotedby B and any line in the plane passing through it will becalled a B-line (Fig. 4).

    Finally, two simple rules to move the attachments withoutaltering the singularity locus naturally arise:

    all attachments in the plane can be freely moved alongtheir B-lines, and

    an attachment in the line can be freely moved if, andonly if, the other attachment of the corresponding legis located at B.

    Following these two rules, it is possible to move anyattachment in the plane, say ai, to any arbitrary location,say ai, in three steps (Fig. 5):

    move ai along the corresponding B-line until it meetsB,

    move bi till its coordinate in the line determines a B-line that contains ai, and

    move ai along the B-line that contains ai.Thus, it is possible to carry out many complex transfor-

    mations, but special attention must be paid to avoid that, ateach step,

    no three attachments in the plane are located in thesame B-line because three leg lengths would becomedependent, and

    no four attachments in the plane are collinear as, inthis case, the line-plane subassembly would containan architecturally singular line-line subassembly. Thisrather surprising result will become evident at the endof this section where the proposed transformations areinterpreted in terms of cross-ratios.

    Given a general line-plane subassembly, what is themaximum number of attachments that, following the above

    r

    PSfrag replacements

    a1 a2

    a4 a5

    a3

    b1b2

    b4 b5b3

    (a)

    PSfrag replacements

    a1 a2

    a4

    a5

    a3

    b1b2

    b4b5

    b3

    (b)Fig. 6. Given a general line-plane subassembly, what is the maximumnumber of attachments that, following the proposed transformations, can bemade coincident?

    motion rules, can be made coincident? Two attachments inthe plane can be readily made coincide by taking them alongtheir B-lines till they meet at B [Fig. 6(a)]. Afterwards,their corresponding attachments in the line can be movedto coincide with two other attachments [Fig. 6(b)]. Notethat no further coincidences are possible without incurring inone of the two previous exceptions. It is obvious that othervalid line-plane subassemblies including more coincident

    4097

    Authorized licensed use limited to: UNIVERSITAT POLITCNICA DE CATALUNYA. Downloaded on December 1, 2009 at 09:44 from IEEE Xplore. Restrictions apply.

  • attachments exist, but we can ensure that their singularityloci will be essentially different from that of the generalline-plane subassembly.

    Finally, it is worth noting that a one-to-one correspondencebetween lines and/or points exists through a multilinearexpression if, and only if, the cross-ratio of any set offour lines in a plane or four points in a line is equal tothe cross-ratio of their correspondents. This fact derivesfrom [9, Theorem II.2]. Since (10) defines a one-to-onecorrespondence through a multilinear function between linesand points, we can conclude that the cross-ratio of any fourB-lines must be equal to the cross-ratio of the correspondingattachments in the line. This provides and alternative wayfor computing B and, what is much more important, analternative way of defining all valid changes in the location ofthe attachments as those that keep invariant the cross-ratiosbetween the B-lines in the plane and their correspondingattachments in the line.

    V. COMPUTING LEG LENGTHSThis section shows how to compute the length of the legs

    resulting from changing the location of their attachments,using the motion rules presented in the previous section, interms of the lengths of the original legs.

    The leg lengths of our line-plane subassembly can beexpressed as l2i = bi ai, for i = 1, . . . , 5. Then, ifwe subtract from the expression for li, i = 2, . . . , 5, theequations u2 +v2 +w2 = 1 and l2

    1= x2 +y2 +z2, quadratic

    terms cancel yielding

    zitxix yiy xiziu yiziv

    + 1/2(x2i + y2

    i + z2

    i + l2

    1 l2i ) = 0,

    (13)

    for i = 2, . . . , 5, where t = p i, x, y, u and v areunknowns.

    Now, suppose we want to compute the distance d2 = ba between the point in the plane a = (x, y, 0) and the pointin the line b = p + zi, where {x, y, z} satisfies equation(10). If we subtract from the expression for d2 the equationsu2 + v2 + w2 = 1 and l2

    1= x2 + y2 + z2, quadratic terms

    cancel, as above. The resulting expression for d2, togetherwith the equations in (13), lead to a system of five equationsin six unknowns. If we take t as parameter, the resultinglinear system can be written as:

    x2 0 x2z2 0 0x3 y3 x3z3 y3z3 0x4 y4 x4z4 y4z4 0x5 y5 x5z5 y5z5 0x y xz yz 1

    2

    xyuvd2

    =

    z2t + N2z3t + N3z4t + N4z5t + N5zt + N

    ,

    (14)where Ni = 12 (x

    2

    i + y2

    i + z2

    i + l2

    1 l2i ) and N = 12 (x

    2 +y2 + z2 + l2

    1). The determinant of this linear system is 1

    2C1,

    that is, the cofactor of the first element of T. If this cofactoris zero, we can always choose as parameter either x, y, u,or v, to reformulate the above linear system. Since for anon-architecturally singular line-plane subassembly no twocofactors are zero (as we have proved in Section III), we

    can always find a non-singular linear system by choosingthe right parameter.

    Solving the above system for d2 using the Cramers rule,we get

    d2 =

    x2 0 x2z2 0 z2t + N2x3 y3 x3z3 y3z3 z3t + N3x4 y4 x4z4 y4z4 z4t + N4x5 y5 x5z5 y5z5 z5t + N5x y xz yz zt + N

    1

    2C1

    . (15)

    In other words,d2 =

    rt + s1

    2C1

    , (16)

    where

    r =

    x2 0 x2z2 0 z2x3 y3 x3z3 y3z3 z3x4 y4 x4z4 y4z4 z4x5 y5 x5z5 y5z5 z5x y xz yz z

    (17)

    and

    s =

    x2 0 x2z2 0 N2x3 y3 x3z3 y3z3 N3x4 y4 x4z4 y4z4 N4x5 y5 x5z5 y5z5 N5x y xz yz N

    . (18)

    Finally, notice that, for any set of values for x, y, andz satisfying (10), r = 0. Therefore, the length of anyleg, resulting from the changes in its attachments followingthe rules proposed in the previous section, can be readilycomputed as the quotient of two determinants involvingthe attachment coordinates and the leg lengths prior to thechanges.

    VI. FORWARD KINEMATICSGiven the general line-plane subassembly in Fig.7, the

    lengths of the dotted segments in blue, l1, l3, and l4, canbe obtained using the formula presented in the previoussection. Then, the lengths of the dotted segments in red u1,u2, u3 and u4, can be obtained using standard techniquesfrom Distance Geometry, as described below. Once thesedistances are known, the forward kinematics of our line-plane subassembly can trivially solved by a sequence oftrilaterations [10].

    The Cayley-Menger determinant, D(p1, ...,pn) of the setof points p1, ...,pn is defined as the determinant of the (n+1) (n+1) matrix with the last row and column entries setto one and its ij entry, the square distance between pi andpj [10]. This determinant is proportional to squared volumeof the (n 1)-dimensional simplex defined by the n points.Thus, in three dimensions, the Cayley-Menger determinant offive or more points is necessarily zero. Then, we can establishthe following quadratic relation between u2

    1and u2

    2.

    D(a2,b2,B,b5,a5) =2

    i=0

    2j=0

    pij(u2

    1)i(u2

    2)j = 0 (19)

    4098

    Authorized licensed use limited to: UNIVERSITAT POLITCNICA DE CATALUNYA. Downloaded on December 1, 2009 at 09:44 from IEEE Xplore. Restrictions apply.

  • PSfrag replacements

    a1

    a

    1 a2

    a3a4

    a5

    B

    b1

    b2b3

    b4 b5

    u1

    u2

    u3

    u4

    l1

    l2 l3 l4l5

    Fig. 7. The forward kinematics of a line-plane subassembly can be fully formulated in terms of distances. l1, l3 and l4 can be computed using thedistance formula presented in Section V. Then, ui, for i = 1, . . . , 4 can be obtained using standard Distance Geometry techniques.

    Since the Cayley-Menger determinant of four coplanar pointsmust also be zero, because the volume of the simplexdefined by the four points is degenerate, the following linearequations in u2i , i = 1, . . . , 4 can also be readily obtained:

    D(b1,b2,b5,a2) = s12u2

    2+ s25u

    2

    3+

    (s12 + s25)l2

    2+ s12s25(s12 + s25) = 0

    (20)

    D(b1,b2,b5,a5) = s12l2

    5+ s25u

    2

    4+

    (s12 + s25)u2

    1+ s12s25(s12 + s25) = 0

    (21)

    D(a1,a2,a5,b1) = r12u

    2

    4+ r25l

    2

    1+

    (r12 + r25)u2

    3+ r12r25(r12 + r25) = 0,

    (22)

    where rij are distances between base points ai and aj andsij distances between line points bi and bj .

    Using (20) and (21), we obtain values for u23

    and u24

    thatcan be substituted in (22), thus obtaining a linear equationin squared distances of the form:

    p1u2

    1+ p2u

    2

    2+ p3 = 0. (23)

    Finally, using (19) and (23), we obtain a resultant polynomialof degree four in u2

    1. Then, a closed-form solution for u2

    1

    exists. For each possible value for u21, four possible poses

    for the line with respect to the plane can be found bytrilateration. Using the corresponding values for u2

    2, u2

    3and

    u24

    to discriminate solutions, only two possible poses for eachvalue of u2

    1are possible. Actually, they are mirror solutions

    with respect to the plane. Thus, a line-plane subassembly canattain up to eight assembly modes, a result consistent withthat presented by Zhang and Song in [3].

    VII. CONCLUSIONSA kinematics analysis of the line-plane subassembly with

    especial emphasis on singularity-invariant transformations inthe locations of its leg attachments has been presented. It hasbeen shown how these transformations can be interpreted asthose that keep invariant some cross-ratios between points inthe line and lines in the plane, and how similar cross-ratiosalso permit to decide if the given line-plane subassembly isarchitecturally singular. This remarkable characterization of

    architectural singularities and singularity-invariant transfor-mations in terms of cross-ratios has given us much insightinto both problems, mainly because of its straightforwardgeometric and visual interpretation. We actually conjecturethat this characterization can be extended to general Stewartplatforms.

    Finally, it is worth noting that locating a line, with respectto a plane, from a set of pairwise distances between pointsin the line and in the plane is a basic operation that arises inconstraint-based geometric modeling. As a consequence, itis worth investigating the repercussions the presented resultsto this problem.

    ACKNOWLEDGEMENTThe authors would like to thank Carme Torras and

    Maria Alberich-Carramiana for their technical commentsand helpful advice during the development of this work.

    REFERENCES[1] X. Kong and C.M. Gosselin, Classification of 6-SPS Parallel Manip-

    ulators According to Their Components, Proc. ASME Des. Eng. Tech.Conf., 2000.

    [2] X. Gao, D. Lei, Q. Liao, and G-F. Zhang, Generalized Stewart-Goughplatforms and their direct kinematics, IEEE Trans. on Robotics, Vol.21, No. 2, pp. 141-151, 2005.

    [3] C. Zhang and S.M. Song, Forward Kinematics of a Class of Parallel(Stewart) Platforms with Closed-Form Solutions, Proc. IEEE Intl.Conf. on Robotics and Automation, pp. 2676-2681, 1991.

    [4] M.L. Husty and A. Karger, Architecture Singular Parallel Manipulatorsand Their Self-Motions, Advances in Robot Kinematics, J. Lenarcicand M. M. Stanisic (eds.), Kluwer Academic Publishers, pp. 355-364,2000.

    [5] J. Borrs, F. Thomas, and C. Torras, Architecture singularities inflagged parallel manipulators, Proc. of the IEEE Intl. Conf. on Roboticsand Automation, pp. 3844-3850, 2008.

    [6] J.-P. Merlet, Parallel Robots, Springer, 2000.[7] O. Ma and J. Angeles, Architecture Singularities of Platform Manipu-

    lators, Proc. IEEE Intl. Conf. on Robotics and Automation, Vol. 2, pp.1542-1547, 1991.

    [8] R. Courant and H. Robbins, What is Mathematics? Oxford UnivesityPress, 1996.

    [9] E.A. Maxwell, The Methods of Plane Projective Geometry based onthe use of General Homogeneous Coordinates, Cambridge UniversityPress, 1960.

    [10] J.M. Porta, L. Ros, and F. Thomas, On the Trilaterable Six-Degree-of-Freedom Parallel and Serial Manipulators, Proc. of the IEEE Int.Conf. on Robotics and Automation, pp. 960 - 967, 2005.

    4099

    Authorized licensed use limited to: UNIVERSITAT POLITCNICA DE CATALUNYA. Downloaded on December 1, 2009 at 09:44 from IEEE Xplore. Restrictions apply.