chp-3a10.1007-2f978-94-007-4620-6_46.pdf

Upload: ktk-zad

Post on 14-Apr-2018

215 views

Category:

Documents


0 download

TRANSCRIPT

  • 7/27/2019 chp-3A10.1007-2F978-94-007-4620-6_46.pdf

    1/8

    Inverse Geometrico-Static Analysis of

    Under-Constrained Cable-Driven Parallel

    Robots with Four Cables

    Marco Carricato, Ghasem Abbasnejad and Dominic Walter

    Abstract This paper presents the inverse geometrico-static analysis of under-

    constrained cable-driven parallel robots with 4 cables. The problem consists in find-

    ing all equilibrium configurations of the end-effector when either its orientation or

    the center-of-masss position is assigned. In both cases, a further point of the end-

    effector is constrained to lie on a given plane. A major challenge is posed by the

    intrinsic coupling between kinematics and statics, which must be tackled simulta-

    neously. The problems at hand are solved by analytical elimination procedures, thus

    leading to univariate polynomials free of spurious factors. All potential solutions

    may be real.

    Key words: Cable-driven parallel robots, under-constrained robots, kinematic anal-

    ysis, static analysis

    1 Introduction

    Cable-driven parallel robots (CDPRs) employ cables in place of rigid-body exten-sible legs in order to control the end-effector (EE) pose, thus strengthening classic

    advantages characterizing closed-chain architectures versus serial ones. A CDPR is

    under-constrained if the EE preserves some freedoms once actuators are locked.

    Typically, this occurs when the EE is controlled by a number of cables n smaller

    than the number of degrees of freedom (dofs) that the EE possesses with respect to

    the base [2].

    Marco Carricato Ghasem AbbasnejadDepartment of Mechanical Engineering, University of Bologna, Bologna, Italy, e-mail: marco.

    [email protected]

    Dominic Walter

    Institute for Basic Sciences in Engineering, University of Innsbruck, Innsbruck, Austria

    J. Lenarcic, M. Husty (eds.), Latest Advances in Robot Kinematics,

    DOI 10.1007/978-94-007-4620-6 46,

    Springer Science+Business Media Dordrecht 2012

    365

    http://[email protected]/http://[email protected]/http://dx.doi.org/10.1007/978-94-007-4620-6_46http://dx.doi.org/10.1007/978-94-007-4620-6_46http://dx.doi.org/10.1007/978-94-007-4620-6_46http://[email protected]/http://[email protected]/
  • 7/27/2019 chp-3A10.1007-2F978-94-007-4620-6_46.pdf

    2/8

    366 M. Carricato et al.

    Fig. 1 A cable-driven parallel robot with 4 cables: (a) model for the IGP with assigned orientation,

    (b) model for the IGP with assigned position.

    A major challenge in the kinematic study of under-constrained CDPRs emerges

    from the fact that the EE configuration depends on both the cable lengths and the

    applied forces (e.g. gravity). Accordingly, loop-closure and mechanical-equilibrium

    equations must be solved simultaneously and displacement-analysis problems be-

    come significantly more complex than analogous tasks concerning rigid-link fully-

    constrained manipulators [7, 9, 10]. Recently, Carricato and Merlet [24] proposed

    a general methodology for the kinematic, static and stability analysis of under-

    constrained CDPRs equipped with n 5 cables. By properly formulating the math-ematical model, the method allows one to find the entire set of equilibrium config-

    urations when either n EE-pose coordinates (inverse problem) or n cable lengths

    (direct problem) are assigned.

    In this paper, the inverse geometrico-static problem of CDPRs with 4 cables is

    solved. Two instances are considered, depending on whether the EE orientation or

    the EEs center-of-mass position is assigned. Since 4 dofs of the EE are to be con-

    trolled, an additional constraint must be set on the EE-pose coordinates: when the

    EE orientation is assigned, the EEs center-of-mass is constrained to lie on a given

    plane (this condition may be useful, for instance, to set the center-of-mass at a given

    height); when the EE orientation is assigned, an additional point of the EE is set to

    lie on a given plane (this condition may be useful for obstacle avoidance, in order

    to guide the EE tilt). In both cases, the overall robot configuration, the cable lengthsand the cable tensions are to be computed.

  • 7/27/2019 chp-3A10.1007-2F978-94-007-4620-6_46.pdf

    3/8

    Inverse Geometrico-Static Analysis of Under-Constrained CDPRs with 4 Cables 367

    2 Geometrico-Static Model

    The EE is connected to the fixed base by 4 cables (Fig. 1). The ith cable exits

    from the base at point Ai and it is connected to the EE at point Bi . The geometric

    parameters of both the EE and the base are arbitrary. A is a fixed Cartesian frame

    attached at A1, whereas B is a Cartesian frame attached to the EE at the platforms

    center of mass G. The platform pose is described by XT = [gT;T], where gT =[x , y , z]T is the position of G in A and T = [e1, e2, e3]T is the array groupingthe Rodrigues variables parameterizing the EE orientation with respect to A. The

    EE is acted upon by a constant force of magnitude Q, applied at G. This force is

    described as a 0-pitch wrench QLe, where Le is the normalized Plucker vector of

    the line of action. The normalized Plucker vector of the line associated with the ith

    cable is Li /i , where i is the cable length, pi is any vector from the reduction

    pole of moments O to the cable line and LTi = [(Ai Bi )T; {pi (Ai Bi )}T].Accordingly, the wrench exerted by the ith cable on the EE is (i /i )Li , with ibeing a positive scalar representing the intensity of the cable tensile force. Without

    loss of generality, one may assume O A1.When all cables of the robot are in tension, the set of geometrical constraints

    imposed on the EE is

    ||Ai Bi ||2 = 2i , i = 1 . . . 4, (1)

    with the overall pose being determined by the EE static equilibrium, i.e.

    4i=1

    i

    iLi + QLe =

    L1 L2 L3 L4 Le

    M(O)

    (1/1)

    (2/2)

    (3/3)

    (4/4)

    Q

    = 0, (2)

    with i 0, i = 1 . . . 4.Equations (1)(2) amount to 10 scalar relations in 14 variables, namely g, , i

    and i , i = 1 . . . 4.Generally, a finite set of system configurations may be determined if 4 additional

    constraints are assigned on the variables. When these constraints concern the EE-

    pose coordinates, an inverse geometrico-static problem (IGP) must be solved. Two

    relevant cases may be considered, depending on whether: (i) the orientation is as-

    signed and G is constrained to lie on a given plane (IGP with assigned orientation);

    or (ii) the position ofG is known and a further point B5 of the EE is required to lie

    on a given plane (IGP with assigned position). In both cases, the pose coordinates

    are subject to 4 linear constraints, i.e. qi (X) = 0, i = 1 . . . 4.By following the method presented in [2], cable tensions may be eliminated from

    the set of unknowns by observing that Eq. (2) holds only if

    rank[M(O)] 4, (3)

  • 7/27/2019 chp-3A10.1007-2F978-94-007-4620-6_46.pdf

    4/8

    368 M. Carricato et al.

    which is a purely geometrical condition, since M(O) is a 6 5 matrix only de-pending on X. By setting all 5 5 minors of M(O) equal to zero, 6 polynomialrelations that do not contain cable tensions may be obtained, 5 of which are linearly

    independent, namely pj(X)

    =0, j

    =1 . . . 5. The 0-dimensional variety V of the

    ideal generated by {q1, . . . , q4, p1, . . . , p5} provides the equilibrium configurationsof the EE that satisfy the imposed constraints.

    Once X is known, cable lengths may be computed by Eq. (1) and cable tensions

    may be obtained by 4 linearly-independent relations chosen within Eq. (2). Stability

    may be assessed as in [2]. Once a configuration is found, it proves feasible only if it

    is stable and therein cable tensions are positive.

    3 IGP with Assigned Orientation

    In this case, is known and G is constrained to lie on a plane (Fig. 1(a)). The

    constraints qi (X) = 0, i = 1 . . . 4, are

    e1 = e1, e2 = e2, e3 = e3, g n d = xn1 + yn2 + zn3 d = 0, (4)

    where e1, e2 and e3 are known scalars, n = [n1, n2, n3]T is a unit vector perpen-dicular to and |d| is the distance of from A1. Two subcases may be identified,depending on whether n3

    =0 or n3

    =0.

    3.1 n3 = 0

    When n3 = 0, is a nonvertical plane and z may be expressed, from the last rela-tionship in Eq. (4), as z = (n1/n3)x (n2/n3)y + d/n3. By taking advantage ofthis expression and by imposing the first three constraints in Eq. (4), the 5 relations

    pj(X)

    =0, j

    =1 . . . 5, emerging from Eq. (3) become cubic relations in x and y

    comprising 10 monomials, i.e. [y3, y2x , y x2, x3, y2, y x , x2, y , x , 1].The problem may be efficiently solved by implementing a Sylvester dialytic

    method, namely by rewriting the relations pj = 0 as linear equations in all mono-mials involving the original unknowns except one, which is hidden in the equation

    coefficients. If these monomials are treated as linear unknowns, a square homo-

    geneous system is obtained and the determinant of the coefficient matrix provides

    a resultant in the hidden variable. In the case at hand, by hiding y, 4 monomi-

    als in x emerge and, thus, four relations pj = 0, j = 1 . . . 4, may be used tobuild up a square Sylvester matrix. However, the corresponding resultant exhibits

    a spurious solution. In order to get rid of the extraneous factor, all five relationspj = 0, j = 1 . . . 5, may be linearized in the 5 monomials contained in the array1 = [y3, x3, x2, x, 1]T, namely

  • 7/27/2019 chp-3A10.1007-2F978-94-007-4620-6_46.pdf

    5/8

    Inverse Geometrico-Static Analysis of Under-Constrained CDPRs with 4 Cables 369

    Table 1 A 4-4 CDPR whose IGP with assigned orientation admits 5 real potential solutions (d =3/

    6).

    [A2]A [A3]A [A4]A [B1 G]A [B2 G]A [B3 G]A [B4 G]A

    6n

    8 9 1 3 3 2 3 20 7 8 4 2 1 1 15 6 4 3 1 0 2 1

    S1(y)1 = 0, (5)

    where S1(y) is a 5 5 matrix whose entries are known polynomial functions of y.Letting the determinant of S1(y) vanish yields a 5th-degree univariate equation in

    y. This was obtained in symbolic form and it is devoid of spurious roots. For eachroot, a unique value for x may be obtained by solving the linear system (5).

    Solutions may be either complexor real, with only the latter ones having phys-

    ical interest. By varying the robots geometry, the count of real roots may change.

    Table 1 reports an example for which the IGP with assigned orientation admits 5

    real solutions (not all of them necessarily feasible). Examples of this kind may be

    obtained by using the algorithms developed in [1], namely a continuation procedure

    adapted from a routine originally proposed by Dietmaier [6] and two evolutionary

    techniques based on a genetic algorithm and particle swarm optimization.

    3.2 n3 = 0

    When n3 = 0 (without loss of generality, n2 = 0), is vertical and y may beexpressed, from the last relation in Eq. (4), as y = (n1/n2)x + (d/n2).

    By substituting this expression in the relations pj(X) = 0, j = 1 . . . 5, oneobtains 5 cubics in the monomials [z2x,zx2, x3, z2, z x , x2, z , x , 1]. By a proceduresimilar to that described in Sec. 3.1, a least-degree univariate equation free from

    extraneous polynomial factors may be obtained by linearizing all five relations pj =0, j = 1 . . . 5, in the 5 monomials contained in the array 2 = [z2, x3, x2, x, 1]T,and by writing them in the form

    S2(z)2 = 0, (6)

    where S2(z) is a 5 5 matrix whose entries are known polynomial functions of z.Letting the determinant ofS2(z) vanish yields a 4th-degree univariate polynomial in

    z, which is available in symbolic form and devoid of spurious roots. For each root,

    a unique value for x may be obtained by solving the linear system (6). Even in thiscase, all roots may possibly be real.

  • 7/27/2019 chp-3A10.1007-2F978-94-007-4620-6_46.pdf

    6/8

    370 M. Carricato et al.

    4 IGP with Assigned Position

    In this case, the position of G is known and a further point B5 of the EE is con-

    strained to lie on an assigned plane (Fig. 1(b)). The constraints qi (X)

    =0,

    i = 1 . . . 4, become

    x = x, y = y, z = z, r5 n d = 0, (7)

    where x, y and z are known scalars, r5 is the position vector of B5 in A, n is a unit

    vector perpendicular to and |d| is the distance of from A1.If R() is the rotation matrix between B and A, the position vector of Bi , i =

    1 . . . 5, in A may be expressed as ri = [Bi]A = g + R()[Bi]B, where the positionofBi in B is known. By substituting these expressions in the 5 relations pj(X) = 0,j = 1 . . . 5, and by imposing the first three constraints in Eq. (7), one obtains 5sextics in e1, e2 and e3. By a similar expansion, the fourth relationship in Eq. (7),

    i.e. q4 = 0, becomes a quadratic equation in the Rodrigues parameters.By denoting the ideal generated by the set J = {p1, . . . , p5, q4} as J, the solu-

    tions of the IGP with assigned position form the variety V of J. The high orderof the polynomials in J suggests applying elimination procedures based on Groeb-

    ner bases in order to solve the problem. Even though the lexicographic monomial

    order is, in general, particularly suitable to solve polynomial systems, for it pro-

    vides equation sets whose variables may be eliminated successively, it is highly

    inefficient in terms of computation time and memory requirements. A Groebner ba-sis G[J] of J with respect to a graded reverse lexicographic order, instead, i.e.grevlex(e1, e2, e3), may be computed in a very expedited way (tenths of seconds,

    for the case at hand, on a PC with a 2.67GHz Intel Xeon processor and 4GB of

    RAM). Once G[J] is known, the FGLM algorithm [8], converting a Groebner basisfrom one monomial order to another, may be called upon to compute a univariate

    polynomial in J. However, a more efficient method is provided by the Groebner-Sylvester hybrid approach proposed in [5]. The method is based on the observation

    that G[J] comprises 12 polynomials and these contain 12 monomials in e1 and e2,i.e. 3

    = [e1e

    4

    2

    , e5

    2

    , e1e3

    2

    , e4

    2

    , e1e2

    2

    , e3

    2

    , e2

    1

    , e1e2, e2

    2

    , e1, e2, 1]

    T. Accordingly, G[J

    ]may be set up as a square system of homogeneous linear equations in the form

    S3(e3)3 = 0, (8)

    where S3(e3) is a 1212 matrix polynomial in e3. Letting the determinant ofS3(e3)vanish yields a spurious-root-free univariate polynomial of degree 32 in e3. For each

    root, unique values for e1 and e2 may be obtained by solving the linear system (8).

    An alternative procedure is based on the properties of the normal set N[J],which is the array grouping all monomials which are not multiples of any lead-

    ing monomial in G[J] [11]. N[J] contains 32 monomials in , i.e. N[J] =[1, . . . , 32]T. If rh is the remainder on division of e3h by G[J], rh is a linearcombination of the monomials of N[J], i.e. rh =

    32k=1 ahkk , with ahk being a

    constant coefficient. Since rh e3h belongs to J, it must vanish on the variety

  • 7/27/2019 chp-3A10.1007-2F978-94-007-4620-6_46.pdf

    7/8

    Inverse Geometrico-Static Analysis of Under-Constrained CDPRs with 4 Cables 371

    Table 2 A 4-4 CDPR whose IGP with assigned position admits 32 real potential solutions (d =0.0543588).

    [A2]A [A3]A [A4]A [B1]B [B2]B [B3]B [B4]B [B5]B n (x, y, z)

    0.0096715 0.1602038 0.3227272 0.8585338 0.3187879 0.6598471 0.6273182 0.4579794 0.8894538 0.1339193

    0 0.0649423 0.7151215 0 0.4888859 0.6661870 0.9610494 0.5558744 0.4392272 0.2021438

    0.5484151 0.6597958 0.5378416 0 0 0.8744523 0.0797477 0.8222827 .1262981 0.1180386

    V, for any h. Thus, one may assemble all equations of this kind in the form

    (A[J, e3] e3I32) N[J] = 0, (9)

    where A[J, e3] = [ahk] is a 32 32 numeric matrix (called multiplication matrixfor e3) and I32 is the 32 32 identity matrix. Equation (9) is a linear eigenvalueproblem, whose 32nd-degree characteristic polynomial is the desired resultant in

    e3. Equation (9) provides an efficient way to numerically compute all solutions of

    the problem at hand as the eigenvalues of A[J, e3].By taking advantage of the algorithms developed in [1], several sets of robot

    parameters were found proving that all 32 solutions may be real. Table 2 reports an

    example.

    5 Conclusions

    This study solved the inverse geometrico-static problem (IGP) of under-constrained

    cable-driven parallel robots with 4 cables. The problem consists in finding all equi-

    librium configurations of the robot when a subset of the end-effector pose coordi-

    nates is assigned. Two relevant cases were considered.

    In the former, the orientation of the end-effector is assigned and the center of

    mass is constrained to lie on a plane (IGP with assigned orientation). The prob-

    lem was solved by an elimination procedure based on a Sylvester dialytic method.

    A least-degree univariate polynomial was obtained in symbolic form. This has de-

    gree 4 or 5, depending on the orientation of the plane constraining the center of mass

    being vertical or not, and all roots may be real.

    In the latter case, the position of the center of mass is assigned and a further point

    of the end-effector is required to lie on a known plane (IGP with assigned position).

    The problem was solved by exact-arithmetic procedures based on Groebner-basis

    computation. In this case, at the most 32 solutions (and a corresponding univariate

    polynomial) were obtained. By the algorithms developed in [1], a numerical exam-

    ple was found that proves that all potential solutions may be real.

    It is worth observing that all solution counts reported above refer to potential

    solutions of the problems at hand, since they do not take into account the con-

    straints imposed by the sign of cable tensions and the stability of equilibrium. Once

    such constraints are imposed and solutions are sifted, the number of feasible con-

  • 7/27/2019 chp-3A10.1007-2F978-94-007-4620-6_46.pdf

    8/8

    372 M. Carricato et al.

    figurations reduces. When multiple feasible configurations exist, the EE may switch

    across them, due to inertia forces or external disturbances. Accordingly, the compu-

    tation of the entire set of equilibrium configurations is essential for robust trajectory

    planning. This motivates the relevance of the presented algorithms, even when they

    are not applicable to real-time computation (as for the IGP with assigned position).For real-time applications, these authors are exploring interval-analysis-based ap-

    proaches, in collaboration with Dr. Merlets team at INRIA.

    References

    1. Abbasnejad, G., Carricato, M.: Real solutions of the direct geometrico-static analysis of under-

    constrained cable-driven parallel robots with three cables. In: Proc. of AIMETA 2011, the 20th

    Congress of the Italian Association of Theoretical and Applied Mechanics, pp. 115. Bologna,

    Italy, (2011)

    2. Carricato, M., Merlet, J.P.: Geometrico-static analysis of under-constrained cable-driven par-

    allel robots. In: Lenarcic J., Stanisic M.M. (eds.) Advances in Robot Kinematics: Motion in

    Man and Machine, pp. 309319. Springer, Dordrecht (2010)

    3. Carricato, M., Merlet, J.P.: Direct geometrico-static problem of under-constrained cable-

    driven parallel robots with three cables. In: Proc. of the 2011 IEEE Int. Conf. on Robotics

    and Automation, pp. 30113017. Shanghai, China, (2011)

    4. Carricato, M., Merlet, J.P.: Inverse geometrico-static problem of under-constrained cable-

    driven parallel robots with three cables. In: Proc. of the 13th World Congress in Mechanism

    and Machine Science, pp. 110, Paper No. A7 283. Guanajuato, Mexico (2011)

    5. Dhingra, A.K., Almadi, A.N., Kohli, D.: A GrobnerSylvester hybrid method for closed-form

    displacement analysis of mechanisms. ASME J. Mech. Des. 122(4), 431438 (2000)

    6. Dietmaier, P.: The StewartGough platform of general geometry can have 40 real postures.

    In: Lenarcic J., Husty M.L. (eds.) Advances in Robot Kinematics: Analysis and Control, pp.

    716. Kluwer Academic Publishers, Dordrecht (1998)

    7. Fattah, A., Agrawal, S.K.: On the design of cable-suspended planar parallel robots. ASME J.

    Mech. Des. 127(5), 10211028 (2006)

    8. Faugere, J.C., Gianni, P., Lazard, D., Mora, T.: Efficient computation of zero-dimensional

    Grobner bases by change of ordering. J. Symb. Comput. 16(4), 329344 (1993)

    9. Jiang, Q., Kumar, V.: The direct kinematics of objects suspended from cables. In: Proc. of the

    ASME 2010 Int. Design Engineering Technical Conferences, pp. 110, Paper no. DETC2010

    28,036. Montreal, Canada, (2010)

    10. McCarthy, J.M.: 21st century kinematics: Synthesis, compliance, and tensegrity. ASME J.

    Mech. Robot. 3(2), 020201 (2011)

    11. Stetter, H.J.: Matrix eigenproblems are at the heart of polynomial system solving. ACM

    SIGSAM Bull. 30(4), 2225 (1996)