Aggregative Mechanics of Rigid Body Systems Eng

download Aggregative Mechanics of Rigid Body Systems Eng

of 50

Transcript of Aggregative Mechanics of Rigid Body Systems Eng

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    1/121

     

    Aggregative mechanics of rigid body

    systems

    V.A. Konoplev

    Sankt-Petersburg

    1996 

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    2/121

    Contents

    Preface ix

    1 Kinematics of multibody systems 11.1 Linear space of equipollent systems of line vectors . . . . . . . 1

    1.1.1 Equation of the kinematics on the group  Lt(R, 6) . . . 101.2 Graph of a tree-like multibody system . . . . . . . . . . . . . . 13

    1.2.1 Examples of multibody systems . . . . . . . . . . . . . . 171.3 Kinematic equations of (µ, k − 1; lk)-th kinematic pair . . . . . 22

    1.3.1 Examples of equations of kinematic pairs . . . . . . . . 251.4 Kinematics of Hooke-elastic pair . . . . . . . . . . . . . . . . . 271.5 Kinematic equations of  lk-th element . . . . . . . . . . . . . . . 29

    1.5.1 Examples of kinematic equations of kinematic pairs . . 301.6 Kinematic equations of a tree-like multibody system . . . . . . 33

    1.6.1 Examples of constructing configuration matrices . . . . 35

    1.6.2 Examples of kinematic equations of kinematic pairs . . 371.6.3 Examples for constructing parastrophic matrices . . . . 38

    2 Equations of motion for a multibody system 41

    2.1 Equations of motion of an element of a multibody system . . . 412.1.1 Equations of motion of an element of a system carry-

    ing dynamically non-balanced and asymmetric rotatingbodies . . . . . . . . . . . . . . . . . . . . . . . . . . . . 45

    2.1.2 Equations of motion of an element of a multibody sys-tem in inertial medium . . . . . . . . . . . . . . . . . . 46

    2.2 Equations of motion of a tree-like multibody system . . . . . . 472.2.1 Equations of motion of double pendulum . . . . . . . . 50

    2.3 Equations of Hooke-elastic body system motion . . . . . . . . . 53

    2.4 Eff ective forms of equations of multibody system motion . . . . 552.5 Determination of preplanned control with the help of forward

    and backward sweep methods . . . . . . . . . . . . . . . . . . . 66

    v

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    3/121

    vi   Chapter 1

    2.6 Algorithm for constructing equations of motion based on for-ward and backward sweep methods . . . . . . . . . . . . . . . . 69

    3 Analytic transvective forms of dynamic equations in the Cauchy

    form 753.1 Matrix realization of Gauss method . . . . . . . . . . . . . . . . 763.2 Analytic transvective forms of inertia matrix and its inverse . . 763.3 Analytical transvective Cauchy form of motion equations for a

    tree-like system . . . . . . . . . . . . . . . . . . . . . . . . . . . 793.4 Computer complexity of the algorithms . . . . . . . . . . . . . 80

    4 Diff erential equations of constraints of multibody systems

    with the external medium bodies 85

    4.1 State of the art . . . . . . . . . . . . . . . . . . . . . . . . . . . 854.2 Kinematics of pairs ‘the system bodies – the external medium

    ones’ . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 864.3 Diff erential equations of time-invariant constraints . . . . . . . 914.4 Diff erential equations of time-varying constraints . . . . . . . . 954.5 Diff erential equations of constraints of multibody systems with

    loops . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 99

    References 101

    Notation 105

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    4/121

    Preface

    The main theme of this book is  Computer-Aided Modeling  concerned withthe  Mechanics of Multibody Systems  branch of  General Mechanics . It bringstogether eff orts of specialists in the  field of mechanics and information scienceto solve the basic problem (see,  e.g., Gerdt et al.  1980, Grosheva et al.   1983,Klimov  et al.   1989):

    to develop theoretical foundations and applied issues of a new   field of the human knowledge based on bringing together (‘mutual diff usion’) me-chanics, in particular, the multibody system mechanics, and the branch of information science which is commonly named  Computer Algebra .

    The above-mentioned problem has been studied in two directions (see Wit-tenburg 1977, Medvedev et al.  1978, Gerdt  et al.  1980, Grosheva et al.   1983,Konoplev 1986a, Arais  et al.  1987, Velichenko 1988, Klimov  et al.   1989):

    −   the implementation of computer algebra methods in the classical mechan-ics with the aim of developing theoretical and software tools which are

    intended to replace the traditionally human work in deriving mechanicalsystems motion equations in Newton-Euler, Lagrange, Appel and Hamil-ton forms;

    −   the development of new mathematical formalisms in mechanics to pro-duce computer-aided algorithms suitable for the use of computer algebramethods and symbolic computation software.

    In recent time the trend has been toward bridging the gap between thesetwo approaches. The book contains the results of the development of a newcomputer-aided mathematical formalism of the multibody system mechanicswhich may be easily implemented with the use of computer algebra tools forsymbolic computations and of standard software for numerical ones.

    The efficiency of the represented formalism is determined by the following

    facts:−   The algorithms are universal in the sense that analytical and numerical

    forms of multibody system mechanical models are constructed indepen-

    ix

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    5/121

    x   Preface 

    dently of one another, i.e., these algorithms may be used for constructinganalytical and, independently, numerical forms of models bypassing thestage of constructing scalar equations.

    −   The algorithms provide the efficient solution of direct problems in the

    mechanics of multibody systems (with the help of the sweep method).−   There are many efficient recurrent procedures.

    −   There is no need to derive previously analytical forms of any particularfunctionals (such as Lagrangian, Hamiltonian), the Gauss function, theAppel function and so on.

    −   There is no need to exploit symbolic diff erentiating tools, since the al-gorithms contain no such diff erential operators as Christoff el symbols,three-indexed symbols of Boltzmann, the Jacoby matrix and so on. Alloperations are performed with the use of readily available algebraic tools.

    −   Where bodies of a system are linked with external bodies, there is no needto derive equations of holonomic and non-holonomic (time-invariant andtime-varying) constraints and computer calculation of the corresponding

    Jacoby matrix for these purposes. To this end, only the matrices whichare derived during the construction of motion equations are used.

    −   The method of indexing that is oriented to multibody systems with tree-like structure is developed.

    −   The methodology provides the possibility of taking into account the pres-ence of rotating bodies linked to bodies of a system in the case where thereverse linkage to carrier is absent, as well as the influence of an inertialmedium (e.g., water when the   flow is potential) by without significantloss of efficiency of algorithms.

    −   The derivation of Hooke-elastic multibody system motion equations isprovided.

    −   Methods of deriving an inertia matrix and its inverse in the form of mul-

    tiplication of simple matrices (transvective and diagonal) are proposed.−   A method of direct derivation of analytical forms of multibody system

    motion equations in the Cauchy form is developed without computing aninertia matrix and inverting it.

    −   Practically full parallel processing is provided.

    −   Work expenditure is minimized.

    The book is written on base of the author’s study of the problems knownas classical in mechanics and control theory. It is organized as follows. InChapter 1 we focus on some general issues that are very important in formingmathematical models in the multibody system mechanics. Many method-ologies for description of rigid multibody systems have been proposed in thepast. One of them is based on application of dual vectors and matrices in rigid

    body dynamics: in the last thirty years a growing number of investigationsconcerning this topic have appeared in the literature (see,  e.g., Angeles et al.1997). Dual vectors (screws) supply us with the description of a multibody

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    6/121

    Preface    xi

    system that does not suff er from singularities as in the case,   e.g., of Eulerangles. We present the results of our elaboration of a new mathematical for-malism of the multibody system kinematics which is based on the concept of a line vector (Brand 1947, Berezkin 1974). We avoid using the common ter-

    minology of screw theory (Dimentberg 1965, Murray et al.   1993, Selig 1996),as the essence of our approach appears as crucially diff erent and more sim-ple. In particular, equipollent systems of line vectors generate 6-dimensionallinear spaces of binary vectors with respect to various reduction centers. Af-ter introducing bases, we arrive at the coordinate space   R6   where a groupof motions such as translations and rotations defines isomorphism betweencoordinate representations of these spaces (Konoplev 1987a). This group actsmultiplicatively, as distinct from the analogous group of translations whichacts additively on R3. The multiplicative group of motions permits us to giveefficient tools for defining binary vectors in various frames (for an arbitrarynumber of intermediate motions). This fact is of importance as the maincontent of the multibody system kinematics and dynamics is in constructing

    twists and wrenches (kinematical, kinetic and dynamic binary vectors) as inan inertial frame of reference so in frames attached to system bodies.

    After introducing the operation of diff erentiating on the group of motions, weobtain an algebraic apparatus for calculating velocities and quasi-velocities of bodies. This permits us to keep the mathematical prerequisites to a minimumand to construct algebraic, physically pictorial models of multibody systemssuitable for computer implementation in symbolic and numerical forms.

    A multibody system consists of three levels: kinematical pairs, kinematicalchains of kinematical pairs, and the whole system of kinematic chains (Kono-plev 1986b,c). Preliminary studies have showed that the goal of mathematicalformalization of the multibody system mechanics and, in particular, of thekinematics, together with the efficient apparatus of corresponding computer

    calculations, may be achieved with the help of system analysis methodology(modular methodology) (Messarovich  et al.   1978, Konoplev 1986a).The methodology of system analysis is efficiently used where equations (ormodules in the corresponding terminology), describing the behavior of a sys-tem on each levels, may be derived from the analogous equations, representingits behavior on the previous level. In such cases, the equations, describing thebehavior of the whole system, appear to be comprised of equations (modules)of previous levels. If there exists an algorithm of module construction for thelowest level system, which possesses an efficient computer implementation,then it turns out that the computer implementation of equation constructionfor the whole system is more efficient then any other algorithm.

    Kinematical equations of a kinematical pair, a kinematical chain and the

    whole system on the   first, second and third levels, respectively, are relationsbetween quasi-velocities and generalized velocities (redundant in the generalcase) and play role of the above-mentioned modules. The computer algorithm

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    7/121

    xii   Preface 

    of deriving the third level module from the  first level modules, i.e., kinematicalequations of the whole system, defines the graph of the system, which isrepresented by a two-line array of zeros and units.

    The apparatus of the theory developed in the chapter consists of kinematicalequations (kinematical modules) of all levels. The notion of a twist and thegroup of motions of binary vectors form the basis of this theory. We give thecorresponding algorithms in compact, geometrically and physically pictorialmatrix form readily implemental on a computer for symbolic and numericalcalculation. Of course, these equations are equivalent to known vector equa-tions, but, where the number of intermediate motions is greater than three orfour, the vector equations, being written in scalar form, are too cumbersome(Konoplev 1984, 1987a).

    At the end of the chapter, we introduce the parastrophic matrix of a multibodysystem. This matrix transforms generalized velocities into quasi-velocities of bodies, providing kinematical equations of the system. The parastrophic ma-trix is a basic mathematical element of the theory. It contains the information

    on the system kinematical structure, axes, mechanical and functional config-urations of the system. The parastrophic matrix undoes wrenches of internalreactions in any multibody system subjected to holonomic constraints andextracts control and friction forces, acting on mobility axes of the system.

    In Chapter 2, we present the development of the dynamics of multibody sys-tems. As in the case of the kinematics, the system analysis is taken as thebase of methodology: at   first, equations of motion of single rigid bodies inlinear space of quasi-velocities are derived (the   first-level dynamic modules)in the special matrix form, then equations of motion of kinematical chains(the second-level dynamic modules) and   finally equations of motion of thewhole system (the third-level dynamic modules) are obtained.We then derive equations of motion of a multibody system relative to gener-

    alized coordinates as a result of eliminating quasi-velocities from the dynamicmodule of the system with the use of kinematical equations (Konoplev 1989a,1990, Konoplev  et al.   1991).

    We obtain equations of motion for a single rigid body with dynamically un-balanced and asymmetric rotating  flywheels placed on it under conditions inwhich carrier motion has no influence on their rotation. The influence of aninertial external medium on system motion is taken into account (e.g., water,provided that the  flow is potential) (Konoplev 1987b and 1989b,c).

    Deriving dynamic equation of Hooke-elastic bodies motion and constructing(with its use) equations of ‘fast’ and ‘slow’ motions (taking into account cross-eff ects) are also considered in the   first part of Chapter 2 (Konoplev   et al.1991).

    The second part of Chapter 2 is devoted to the problem of work expendi-ture for the algorithms of constructing multibody system equations. Thequadratic, in the degree of freedom, algorithm for inertia matrix calculation

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    8/121

    Preface    xiii

    and two linear algorithms for the quadratic, in the generalized velocities terms,calculation are obtained. We propose efficient algorithms, yielding the solu-tion for the so called inverse problem of the multibody system dynamics,which consists in the calculation of reactions between bodies of the system

    and control inputs in joints, given values of generalized coordinates and veloc-ities. The labor content for each of the algorithms presented is estimated forthe symbolic and numerical forms. To illustrate algorithms implementation,motion equations for a double pendulum with a sliding hanger are derived inthe symbolic form.

    The theoretical results presented in the chapter are illustrated by numerousfully considered examples, such as a gyroscope on an inclined base, a  flywheelinstalled on a rigid body, a double pendulum with a sliding hanger, a ma-nipulator, a walking machine, and a test bench (Okhotsimsky   et al.   1984,Konoplev 1989, Konoplev  et al.   1989, 1992a, Belkov 1992). We have studiedthe above-mentioned mechanisms using computer simulation at the requestof industrial  firms.

    Thus, because the equations of multibody system motion, introduced in Chap-ter 2, contain only constant inertia matrices and the parastrophic matrix, thedefinition of the latter immediately leads to construction of kinematical equa-tions and motion equations (Konoplev 1989a, 1990, Konoplev et al.  1991).

    In Chapter 3, we continue to study the problem of reducing the labor contentfor algorithms of motion equation derivation. It is known (Gantmacher 1964,Suprunenko 1972, Skornyakov 1980 and 1983) that the general linear grouphas the system of generators (transvective and diagonal matrices). Here wegive two algorithms for deriving an inertia matrix and its inverse in the formof multiplications of the above-mentioned simplest matrices. This permitsus to bypass constructing an inertia matrix and to define the symbolic andnumerical forms of its inverse immediately. As a result, we derive the motion

    equations of a multibody system at once in the Cauchy form (Konoplev 1994,1995).

    Estimating the labor content for algorithms for symbolic and numerical formsof matrix representation we see that one of them is the most efficient algorithmwhen the system degree of freedom is greater than 27-30.

    In Chapter 4, a new efficient method for constructing diff erential equations of holonomic and non-holonomic, time-invariant and time-varying constraints isdeveloped. It is customary to derive the above-mentioned equations in twostages. First, equations of constraints are written and then the Jacoby matrixof holonomic constraints is derived (Nikulin   et al.   1983). With the use of this matrix and that of linear non-holonomic constraints, diff erential equa-tions of constraints are constructed. These equations are used for eliminating

    Lagrange multipliers from redundant equations of motion. If there are manyconstraints and the system degree of freedom is great, the construction of these matrices is tedious. We propose a new, in essence, approach to solv-

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    9/121

    xiv   Preface 

    ing this problem. The above-mentioned sequence of operations is replacedwith the inverse one. It turns out that the modular technology of construct-ing multibody system motion equations permits us to derive reaction vectorsof external bodies incidentally during construction of motion equations, in

    particular, when determining the parastrophic matrix of the system. It onlyremains to write diff erential equations of constraints with the use of this ma-trix. Thus the problem of cumbersome analytical construction of constraintequations, as well as the Jacoby matrix computation of each step of numericalintegration of motion equations, is completely removed (Konoplev 1989b and1992).

    With the help of this methodology, an algorithm for constructing motionequations for a multibody system with internal chain-loops is elaborated.

    The book does not review the literature. There are two reasons for this. In thefirst place, it is impossible to do this in full measure, since the list of relevantpublications is enormous and the number of books and papers on multibodysystem mechanics is steadily growing. Secondly, the results connected with

    mechanical modeling (the aggregative mechanics) given here does not relyon any works known to the authors. Nevertheless, it is necessary to list theauthors (additional to the above-mentioned Wittenburg 1977, Medvedev   et al.   1978, Gerdt  et al.   1980, Grosheva   et al.   1983, Konoplev 1986a, Araiset al.   1987, Velichenko 1988, Klimov   et al.   1989), whose works are uncon-ventional: V.V. Akselrod, A.V. Bansh’ikov, L.A. Burlakova, A.B. Byachkov,L. Chang, M.A. Chubarov, Yu.N. Chelnokov, A.I. Filaretov, F. Freudenstein,H.P. Frisch, A.S. Gorobtsov, T.J. Haug, J.M. Hollrbach, R.L. Huston, R.S.Hwang, V.D. Irtegov, T.R. Kane, A.I. Korzun, G.P. Kulvetis, V.A. Kutergin,E.E. Lavendel, C.S.G. Lee, V.V. Malanin, D. Orin, B. Paul, W. Schiehlen,L.I. Shtejnwolf, A.M. Shulgin, M.W. Walker, O. Wallrapp, P.Y. Willems, J.T.Wang, L. Wang, L. Woo, A.T. Zaremba, among others (we apologize to those

    whom we omit to mention).The main part of the book is based on lectures that the author has been givingon elective special courses in two departments of the Baltic State TechnicalUniversity (St Petersburg).

    The present volume may successfully be used as an introduction to the me-chanics of rigid bodies, it is distinct, however, in that the   flavor is decidedlyone of applied mathematics. It also covers details of various extensions of the theory and recent research results in mechanics. Readers’ familiarity withreal vectors and matrices, with systems of ordinary diff erential and diff erenceequations and with basics of real, complex and functional analysis is presup-posed.

    The book will appeal to a wide circle of specialists, including professional

    mathematicians interested in modern mathematical formalization of mechan-ics, as well as mechanical engineers, graduates and post-graduate students.They will be able to   find numerous efficient algorithms for solving actual

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    10/121

    Preface    xv

    problems in the  field of multibody systems, detailed explanations and exam-ples.

    The authors thank Academicians of the Russian Academy of Sciences D.M.Klimov, D.E. Okhotsimsky and Corresponding Member V.F. Juravlev forrepeated critical discussions on the aggregative mechanics issues, and Prof.Yu.F. Golubev and Prof. A.P. Makreev for the support given at decisivemoments for the future of computer-aided methods described in the book.

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    11/121

    xvi

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    12/121

    Chapter 1

    Kinematics of multibody systems

    1.1. Linear space of equipollent systems of line vectors

    It is well known that a system of forces acting on a rigid body generates thesum and the total moment considered with respect of a certain point calledthe center of reduction. Treating the sum and the moment as an aggregate of two free vectors we may say about a so called binary vector. This notion isvery near to that of a dual vector or screw (Dimentberg 1965, Murray  et al.1993, Selig 1996, Angeles 1997) being in the base of analytical theory of screws(screw theory). However the diff erence existing between these notions leads tothat our theory diff ers from screw theory in the same degree as real analysison R2 from complex analysis. In particular, introducing specific notions of theconventional calculus of screws (such as a principal axis, a spiral products, alinear complex, a spiral affinor, analytical functions of dual vectors and so on)is not be necessary, as we need only the main object of the multibody systemkinematics: a multiplicative group of motions (translations and rotations) in

    the linear space  R6  defining isomorphism between coordinate representationsof binary vector spaces. In a rather natural way, this yields us very convenientcomputer-aided tools for using equipollent systems of line vectors.

    Vectorial objects 

    Physical magnitudes characterized with the help of one real number are calledscalars. We may easy give examples of scalars: time, angle, length, volume,electrical resistance, mass, work,   etc . Some of them can be supplied withsign but it is not essential. On the other hand there are many magnitudessuch that their description cannot be introduced by means of one number.Magnitudes such as velocity, acceleration and force are called vectorial. Inthe simplest case a vector is introduced as a line segment in which the initialpoint is distinguished from the terminal one, the former being also called apoint of application. Points are classified as zero vectors.

    1

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    13/121

    2   Chapter 1

    There are various categories of vectors. A vector of the   first category – abounded vector – is given above with  fixing its initial and terminal points.This way of (affine) definition does not use the notion of length. With thehelp of some metric a bounded vector can be characterized by the following

    elements:

    −   an initial point;−   a direction;−   a length (norm).

    The classical example of bounded vectors can be vectors of some physical  field,e.g., the Earth’s gravitational one.

    A vector of the second category – a line vector – is defined by the fol-lowing elements:

    −   a straight line along which this vector is directed;−   a sense;−   a length (norm).

    In other words, a line vector is defined as a class of equivalence: the set of bounded vectors having the same line of action, sense and length. The usualmechanical example of a line vector is force: it is characterized by its value,the line of action and sense while its point of application is arbitrary on thisline (see the axioms of statics in the Introduction).

    At last, a vector of the third category – a free vector – is given by thefollowing elements:

    −   a direction;−   a length (norm).

    In other words, any free vector is defined as a class of equivalence: the setof bounded vectors having the same direction, sense and length. The classicmechanical example of a free vector is translation of a rigid body from onestate into another: its points are replaced in the same direction and at thesame distance, i.e., it is characterized by its value and the line of action whileits point of application is not of importance.

    In every separate case of using vectorial objects their category must be estab-lished.

    Systems of line vectors 

    From the mathematical point of view such variety of vectorial objects forcesus to work out specific rules in order to handle with them. We assume thatthe fundamentals of geometrical theory of free and line vectors is known (see,e.g., Berezkin 1974). In particular, free vectors submit to the linear space

    axiomatics (it is assumed to be known). Any three linear independent vectorscan be used as a basis for introducing a coordinate space that permits us tomake a step from geometry ideas to algebraic ones. With  fixing of a certain

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    14/121

    Kinematics of multibody systems    3

    origin we may introduce the corresponding frame and treat bounded vectorsas diff erence between radius vectors of their initial and terminal points.

    However this mathematical apparatus gives nothing for line vectors as, ingeneral, we have no idea what sum of two line vectors is. At the same timeit is easy to see that any force system satisfies to the linear space axioms(recall that, in the multibody system mechanics, any force is a line vector):we may stretch or shrink all vectors of any system with the help of a certainreal multiplier  α  and form the union (or diff erence) of any two systems.

    Let  Λ  be the set of all line vectors. Consider two systems hα =  {λk  ⊂ Λ, k ∈K(α)}  and  hβ   = {λk  ⊂ Λ, k  ∈ K(β )}  of line vectors where  K(α) and  K(β )are some sets of naturales.

    Definition 1.1  The systems   hα   and   hβ,   K(α)  6=   K(β ), of line vectors are said to be equipollent 

    hα  ∼ hβ

    if they determine the same sum   x   and total moment   µ   (with respect to the same point of reduction).

    The pair of vectors x  and  µ  can be used for constructing various models of theclass of equipollent systems.   E.g., in the conventional calculus of screws, thispair defines a so called dual vector or screw  x + ωµ where  ω  is such operatorthat  ω2 = 0 (Dimentberg 1965, Angeles 1997). Below a simpler computer-aided model is constructed (we do not aim to discuss here screw calculus aswe wish to keep the mathematical prerequisites to a minimum).

    Notation 1.1   Henceforth 

    −  D3   is  3-dimensional space of points and   V3   is  3-dimensional space of  free vectors associated with it;

    −   a given line vector   λ  ∈  Λ, x  ∈   V3   is the free vector having the same length, direction and sense as  λ;−  a given  a ∈ D3,   lxa  is the action line of  λ (i.e., the straight line passing through the point  a   in parallel to the vector  x), xa   is the bounded vector generated by reducing  x  to the point  a;−  a point O σ  ∈ D3  is chosen as a so called center of reduction;

    −   (−−−→O σ, a) is the bounded vector with the terminal point  a  (here it is possible 

    that  a =  O σ);−   raσ   is the free vector with the same length, direction and sense as 

    (−−−→O σ, a).

    Define the moment (free vector) of  xa  with respect to  O σ

    µxaσ  = raσ × x   (1.1)

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    15/121

    4   Chapter 1

    where the symbol   ×   means the vector product of free vectors.

    As a line vector is defined as the class of equivalence for bounded vectors beingsituated on the corresponding straight line, we may reduce the free vector  xto any point  l ∈ lx

    a. It is well known that its moment (with respect to  O σ) is

    equal to  µxaσ,  i.e.,

    rlσ × x =  µxaσ   (1.2)

    where rlσ is the free vector with the same length, direction and sense as (−−→O σ, l).

    This fact does not depend on choosing   l  ∈   lxa.  That is why we have reasonsthe free vectors  x  and  µxaσ  to be used for describing the line vector  λ   (beingsituated on the line   lxa  of action).

    Thus we see that line vectors can be also defined as a class of equivalence forbounded vectors having the same line of action, sense, length and the samemoment with respect of any point (Dimentberg 1965).

    Definition 1.2  We shall say that a line vector  λ   is reduced to the center O σ

    if the aggregate (the ordered couple of Pl¨ ucker vectors)

    lxaσ  = col {x, µxaσ}   (1.3)

    is computed.

    We defined   lxaσ  as an element of the Cartesian product of   V3 × V3  (while itbelongs to  V3  +̇V3, too) as later on we shall use other elements of  V3 × V3.

    Proposition 1.1  The set of aggregates is not a linear space.

    Proof    Indeed, consider a free vector y  ∈  V3  and take two points  a  and  bsuch that  µyaσ   6=  µ

    ybσ. Then there are two aggregates (generated by the free

    vectors   y   and  −y   with the parallel action lines   lya   and   l−yb   ) such that their

    sum is col {y − y, µyaσ − µy

    bσ}  where the   first component is equal zero, and

    the second component is not equal zero. But according to relation (1.1) it isimpossible (the second component must be equal zero, too). Thus this sumis no aggregate.   2

    Consider the set  Λ   of all lines vectors and construct the corresponding setof aggregates (with respect to the given center   O σ). Due to the fact thatµxaσ  = µ

    xlσ   for any l ∈ l

    xa, for the sake of brevity we shall often omit the index

    a  in the notation of aggregates and their line of action.

    Definition 1.3   Let   hα   =  {λk  ⊂  Λ, k  ∈   K(α)}   be a system of line vectors where  K(α)   is some set of naturales. Then the sum 

    hσα  = Xk∈K(α)

    lxσk   (1.4)

    (of the aggregates de  fi ned with respect to the given center O σ) is called a binary vector.

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    16/121

    Kinematics of multibody systems    5

    In particular, a binary vector is an aggregate if the aggregates composing thisvector have action lines intersecting each other in one point   a:   lxaσ  +  l

    yaσ   =

    col {x +  y, raσ  × (x +  y)}  =   lx+yaσ   as the set of aggregates with action lines,

    intersecting each other in one point, is a linear space.

    Proposition 1.2  The set   Hσ  of all binary vectors is a  6-dimensional linear space.

    Proof    The amount of all sums of aggregates,   i.e.,  binary vectors, is a sumof aggregates,   i.e.,  a binary vector, too. As to the set dimension it is easy tochoose six (orthonormal) vectors being its basic ones.   2

    Thus we may treat any aggregate as a special case of the binary vector gen-erated by one line vector.

    Proposition 1.3  The set  H  of equipollent systems of line vectors is isomor-phic to the linear space  Hσ.

    Let us   finish this section with pointing out the simplest system in a givenequipollent system of line vector. This question is of importance in mechan-ics. In order to give the answer we define the following binary vectors andaggregates.

    Definition 1.4  Let us take a free vector  x  ∈  V3  and two arbitrary points  aand  b ∈ D3  such that  µxaσ  6= µ

    xbσ. Then the binary vector  hσ  being sum of two

    aggregates   lxaσ   and   l−xbσ   (with respect to the same reduction center O σ  ∈  D3)

    is called a couple, and the distance  h  between the lines   lxa   and   lxb   is called the 

    couple arm.

    It is easy to see that

    hσ  = col {03, rab × x}

    where rab is the free vector with the same length, direction and sense as (−→b, a);

    the symbol 03   means 3-dimensional (free or coordinate) null vector.Note that a couple is invariant with respect to the choice of a reduction center,as it is generated by the free vector x ∈ V3 and depends on the arm of couple.

    Definition 1.5  An aggregate and a binary vector de  fi ned by 

    lxσ  = col {x, 03}, hσα  = col {X

    k∈K(α)

    xk,  03}, x 6= 0,X

    xk 6= 0

    are called degenerate.

    Note that

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    17/121

    6   Chapter 1

    −   an aggregate lxσ  is degenerate if its line of action goes through the centerO σ   ∈   D3,   i.e.,   the degeneration property depends on the reductioncenter;

    −   it is not necessary for a degenerate binary vector to be always a sum of 

    degenerate aggregates.Let us present the binary vector (1.4) in the form

    hσα  = col {h(1), h(2)σ   } = col {h

    (1), 03} + col {03, h(2)σ   }

    where  first component  h(1) ∈ V3  is called the sum of the system (or the sum

    of the vectors   xk), and the second component  h(2)σ   ∈   V3   is called the total

    moment with respect to the center  O σ.

    It is easy to see that the inner product (h(1), h(2)σ   ) does not depend on the

    point of reduction. With its help we state the following assertion (see, e.g.,Banach 1951, Berezkin 1974).

    Proposition 1.4  Depending on whether the inner product  (h(1), h(2)σ   )  is dif-

     ferent from zero or equal to zero, every  α-system of line vectors is equipollent to one of the systems:

    −  the aggregate  col {h(1), 03}  and a couple having the moment  h(2)σ   ;

    −  two (skew) aggregates such that one of them has the action line passing through the center O σ;−  one aggregate;−   the zero vector.

    In general, one must not suppose that the simplest system is unique. For thesake of simplicity, classes of equipollent systems of line vectors are usuallyidentified with their simplest representatives.

    Group of motions 

    Relation (1.1) can be used in order to define the two-parametric set of linearoperators M σa   : V3  → V3  acting by the law

    µxaσ  = M σa x   (1.5)

    i.e.,   for any vector   x  ∈   V3, we have the free vector   µxaσ  being equal to the

    moment of   x   reduced to the point  a  with respect to the center  O σ   (see theindices of  µxaσ). Thus the aggregate (1.3) assumes the form

    l

    x

    aσ  =·   I 

    M σa¸

    x   (1.6)

    where I  is the identity operator in  V3.

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    18/121

    Kinematics of multibody systems    7

    Choosing diff erent reduction centers, we may define diff erent operators gener-ating the (1.6)-kind aggregates and the corresponding linear spaces of binaryvectors.Let us consider two linear spaces Hσ  and Hτ  of binary vectors that generated

    with respect to points  O σ   and  O τ   ∈   D3, respectively. It is easy to see thatthese spaces are isomorphic, i.e., there is the biunique correspondence definedby the linear operator

    T στ    =

    ·  I OM στ    I 

    ¸  (1.7)

    acting from  Hτ   to   Hσ  (here the operator  M στ    is defined as in relation (1.5);

    O  is the null operator in  V3).It is clear that after introducing bases in  Hσ  and Hτ  we may give the coordi-nate representation of operator (1.7) in the space  R6  (it is clear that all thesespaces are isomorphic).

    Notation 1.2   Henceforth 

    −   eσ = {eσ1 , eσ2 , e

    σ3}  is an orthonormal basis in   V3;

    −  a reduction center O σ   ∈   D3   is chosen as the origin of the Cartesian  frame  Eσ  = (O σ,  e

    σ);−   the basis vectors of   Eσ   generate the coordinate space   R3   and the fol-lowing vectorial matrix 

    keσk =  keσ1   | eσ2   | e

    σ3k   (1.8)

    i.e., the matrix with entries being vectors (coordinate columns);−   xσ = col {xσ1 , x

    σ2 , x

    σ3} ∈ R3 is the column of coordinates of any  x ∈ V3,

    i.e.,  x =  keσk  xσ;−  the cap over the coordinate column, e.g., xσ means the passage from  xσ

    to the following skew-symmetric matrix 

    x̂σ =

    0   −xσ3   xσ2

    xσ3   0   −xσ1

    −xσ2   xσ1   0

      (1.9)

    Proposition 1.5   (Konoplev 1987a)  Let an aggregate   lxaσ  be de  fi ned (with re-spect to the reduction center O σ   ∈   D3   with the help of a certain free vector x ∈ V3  reduced to some point  a ∈ D3). Then there is the following coordinate representation of   lxaσ   in  R6

    lxσaσ  = Gσa x

    σ (1.10)

    where 

    Gσa  =

    ·  E M σσa

    ¸, M σσa   = r̂

    σaσ   (1.11)

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    19/121

    8   Chapter 1

    rσaσ   ∈   R3   is the coordinate column (see the outer superscript) of the radius 

    vector   (−−−→O σ, a)   in the frame   Eσ   (see the superscript);  E   is  3 × 3-dimensional 

    identity matrix (see also  Berezkin 1974).

    Introduce a new Cartesian frame  Eτ   = (O τ ,  eτ ) with some orthonormal basis

    eτ . We may always define the rotation matrix  cστ   such that

    keτ k =  keσk  cστ , xσ = cστ x

    τ  (1.12)

    (xτ  ∈ R3  is the column of coordinates of  x  in the basis  eτ ;  | det cστ | = 1).

    Notation 1.3   Henceforth 

    −   oστ    ∈   V3   is a vector of translation of   Eτ    (see the subscript) to   Eσ(see the superscript),   oσστ    is its coordinate column in   e

    σ (see the outer superscript), and    ôσστ    is the skew-symmetric matrix induced by  o

    σστ    (see 

    notation (1.9));

    −   Hσσ  and  Hτ τ  are the coordinate representations of  Hσ  and  Hτ   generated by the bases  eσ and  eτ , respectively.

    Proposition 1.6  (Konoplev 1987a and 1989a,b) The isomorphism  Lστ   : Hτ τ  →

    Hσσ   (= Lστ H

    τ τ ) is de  fi ned by the following matrix 

    Lστ   = T σστ    C 

    στ    (1.13)

    where 

    T σστ    =

    ·  E Oôσστ    E 

    ¸, C στ  = diag {c

    στ , c

    στ }   (1.14)

    are matrices of translation and rotation (induced by the translation with the vector  oστ  and the rotation  c

    στ ), respectively; O  is  3×3-dimensional null matrix.

    Proof    Suppose lxτ τ k  = Gτ τ  x

    τ k  is the coordinate representation of an aggregate

    from relation (1.4). Then (see also relations (1.10) and (1.11))

    Lστ  lxτ τ k  = L

    στ G

    τ τ  x

    τ k   =   T 

    σστ    C 

    στ  G

    τ τ  x

    τ k  = T 

    σστ    C 

    στ  G

    τ τ c

    σ,T τ    c

    στ x

    τ k =

    T σστ    Gστ  x

    σk  = G

    σσ x

    σk  = l

    xσσk

    Taking in account that  Lστ   is a linear operator and going in the both sides of this equality to sums of the (1.4)-kind, we easily obtain the desired result.   2

    From the foregoing proposition follows at once that the next assertion holds.

    Proposition 1.7  The linear operator  T στ    :  Hτ → Hσ  has the coordinate rep-resentation  T σστ    in the basis   e

    σ.

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    20/121

    Kinematics of multibody systems    9

    Proposition 1.8   The set of all motions  Lστ   :   Hτ τ  → H

    σσ   is the multiplicative 

    group

    L(R, 6) =  {Lστ   : Lστ   = T 

    σστ    C 

    στ }   (1.15)

    where  σ   and  τ   parameters determining which points the system  Λ  of all line vectors is reduced to.

    Proof    It is true because  Lστ Lτ 

     p   = T σστ    C 

    στ  T 

    ττ  p   C 

    τ  p   = T 

    σστ    C 

    στ  T 

    ττ  p   C 

    σ,T τ    C 

    στ  C 

    τ  p   =

    T σστ    T τσ

     p   C σ

     p   =   T σσ

     p   C σ

     p   =   Lσ

     p   and (Lστ )−1 = (T σστ    C 

    στ  )−1 =   C σ,T τ    (T 

    σστ    )

    −1 =

    C τ σT τσσ   C 

    τ ,T σ   C 

    τ σ  = T 

    ττ σ   C 

    τ σ  = L

    τ σ  ∈ L(R, 6).   2

    Remark 1.1  We may treat two objects to be equivalent if there is an Euclid-ean motion transforming one of them into another (Sternberg 1964). It means that the set of all spaces of binary vectors can be considered as the class of equivalence de  fi ning an ‘abstract’ binary vector for a given system of line vec-

    tors. In this sense we may say about computation of a binary vector at a certain point or about its transform from one point at another.

    In the multibody system mechanics, we may treat any instantaneous complexmotion as a screw motion along a certain line (this line is a so called screwaxis) (see, e.g., Banach 1951). This case is characterized by the property thatthe  first component of some binary vector

    hτα = col {h(1), h(2)τ    }

    is parallel to the second one. If this is not the case we may always to choosea new reduction center  O σ   such that

    col {h(1), ph(1)} =  T στ 

     col {h(1), h(2)τ 

      }   (1.16)

    where p  is some real number which we shall define below.Indeed, from relation (1.16) follows that there is the relation

     ph(1) = oστ  × h(1) +  h(2)τ 

    Using the inner product between this vector and  h(1) we have

     p =  (h(1), h

    (2)τ    )

    (h(1), h(1))

    On the other hand, the vector product between   ph(1) and  h(2)τ    yields

    oστ   = h(1) × h

    (2)τ 

    (h(1), h(1))

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    21/121

    10   Chapter 1

    Proposition 1.9  (Dimentberg 1965) The set of all reduction points O σ  such 

    that the vector  h(2)σ   is parallel to h(1) is the straight line given by 

    o

    σ

    τ   =

      h(1) × h(2)τ 

    (h(1), h(1)) + s h

    (1)

    where  s   is a scalar parameter.

    1.1.1.  Equation of the kinematics on the group   Lt(R, 6)

    In general, we shall distinguish two kinds of instantaneous motion of frames:translation and rotation. Let a matrix   cστ    =   c

    στ (t) define the rotation of 

    the basis  eτ  with respect to the immobile basis  eσ considered in the basis  eσ

    (| det cστ | = 1) (see (1.8) and (1.12)). Denote by  Rt  ⊂ R3 the one-dimensionalsubspace generated by the unit (time-varying) eigenvector corresponding tothe real (time-invariant) eigenvalue of the matrix   cστ . It is clear that the

    origin  O τ  of the rotating frame   Eτ   is on   Rt. Let   P   be the two-dimensionalsubspace being orthogonal to  Rt  and passing through the point  O τ . Suppose

    aτ  = (−−−→O τ , a) is the radius vector of  a ∈ P. Let us also denote by aτσ and aττ 

    the coordinate columns of  aτ  in the bases   eσ and   eτ  of the immovable androtating frames, respectively. Then from aτσ = cστ a

    ττ  follows that (see (1.12))

    aτσ. = cσ.τ  aττ  = cσ.τ  c

    σ,T τ    a

    τσ (1.17)

    where (recall) we use convention (0.2) for any diff erentiable function c  =  c(t).

    Diff erentiating the relation  cσ,T τ    cστ   =  E  we have  c

    σ,T τ    c

    σ.τ    =  −(c

    σ.τ  )

    T cστ . Hencecσ,T τ    c

    σ.τ    =   −((c

    σ,T.τ    c

    στ )

    T )T  =   −(cσ,T τ    cσ.τ  )

    T ,   i.e.,   the matrix   cσ.τ  cσ,T τ    is skew-

    symmetric. Therefore there exists a free vector   w   =   wστ    =   keσk   wσστ    =

    keτ k wστ τ    such that

    ŵσστ    = cσ.τ  c

    σ,T τ    ,   ŵ

    στ τ    = c

    σ,T τ    c

    σ.τ    (1.18)

    where wσστ    and wστ τ    are the coordinate columns of  w

    στ  in the bases  e

    σ and  eτ ,respectively.

    It is easy to see that the vector  wστ   defines the instantaneous angular velocityof the basis   eτ  with respect to the basis  eσ whereas the left-hand side of re-lation (1.17) is the coordinate representation of the instantaneous translationvelocity of  a ∈ P.

    Note that the right-hand side of relation (1.17) is coordinate representationof the vector product

    vστ   = wστ  × a

    τ  (1.19)

    Thus geometrically we may determine the instantaneous angular velocity asa line vector with the line of action which is defined by the free vectors  wστ and  vστ  .

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    22/121

    Kinematics of multibody systems    11

    Let us consider the case where a couple of instantaneous angular velocities  wand  −w  defines the rotations of   Eσ and  Eτ , respectively. The origins of  Eσand  Eτ   are on the action lines of  w   and  −w. Let   P   be the two-dimensionalsubspace orthogonal to w . Suppose there are the points  aσ   and aτ   where the

    action lines of   w   and  −w   intersect with   P. Introduce the radius vector of a ∈ P:   aσ = (−−→aσ, a) and  a

    τ  = (−−→aτ , a).With the help of relation (1.19) we may compute the translation velocities ineach rotation

    vσ  =  w × aσ, vτ   = −w × a

    τ 

    and the full velocity of the point  a

    vσ + vτ   = w × (aσ − aτ )

    where the diff erence   aσ − aτ  depends only on the position of the axes of rotation as it is equal to (−−−→aσ, aτ ).

    Proposition 1.10   (Berezkin 1974)  Any couple of instantaneous rotation is equivalent to one instantaneous translation.

    Henceforth we shall suppose that the frame   Eτ   takes part only in instanta-neous rotational motions.

    Definition 1.6   Let   Lαi  =  {lwik, w

    στ k  ∈ V3, k  ∈ K(α)}  be a system of aggre-

    gates de  fi ning the instantaneous angular velocities of the basis  eτ  with respect to   eσ in the rotation of   Eτ   with respect to the   fi xed axes   l

    wk   (here the index 

    i =  σ  or  i  =  τ  points out the frame which the system of line vectors is reduced to). Then the sum 

    W στ i = Xk∈K(α)

    lwik   (1.20)

    is called the twist of motion of the frame  Eτ  (see the  fi rst subscript in (1.20))with respect to   Eσ  (see the superscript in (1.20)) reduced to the origin of   Ei(see the second subscript in (1.20)) (see  Angeles 1997).

    We may define twists in the same frame which origin corresponding systemsof line vectors is reduced to,  e.g.,  W στ i. When it is  Eτ , that is almost alwaysthe case, the notation becomes simpler:   W σττ   is replaced with   W 

    στ  . In this

    case the subindex from the coordinate notation has a double meaning beingin the same time the index of the moving frame and the index of the framewhich the twist is reduced to. Furthermore we shall use the general notationonly in the cases where an ambiguity could occur.

    Proposition 1.11  The second component of  W στ  is the instantaneous velocity vστ   ∈ V3   of translation of  Eτ  with respect to  Eσ   in the instant  t.

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    23/121

    12   Chapter 1

    Proof    Let cστ k  be the rotation matrices of  Eτ   with the  fixed axes lwk   and let

    Lατ   = {lwτ k, k  ∈  K(α)}  be the corresponding systems of aggregates. Due to

    relation (1.19) the second component of the aggregate  lwτ k is the instantaneousvelocity vστ k  ∈ V3 of translation of the point O τ  (the origin of Eτ  ) with respect

    to Eσ. Going to summation in (1.20), we obtain for the second component of W στ  :   v

    στ   =

     Pk∈K(α) v

    στ k, that proves our proposition.   2

    Due to the supposition concerning the participation of the frames only in in-stantaneous rotational motions, the following conclusions are a direct corollaryof the above proposition:

    −   the instantaneous translation velocity is a free vector   fixing the state of the axis of rotation of the frame;

    −   this velocity can be represented in the basis eτ  as a linear combination of coordinate columns of the instantaneous angular velocities with constantmatrix coefficients âττ k   : v

    στ τ    =

     Pk∈K(α) â

    ττ k   w

    στ τ k ;

    −   twist (1.20) can also be represented in the coordinate form (in  Eτ )

    W στ τ    =

    Xk∈K(α)

    lwτ τ k  = col {w

    στ τ    , v

    στ τ    }   (1.21)

    where wστ τ    = P

    k∈K(α) wστ τ k , v

    στ τ    =

     Pk∈K(α) v

    στ τ k .

    As the twist  W στ    defines the instantaneous rotation and translation, we maysay about the matrices T σστ    (t) and C 

    στ  (t) and the corresponding one-parameter

    group  Lt(R, 6) = {Lστ (t) :   Lστ (t) = T 

    σστ    (t)C 

    στ  (t), t ∈ R}. Now we shall state

    our main assertion.

    Proposition 1.12  (Konoplev 1987a and 1989a)  The equation of kinematics on the one-parameter group  Lt(R, 6)  has the following form 

    Lσ.τ    = Lστ Φ

    στ τ    ,   Φ

    στ τ    = ·  ŵ

    στ τ    O

    v̂στ 

    τ    ŵστ 

    τ ¸   (1.22)

    Proof    With a little algebra we have

    Lσ.τ    = (T σστ    C 

    στ  )

    · = T σσ.τ    C στ   + T 

    σστ    C 

    σ·τ    = (T 

    σσ.τ    + T 

    σστ    C 

    σ·τ   C 

    σ,T τ    )C 

    στ   =

    (T σσ.τ    + T σστ    [ ŵ

    σστ    ])C 

    στ   = T 

    σστ    (T 

    σσ.τ    + [ ŵ

    σστ    ])C 

    στ   =

    T σστ    C στ  C 

    σ,T τ    Φ

    σστ    C 

    στ   = T 

    σστ    C 

    στ Φ

    στ τ    = L

    στ Φ

    στ τ 

    where

    [ ŵσστ    ] = diag{ŵσστ    ,  ŵ

    σστ    }   (1.23)

    2

    Equation (1.22) permits us to introduce the operation of diff erentiation in var-ious spaces of binary vectors that can be easily realized numerically (Konoplev1987a).

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    24/121

    Kinematics of multibody systems    13

    Proposition 1.13  The di  ff erentiation operations in the (moving and immov-able) frames  Eτ   and   Eσ, respectively, are connected by the following relation 

    hσ.σ   = Lστ (h

    τ .τ   +Φ

    στ τ    h

    τ τ )

    where  hτ τ   ∈  Hτ τ   and  h

    σσ  ∈  H

    σσ   are the coordinate representations of a pair of 

    binary vectors generated by the same system of line vectors.

    Proof    From   hσσ   =   Lστ h

    τ τ   and relation (1.22) follows that   h

    σ.σ   =   L

    στ h

    τ .τ    +

    Lσ.τ  hτ τ   = L

    στ h

    τ .τ   + L

    στ Φ

    στ τ    h

    τ τ .   2

    Remark 1.2   In the case where the matrix   Φστ τ    is constant we may easily de  fi ne the exponential form of the rotation matrix 

    cστ  = exp{ŵσστ    t} =  w

    σστ    w

    σσ,T τ    + cos{t}(1−w

    σστ    w

    σσ,T τ    ) + sin{t}ŵ

    σστ 

    with using the properties of the skew-symmetrical matrix  ŵσστ    :

    ( ŵσστ    )2k+1 = (−1)kŵσστ    ,   (ŵσστ    )2k = (−1)k(1−wσστ    wσσ,T τ    )

    After that we may de  fi ne the other entries of the block-triangular matrix  Lστ as some polynomial of trigonometrical functions with the help of the Cauchy  formula (Bellman et al. 1963).

    1.2. Graph of a tree-like multibody system

    Let us consider a system of   n   rigid bodies   {Gk}, k   = 1, n,   and the corre-sponding graph which is defined with giving its elements (Fig. 1.1).Introduce the following notations and concepts (Konoplev 1984, 1985a, 1987aand 1989a,c).

    Notation 1.4   Henceforth 

    −   Ek  = (O k,  ek)   is a Cartesian frame with the origin O k  ∈ D3  and with 

    the basis   ek = {ek1, ek2, e

    k3}   in  V3;

    −   ak is the radius-vector of a point  a  of a rigid body  Gk, akk is the column 

    of its coordinates in the basis  ek;−   N  is a set of natural numbers.

    It is said that the frame   Ek   = (O k,  ek) is attached to the rigid body   Gk   if akk is constant.

    Notation 1.5   Henceforth  E lk   is  lk-th element of the graph where the index  lstands for the trunk of the tree, and the index  k  stands for the corresponding level,   l, k ∈ N  (see Fig. 1.1).

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    25/121

    14   Chapter 1

    Figure 1.1. Graph of a multibody system with tree-like structure

    Let us assume that the graph is oriented from the root   E 10  to its nodes bya sequence of indices   l   and   k,   l  being said to be the principal index in thissequence.

    Defi

    nition 1.7  We shall use the following sets of the graph elements:−   the set   (lk)+  of accessibility, i.e., all elements of the graph that can be reached from  E lk  by motion up along the tree (in the direction in which indices increase) ( E lk  ∈ (lk)+), for the tree-like graph this set is a subtree (with the root  (lk)) of the main tree;−  the set  (lk)−  of counter accessibility, i.e., all elements of the graph that can be reached from  E lk  by motion down along the tree (in the direction in which indices decrease), for the tree-like graph, the set of counter ac-cessibility is a kinematic chain, the  fi rst and last elements in this chain being  E 10   and  E lk, respectively ( E lk  ∈ (lk)−);−  the set  (lk)+ of right incidence of  E lk, i.e., of all elements of the graph that can be reached from  E lk  for one step up along the tree  (E lk   /∈ (lk)

    +);−   the set   (lk)− left incidence of   E lk, i.e., all elements of the graph that 

    can be reached from  E lk   for one step down along the tree  (E lk   /∈ (lk)−);−   two elements  E µ,k−1   and  E lk  are called  (µ, k − 1; lk)-th kinematic pair if  E lk  ∈ (µ, k− 1)

    +  for  µ ≤ l.

    We shall consider two variants of indexing the graph for a system of rigidbodies. In the  first way, the elements of the graph will be the frames takingparts in one of the simplest motions   Ek−1  →   Ek   (either translation with adirectional vector being one of the vectors from  ek−1, or rotation with a  fixedvector which is from the basis ek−1 again). In the second variant, the elementsof the graph will be rigid bodies taking parts in some of the simplest motionswith respect to the frames attached to them.

    According to the stated above, if indices mark the frames taking parts in

    one of the simplest motions, then the motion of an arbitrary kinematic pair(µ, k − 1; lk) is completely determined by the generalized coordinates   q lki   ∈R1, i   = 1, 6. Besides, if the motion   E µ,k−1   →   E lk   turns out to be the

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    26/121

    Kinematics of multibody systems    15

    translation oµ,k−1lk   :  O µ,k−1  → O lk  with the magnitude  olki   and the direction

    elki   ∈   elk when   q lki   =   o

    lki   , i   = 1, 3, and if the motion   E µ,k−1  →   E lk   turns

    to be the rotation   cµ,k−1lk   :   eµ,k−1 →   elk with a   fixed unit vector   elki−3   ∈

    elk and an angle   θlki   then   q lki   =   θ

    li   for   i   = 4, 6. One non-constant (later

    on we shall consider functional) motion in (µ, k  − 1; lk)-th kinematic pair(either translation   olki   , i   = 1, 3, or rotation with the angle   θ

    lki   , i   = 4, 6)

    can be preceded by several (from 0 to 6) constant (later on we shall considerconstructive) translations   plki   , i   = 1, 3 and rotations with angles   φ

    lki   , i   =

    4, 6. If indices stand for the corresponding rigid bodies, then motion of any(µ, k  − 1; lk)-th kinematic pair is determined by at least two and at mostsix generalized coordinates  q lk = col {q l1, q 

    l2, . . . , q  

    l6}, where  q 

    lki   are defined as

    above. The same is valid in the case of preliminary translations and rotations.

    For any (µ, k−1; lk)-th kinematic pair let us introduce an intermediate Carte-sian frame   Elkk   = (O lkk, elkk), obtained by translation of the frame   Eµ,k−1with the column of constructive translation  pµ,k−1lkk   ≡  p

    lkk ≡ col { plk1  , plk2  , p

    lk3  }

    and rotation of the basis   eµ,k−1 in the basis   elkk with the constructive an-

    gles  φlkα ,  φlkβ ,  φlkγ   , where  α,  β ,   γ   = 4, 6. When the indices of angles in onekinematic pair are the same, we shall replace the symbol  φ  with the sym-bol   ψ,  φlkα   =   ψ

    lkγ   , in the case of   α   =   γ . For example, (φ

    lk3  , φ

    lk2  , φ

    lk3  ) =

    (φlk3  ,φlk2  ,ψ

    lk3   ).

    Later, the frame   Elkk  = (O lkk,  elkk) will be called constructive for the kine-

    matic pair (µ, k  − 1; lk). The transition to the constructive frame   Elkk   isimposed not only by the presence of constructive motions in a direct (con-structive) sense but also by the change of frames in some interdisciplinaryproblems which arise due to the application of this technique. For example,in the study of motion of an airplane with respect to a ship, it is necessaryto introduce a transition from the ship frame to the plane one,   i.e . fromone console (the unit vector  e3  is directed in the same direction in which the

    cantilever is oriented) to another when the positions of the cantilevers can bearbitrary,  etc .

    Since the methods and algorithms which are to be developed here should berealized numerically by means of computers let us make our approach concern-ing functional and constructive motions in a given kinematic pair (µ, k−1; lk)more formal.

    Notation 1.6   Henceforth 

    −  the elements  E lk  of the graph are Cartesian frames  Elk which participate in several (from  0  to  6) constructive motions and in a functional motion (de  fi ned by the generalized coordinates  q lki   , i = 1, 6, where  q 

    lki   = o

    lki   , i =

    1, 3,  or  q lki   = θlki   , i = 4, 6) with respect to the constructive frame   Elkk;

    −   plk =  pµ,k−

    1;µ,k−

    1lkk   = col { plk1  , plk2   , plk3  }   is the coordinate column of con-structive translation   pµ,k−1lkk   of   Elkk   in   Eµ,k−1, represented in the basis eµ,k−1;

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    27/121

    16   Chapter 1

    −  φlk =  φµ,k−1lkk   = col {φlkα ,φ

    lkβ , φ

    lkγ  }   is the column of constructive angles 

    of orientation of the basis  elkk in the basis  eµ,k−1.

    Proposition 1.14   The relative position of the elements of   (µ, k  − 1; lk)-th 

    kinematic pair is determined by twelve functions, combined in two sextuples of functions 

    Rµ,k−1lk   = col {Rµ,k−1lkk   , R

    lkklk   }   (1.24)

    where 

    Rµ,k−1lkk   = col { pµ,k−1;µ,k−1lkk   ,  φ

    µ,k−1lkk   }   (1.25)

    can contain up to six functions (constants) di  ff erent from  0;

    Rlkklk   = col {0, . . . , 0, q lki   , 0, . . . , 0}   (1.26)

    can contain only one function di  ff erent from zero.

    Definition 1.8   The two sextuples of constants   Rµ,k−1lkk   and functions   Rlkklk

    generating (1.24) are called constructive and functional con  fi gurations of the kinematic pair  (µ, k − 1; lk), respectively.

    The union of all functional configurations corresponding to all kinematic pairs,usually are called a configuration of the system as usually.

    Let the elements   E lk  of the graph be rigid bodies   Glk   with the frames   Elkattached to them which take parts in some (from 0 to 6) of the constructiveand in some (from 2 to 6) of the functional motions (defined by the generalizedcoordinates q lki   , i = 1, 6, where q 

    lki   = o

    lki   , i = 1, 3, or q 

    lki   = θ

    lki   , i = 4, 6) with

    respect to Elkk.

    Notation 1.7   Henceforth 

    −   olk = col {olk1  , olk2  , o

    lk3  }   is the coordinate column of the free vector of 

     functional translations of  Elk   in the constructive frame  Elkk, olk ≡ olkklk   ;

    −   θlk = col {θlk4   , θlk5   , θ

    lk6  }  is the column of functional angles of orientation 

    of the basis  elk in the basis  elkk of the constructive frame  Elkk,   θlk ≡ θlkklk   .

    Proposition 1.15   The relative position of the elements of   (µ, k  − 1; lk)-th kinematic pair is de  fi ned by con  fi guration (1.24) where 

    Rµ,k−1lkk   = col { plk,  φlk}, Rlkklk   = col {o

    lk,  θ lk}   (1.27)

    the constructive con  fi guration   Rµ,k−1lkk   being able to have up to six constants 

    di  ff erent from  0, while the functional con  fi guration  Rlkklk   can have from  2  to  6 functions di  ff erent from  0  (for the case of only one generalized coordinate see (1.24)).

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    28/121

    Kinematics of multibody systems    17

    1.2.1.   Examples of multibody systems 

    Henceforth we use the notation  0  = (0, 0, 0) for 3-dimensional null row.

    Gyroscope on a tilted base 

    Mark with indices (see Fig. 1.2) frames taking parts in one of the simplestfunctional motions.

    Figure 1.2. Gyroscope on a tilted base and its graph

    Henceforth all mobility axes of the multibody system are assumed to be re-duced at the origin of motion. In the case under consideration there are

    R0

    1

      = col {R0

    1k

    , R1k

    1

      }, R0

    1k

     = (0, 0,φ1

    5

    ,φ1

    6

    )T , R1k

    1

      = (0, 0, θ1

    4

    , 0)T 

    R12   = col {R12k, R

    2k2   }, R

    12k  = 0, R

    2k2   = (0, 0, θ

    25, 0)

    R23   = col {R23k, R

    3k3   }, R

    23k  = 0, R

    3k3   = (0, 0, 0, θ

    36)

    Flywheel on ( lk)-body 

    For this example we have

    Rlks   = col {Rlksk, R

    sks   }, R

    lksk  = ( p

    s1, p

    s2, p

    s3,φ

    s4,φ

    s5, 0)

    T , Rsks   = (0, 0, 0, θs6)

    where ps = col { ps1, ps2, ps3}  is the constructive position column of the  flywheelin  Elk;   φ

    s4,   φ

    s5  are the constructive angles of the   flywheel orientation in   e

    lk;θs6   is the angle of the  flywheel rotation in  e

    sk (see Fig. 1.3).

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    29/121

    18   Chapter 1

    Figure 1.3. Flywheel on lk -th body

    Double pendulum with sliding hanger 

    Let us enumerate the frames which participate in the simplest motions, namely:E1,   E2,   E3   (we skip here the   first index   l  due to the uniqueness) (see Fig.1.4).The motion of the kinematic pairs (0, 1),   (1, 2) and (2, 3) is defined by thefunctional translation E2 with the magnitude o12 along the basic vector  e

    02 =  e

    12

    from the basis  e0 of the frame  E0 = (O 0, eo), by the functional rotation with

    the   fixed basic vectors   e12   =   e22   from the basis   e

    2 of   E2   with respect to   E1on the angle  θ25, and also by the constructive translation with the   fixed unitvectors  e21   =  e

    31  and by the functional rotation with the   fixed unit vector  e

    33

    from the basis   e3 of   E3   with respect to   E2  on the angle   θ36. So we obtain:

    q 12  = o12, q 

    25  = θ

    25, q 

    36  = θ

    36  , and the configuration of the system assumes the

    form

    R01   = col {R01k, R

    1k1   }, R

    01k  = 0, R

    1k1   = (0, o

    12, 0, 0)

    R12   = col {R12k, R

    2k2   }, R

    12k  = 0, R

    2k2   = (0, 0, θ

    25, 0)

    R23   = col {R23k, R

    3k3   }, R

    23k  = ( p

    31, 0, 0, 0)

    T , R3k3   = (0, 0, 0, θ36)

    The sets of accessibility and contour accessibility and the sets of left and rightincidence assume the form:

    (o)+   =   {E0, E1, E2, E3},   (1)+  =  {E1, E2, E3},   (2)+  =  {E2, E3}

    (3)+   =   {E3},  (o)− =  {E0},   (1)− =  {E0, E1}

    (2)−

      =   {E0, E1, E2},   (3)−

     =  {E0, E1, E2, E3}

    (o)+ =   {E1},   (1)

    + = {E2},   (2)+ = {E3},   (3)

    + = ∅

    (o)− =   ∅,   (1)− = {E0},   (2)− = {E1},   (3)

    − = {E2}

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    30/121

    Kinematics of multibody systems    19

    Re-numbering the rigid bodies of the system (Fig. 1.4), we get two kine-matic pairs (0, 1),   (1, 2) which motions are defined by the same general-ized coordinates as in the previous case, but in the slightly modified form:q 1 = col {o12, θ

    15}, q 

    26  = θ

    36.

    Figure 1.4. Double pendulum with sliding hanger

    The system configuration is again determined by the same four functions asin the previous case, but their form is modified

    R01   = col {R01k, R1k1   }, R01k = 0, R1k1   = (0, o12, 0, 0, θ25, 0)T 

    R12   = col {R12k, R

    2k2   }, R

    12k = ( p

    21, 0, 0, 0)

    T , R2k2   = (0, 0, 0, θ26)

    Manipulator 

    Manipulator is a technical system with many joints and 6-degrees of freedomrigid bodies (Fig. 1.5). After re-numbering the frames which participate inevery simplest motion, we obtain

    q 14  = θ14, q 

    25  = θ

    25, q 

    35  = θ

    35, q 

    44  = θ

    44, q 

    55  = θ

    55, q 

    66  = θ

    66

    Then the configuration of the system assumes the form (Konoplev 1986b,c,Zaremba et al.   1991)

    R01   = col {R01k, R

    1k1   }, R

    01k = ( p

    11,  0,  0,  0)

    T , R1k1   = (0,   θ14,  0,  0)

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    31/121

    20   Chapter 1

    R12   = col {R12k, R

    2k2   }, R

    11k  = 0, R

    1k2   = (0,  0,  θ

    25,  0)

    R23   = col {R23k, R

    3k3   }, R

    23k  = (0, p

    32,  0,  0)

    T , R3k3   = (0,  0,  θ35,  0)

    R34   = col {R34k, R

    4k4   }, R

    34k = (0, p

    42,  0,  0)

    T , R4k4   = (0,  θ44,  0,  0)

    R45   = col {R45k, R5k5   }, R45k = 0, R5k5   = (0,  0,  θ55,  0)T R56   = col {R

    56k, R

    6k6   }, R

    56k  = 0, R

    6k6   = (0,  0,  0,  θ

    66)

    Figure 1.5. Six-component manipulator

    Walking machine 

    The walking machine with the kinematic scheme given on Fig. 1.6 has 24excessive generalized coordinates.

    Figure 1.6. Walking machine

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    32/121

    Kinematics of multibody systems    21

    If the elements of the graph are the joints of this system, then the configurationof the system becomes

    R1011   = col {R1011k, R

    11k11   }, R

    1011k  = 0

    R11k11   = (o111   , o112   , o113   ,  θ114   ,  θ115   ,  θ116   )T 

    For the  i-th leg we have (i = 1, 6):

    R11i2   = col {R11i2k, R

    i2ki2   }, R

    i2i3 = col {R

    i2i3k, R

    i3ki3   }, R

    i3i4 = col {R

    i3i4k, R

    i4ki4   }

    R11i2k   = ( pi21 , p

    i22 , p

    i23  ,  0)

    T , Ri2ki2   = (0,  θi24   ,  0,  0)

    Ri2i3k   = ( pi31 , p

    i32 , p

    i33  ,  0)

    T , Ri3ki3   = (0,  0,  θi35   ,  0)

    Ri3i4k   = ( pi41 , p

    i42 , p

    i43  ,  0)

    T , Ri4ki4   = (0,  0,  θi45   ,  0)

    Test bench for imitating car motion 

    The test bench is constructed to imitate free motion of a given machine or asystem of machines in laboratory environment (Fig. 1.7).

    Figure 1.7. Test bench

    This system consists of 25 rigid bodies. It has 48 excessive generalized co-ordinates, which are restrained by 42 holonomic constraints. The test benchconstruction consists of one platform and 6 supports every of which involving

    4 bodies. Every support has 7 degrees of freedom. After numbering of theframes which participate in every simplest motion, (in contrast to the case of the double pendulum) there are configurations:

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    33/121

    22   Chapter 1

    - for the platform

    R1011   = col {R1011k, R

    11k11   }, R

    1011k  = 0, R

    11k11   = (o

    111   ,  0,  0,  0)

    R1112   = col {R1112k, R

    12k12   }, R

    1112k  = 0, R

    12k12   = (0, o

    122   ,  0,  0)

    R1213   = col {R1213k, R13k13   }, R1213k  = 0, R13k13   = (0,  0, o133   ,  0)T 

    R1314   = col {R1314k, R

    14k14   }, R

    1314k  = 0, R

    14k14   = (0,  θ

    144   ,  0,  0)

    R1415   = col {R1415k, R

    15k15   }, R

    1415k  = 0, R

    15k15   = (0,  0,  θ

    155   ,  0)

    R1516   = col {R1516k, R

    16k16   }, R

    1516k  = 0, R

    16k16   = (0,  0,  0,  θ

    166   )

    - for  i-th support (i = 1, 6)

    R16i7   = col {R16i7k, R

    i7ki7   }, R

    16i7k = ( p

    i71 , p

    i72  , p

    i73 ,  0)

    Ri7ki7   = (0,  θi74   ,  0,  0)

    T , Ri7i8 = col {Ri7i8k, R

    i8ki8   }, R

    i7i8k = 0

    R18ki8   = (0,  0,  0,  θi86  )

    T , Ri8i9 = col {Ri8i9k, R

    i9ki9   }, R

    i8i9k = (0, p

    i92 , 0, 0)

    Ri9ki9   = (0,  θi94   ,  0,  0)

    T , Ri9i10 = col {Ri9i10k, R

    i10ki10   }, R

    i9i10k  = 0

    Ri10ki10   = (0,  0,  θ

    i105   ,  0)

    , Ri10i11 = col {R

    i10i11k, R

    i11ki11   }, R

    i10i11k = 0

    Ri11ki11   = (0,  0,  0,  θi116   )

    T , Ri11i12 = col {Ri11i11k, R

    i11ki12   }

    Ri11i11k   = (0, pi122   ,  0,   0)

    T , Ri11ki12   = (0,  0,  0,  θi126   )

    Ri12i13   = col {Ri12i13k, R

    i13ki13   }, R

    i12i13k = (0, p

    i132   ,  0,  0)

    Ri13ki13   = (0, oi132   ,  0,  0)

    1.3. Kinematic equations of   (µ, k − 1; lk)-th kinematic pair

    Kinematic equations give the connection between the coordinates of twist of (µ, k− 1; lk)-th kinematic pair and the generalized coordinates and velocities

    of this pair. Let us begin with deriving the main kinematic equalities of thistheory (Gantmacher 1964, Diedonne 1972, Konoplev 1986b, Velichenko 1988).To establish them we need the following notion.

    Definition 1.9   Let   W στ    = col {wστ , v

    στ }  be the twist of motion of the frame 

    Eτ  with respect to   Eσ. Then the vector 

    V στ    = col {vστ , w

    στ }

    is called the quasi-velocity of   Eτ  with respect to  Eσ.

    Proposition 1.16   Let 

    −   Ek   take part in a motion with respect to   Es, and   E p   take part in a 

    motion with respect to   Ek;−   W sk , W k

     p , W s

     p  be the twists of the kinematic pairs  (Es,  Ek),   (Ek,   E p)and  (Es,   E p)  (see (1.20), (1.21)).

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    34/121

    Kinematics of multibody systems    23

    Then the following kinematic equalities hold 

    W sp p   = L pkW 

    skk   + W 

    kp p   , V 

    sp p   = L

    k,T  p   V 

    skk   + V 

    kp p   (1.28)

    where −   L pk  is a motion from group (1.15);−   W skk   , W 

    kp p   , W 

    sp p   and  V 

    skk   , V 

    kp p   , V 

    sp p   are the coordinate representations 

    of the twists and the corresponding quasi-velocities.

    Proof    1. After reducing all twists to  E p, we get that  W sp

     pp   =  W sp

    kp  + W kp

     pp .After that, to prove the  first equality it is enough to apply transform (1.13). 2.To prove the second equality, let us introduce 6×6-dimensional matrix ² whosemain diagonal is formed by two 3 × 3-dimensional null matrixes, and whosesecond diagonal is formed by two 3 × 3-dimensional identity matrixes. Since²² =  E : we get easily that  ²W sp p   = ²L

     pk²²W 

    skk   + ²W 

    kp p   where ²L

     pk² =  L

    k,T  p   .   2

    The term  main  emphasizes the fundamental meaning of equality (1.28): the

    deriving of the kinematic equations for subsystems of the basic system is doingwith its help.

    Proposition 1.17   (Konoplev 1984 and 1986b,c)  Let 

    −   the con  fi guration of the pair  (µ, k − 1; lk)   be given by relation (1.24);

    −   Lµ,k−1lk   =  Lµ,k−1lkk   L

    lkklk   be a transformation of the coordinate columns of 

    screws, generated by con  fi guration (1.24), where the transformation 

    Lµ,k−1lkk   = T µ,k−1

    lkk   C µ,k−1lkk

    is de  fi ned by the constructive con  fi guration 

    Rµ,k−1lkk   = col { pµ,k−1lkk   ,  φ

    µ,k−1lkk   }

     p

    µ,k−1

    lkk  ≡

      p

    µ,k−1;µ,k−1

    lk   ,  φ

    µ,k−1

    lkk  ≡

    φ

    µ,k−1

    lk

    and the transformation   Llkklk   =   T lkk

    lk   C lkklk   is induced by the functional 

    con  fi guration  Rlkklk   = col {0, . . . , 0, q lki   , 0, . . . , 0}:

    T µ,k−1lkk   =

    ·  E O

    ˆ pµ,k−1lkk   E 

    ¸, C µ,k−1lkk   = diag {c

    µ,k−1lkk   , c

    µ,k−1lkk   }

    cµ,k−1lkk   =   cα−3(φlkα )cβ−3(φ

    lkβ )cγ −3(φ

    lkγ  )

    ci−3(φlki   ) =   E  + ê

    lki−3 sinφ

    lki   + ê

    lki−3(1− cosφ

    lki   )

    2

    Llkklk   =

    ½  T lkklk   if    i = 1, 3C lkklk   otherwise

    T lkklk   =·   E O

    ôlkklk   E ¸

    , C lkklk   = diag {clkklk   , clkklk   }

    olkklk   = col {0, . . . 0, olki   , 0, . . . 0}, c

    lkklk   = ci(θ

    lki+3), i = 1, 3

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    35/121

    24   Chapter 1

    Then the kinematic equation of  (µ, k − 1; lk)-th kinematic pair is 

    V µ,k−1;lklk   = Rlkk.lk   = f 

    lki   q 

    lk.i   , q 

    lk.i   =

    ½  olk.i   if    i = 1, 3θlk.i   if    i = 4, 6

      (1.29)

    where  f lki   is  6-dimensional (unit) column such that its  i-th entry is equal to  1( i = 1, 6), the other ones are equal to zero.

    Proof    In order to simplify the proof let us re-number by the integers0, 1, . . . , 7 the frames that participate in every simplest constructive and func-tional motions of (µ, k  −  1; lk)-th kinematic pair. Hence, the motion of (µ, k  − 1; lk)-th kinematic pair will be a superposition of the simplest mo-tions   E0  →   E1  →   . . .  →   E7,   E0   =   Eµ,k−1,   E7   =   Elk, and the   first six of them p11, p

    22, p

    33,   φ

    4α,   φ

    5β , and  φ

    6γ  are constructive, while the 7-th  q 

    7i , i = 1, 6,

    is functional.From the second equation of (1.28) follows that

    V µ,k−1;lk

    lk   =   V 077   = L

    1,T 7   V 

    011   + V 

    177   = L

    1,T 7   V 

    011   + L

    2,T 7   V 

    122   + V 

    277   =

    L1,T 7   V 011   + L

    2,T 7   V 

    122   + L

    3,T 7   V 

    2,33   + L

    4,T 7   V 

    344   + L

    5,T 7   V 

    455   +

    L6,T 7   V 566   + L

    7,T 7   V 

    677   V 

    677   ;   V 

    066   = 0

    V 677   =

    ½  col {c6,T 7   e

    7i o

    7.i   ; 0

    T } = col {e7i o7.i   , 0

    T }   if    i = 1, 3col {0T , e7i θ

    7.i   }   otherwise

    and   finally   V µ,k−1;lklk   = col {v677   , w

    677   }   =   f 

    7i q 

    7.i   =   f 

    lki   q 

    lk.i   due to   V 

    n,n+1n+1   =

    0, n = 0, 5.   2

    Let the configuration of (µ, k − 1; lk)-th kinematic pair be given in the form(1.24)-(1.27).

    Notation 1.8   Henceforth 

    −   Lµ,k−1lk   =  Lµ,k−1lkk   L

    lkklk   is transformation of the coordinates of twists in-

    duced by the con  fi guration  Rµ,k−1lk   = col {Rµ,k−1lkk   , R

    lkklk   }  where the trans-

     formation  Lµ,k−1lkk   = T µ,k−1

    lkk   C µ,k−1lkk   is determined by the constructive con-

     fi guration  Rµ,k−1lkk   = col { plk,  φlk} and the transformation  Llkklk   = T 

    lkklk   C 

    lkklk

    is determined by the functional one  Rlkklk   = col {olk, θlk};

    −   q lk is the column of generalized coordinates of  (µ, k−1; lk) -th kinematic pair (non-null elements of the functional con  fi guration  Rlkklk   );−   ²lkklk   is  3 × 3-dimensional matrix of the kind 

    ²lkklk   =   kcT 3 (θ

    lk6   )c

    T 2 (θ

    lk5   )e

    lk1   | c

    T 3 (θ

    lk6   )e

    lk2   | e

    lk3  k

    −   clkk

    lk   =   c1(θlk

    4  )c2(θlk

    5   )c3(θlk

    6  )   be the orientation matrix for   elk

    in the constructive frame  Elkk;

    M lkklk   = diag {clkk,T lk   , ²

    lkklk   }   (1.30)

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    36/121

    Kinematics of multibody systems    25

    is the matrix of transition from the generalized velocities   q lk.i   of   (µ, k −

    1; lk)-th kinematic pair to the quasi-velocities  V µ,k−1;lklk   of the same kine-matic pair.

    Proposition 1.18  (Konoplev 1984 and 1986b,c)  The kinematic equation of (µ, k − 1; lk)-th kinematic pair is 

    V µ,k−1;lklk   = M lkklk   R

    lkk.lk   = M 

    lkklk   kf 

    lkkq lk. (1.31)

    where  kf lkk is the mobility axes matrix for  (µ, k−1; lk)-th kinematic pair that is constituted by the   6-dimensional unit columns   f lki   (each of them has   1   at its  i-th position,  i = 1, 6, the other ones being equal to zero).

    Proof    As in the previous case, to simplify the proof let us re-number bythe integers 0,   1, . . . ,   12,   the frames that participate in the simplest con-structive and functional motions of (µ, k  − 1; lk)-th kinematic pair. Then

    motion of (µ, k − 1; lk)-th kinematic pair will be superposition of twelve sim-plest motions   E0,   E1,   E2, . . . ,   E12, where   E0   =   Eµ,k−1,   E12   =   Elk, thefirst six of them  p11, p

    22, p

    33,   φ

    4α,   φ

    5β   and  φ

    6γ  are constructive and the second

    six  o71, o82, o

    93,   θ

    104   ,   θ

    115   and  θ

    126   are functional. Taking in account the second

    equality from (1.28) we obtain

    V µ,k−1,klk   =   V 0,1212   = L

    1,T 12   V 

    011   + L

    2,T 12   V 

    122   + L

    6,T 12   V 

    566   + L

    7,T 12   V 

    677   +

    L8,T 12   V 788   + L

    9,T 12   V 

    899   + L

    10,T 12   V 

    9,1010   + L

    11,T 12   V 

    10,1111   +

    L12,T 12   V 11,1212   = L

    7,T 12   col {v

    677   , 0

    T } + L8,T 12   col {v788   , 0

    T } +

    L9,T 12   col {v899   , 0

    T } + L10,T 12   col {0T , w9,1010   } +

    L11,T 12   col {0T , w10,1111   } + L

    12,T 12   col {0

    T , w11,1212   } =

    C 7,T 12   T 7,T 12   col {v677   , 0T } + C 8,T 12   T 8,T 12   col {v788   , 0T } +

    C 9,T 12   col {v899   , 0

    T } + C 10,T 12   col {0T , w9,1010   } +

    C 11,T 12   col {0T , w10,1111   } + col {0

    T , w11,1212   } =

    col {0T , c11,T 12   c10,T 11   w

    9,1010   } + C 

    10,T 12   col {v

    697   + v

    798   + v

    899   , 0

    T } +

    col {0T , c11,T 12   w10,1111   } + col {0

    T , w11,1212   } =

    col {c9,T 12   v699   , 0

    T } + col {0T , c11,T 12   c10,T 11   e

    101   θ

    10.4   } +

    col {0T , c11,T 12   e112   θ

    11.5   } + col {0

    T , e123   θ12.6   } =

    col {0T , ²912col {θ10.4   , θ

    11.5   , θ

    12.6   }} + col {c

    9,T 12   v

    699   , 0

    T } =

    col {c6,T 12   col {o7.1 , o

    8.2 , o

    9.3 }, 0

    T } +

    col {0T 

    , ²612col {θ

    10.4   , θ

    11.5   , θ

    12.6   }} =

    M 612(o71, o

    82, o

    93, θ

    10.4   , θ

    11.5   , θ

    12.6   )

    T  = M lkklk   kf lkkq lk. 2

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    37/121

    26   Chapter 1

    1.3.1.   Examples of equations of kinematic pairs 

    Gyroscope (Fig. 1.2)

    There areV 011   =   M 

    1k1   f 

    14 θ

    1.4   = Ef 

    14 θ

    1.4 , V 

    122   = M 

    2k2   f 

    25 θ

    2.5   = f 

    25 θ

    2.5

    V 233   =   M 3k3   f 

    36 θ

    3.6   = f 

    26 θ

    3.6

    Flywheel (Fig. 1.3)

    There is

    V 0ss   = f s6θ

    s.6

    Double pendulum (Fig. 1.4)

    There are two variants to write down the equations. The  first one is

    V 011   =   M 1k1   f 

    12 o

    1.2   = f 

    12 o

    1.2 , V 

    122   = M 

    2k2   f 

    25 θ

    2.5   = f 

    25 θ

    2.5

    V 233   =   M 3k3   f 

    36 θ

    3.6   = f 

    36 θ

    3.6

    And the second variant is

    V 011   =   kf 12   | f 

    15kcol {o

    1.2 , θ

    1.5 }  =  kf 

    1kq 1.,   kf 1k =  kf 12   | f 15k

    V 122   =   M 2k2   f 

    25 θ

    2.5   = f 

    36 θ

    3.6 , q 

    1. = col {o1.2 , θ1.5 }, q 

    2.6   = θ

    3.6

    Manipulator (Fig. 1.5)

    There are

    V 011   =   M 1k1   f 

    14 θ

    1.4   = f 

    14 θ

    1.4 , V 

    122   = M 

    2k2   f 

    25 θ

    2.5   = f 

    25 θ

    2.5 , . . . ,

    V 566   =   M 6k6   f 

    66 θ

    6.6   = f 

    66 θ

    6.6

    Walking machine (Fig. 1.6)

    There is

    V 10,1111   = M 11k11   kf 

    11kq 11.

    where for the matrix  M 11k11   we get

    c11k,T 11   =   cT 3 (θ

    116   )c

    T 2 (θ

    115   )c

    T 1 (θ

    114   )

    ²

    11k

    11   =   kcT 

    3 (θ11

    6   )c

    2 (θ11

    5   )e

    11

    1   | cT 

    3 (θ11

    6   )e

    11

    2   | e11

    3   kf 11 =   E, q 11 = (o111   , o

    112   , o

    113   , θ

    114   , θ

    115   , θ

    116   )

    V 11,i2i2   =   M i2ki2   f 

    i24   θ

    i2.4   = f 

    i24   θ

    i2.4   , . . . , V  

    i3,i4i4   = M 

    i4ki4   f 

    i45   θ

    i4.5   = f 

    i45   θ

    i4.5

  • 8/21/2019 Aggregative Mechanics of Rigid Body Systems Eng

    38/121

    Kinematics of multibody systems    27

    Test bench (Fig. 1.7)

    For the platform from variant 1 is fulfilled