Lagrangian Dynamics of Open Multibody Systems with Generalized Holonomic and Nonholonomic Joints

Size: px
Start display at page:

Download "Lagrangian Dynamics of Open Multibody Systems with Generalized Holonomic and Nonholonomic Joints"

Transcription

1 Proceedings of the 2007 IEEE/RSJ International Conference on Intelligent Roots and Systems San Diego, CA, USA, Oct 29 - Nov 2, 2007 ThB6.4 Lagrangian Dynamics of Open Multiody Systems with Generalized Holonomic and Nonholonomic Joints Vincent Duindam Dept. of EECS, University of California Berkeley, CA 94720, USA v.duindam@ieee.org Stefano Stramigioli Dept. of EEMCS, University of Twente P.O. Box 217, Enschede, Netherlands s.stramigioli@ieee.org Astract Standard methods to model multiody systems are aimed at systems with configuration spaces isomorphic to R n. This limitation leads to singularities and other artifacts in case the configuration space has a different topology, for example in the case of all joints or a free-floating mechanism. This paper discusses an extension of classical methods to allow for a very general class of joints, including all joints with a Lie group structure as well as nonholonomic joints. The model equations are derived using the Boltzmann-Hamel equations and have very similar structure and complexity as otained using classical methods, ut they do not suffer from singularities. Furthermore, the equations are explicit differential equations oth for holonomic and nonholonomic joints) and can e directly implemented in simulation software. I. INTRODUCTION For analysis, design, and control of rootic and other complex mechanical systems, it is often crucial to otain a good mathematical model of the dynamics of the mechanism. This model should reflect the essential properties of the mechanism, while still eing simple enough for simulation and controller design. For many applications, it is sufficient to model these mechanisms as rigid multiody systems, meaning interconnections of perfectly rigid odies y ideal joints without mechanical play. The assumption of rigidity implies that the spatial configuration space of the mechanism is a finite-dimensional space, often given the structure of a linear space isomorphic to R n. To represent the configuration of the mechanism, one can then choose coordinates q R n, and these coordinates are usually chosen to represent physically meaningful quantities, e.g. rotation angles for angular joints and elongation distances for prismatic joints. Given the inertial properties of the rigid odies in the mechanism, the dynamics can then e descried y the well-known equation [1] Mq) q + Cq, q) q + Nq) = Bq)τ 1) where Mq) is the strictly positive-definite mass matrix of the system, Cq, q) q represents the Coriolis and centrifugal forces, Nq) the gravity forces, τ the vector of actuation torques, and Bq) the input mapping such that Bq)τ is collocated with q. To use 1), the configuration space is required to e adequately descried y R n. For most joint types, this is not a serious prolem, though strictly speaking the configuration space of a rotational joint is a circle and not R 1. However, for more general joints, such as all joints three degrees of freedom) and free motion joints unconstrained motion with six degrees of freedom), the required representation of the configuration space as R n leads to singularities and sensitivities that do not correspond to physical singularities and sensitivities. These artificial singularities, as opposed to inherent singularities e.g. in a Cardan joint, are solely due to the choice of coordinates and hence should e eliminated. In this paper, we present an extension of 1) to mechanisms with more general joints. This general class is defined more precisely in the next section, ut it includes the important suclass of all joints for which the configuration space is a Lie group, such as all joints and free motion joints. The class also includes nonholonomic joints such as rolling constraints), for which the configuration space has a higher dimension than the space of instantaneously allowed velocities. The resulting equations are explicit, singularity-free differential equations that differ only slightly from 1). Lie group theory has een used extensively to develop singularity-free representations of the dynamics of a system on a single Lie group, see for example [2], [3]. Systems with nonholonomic constraints have een reduced to explicit differential equation in various ways as well, in the context of geometric mechanics and Ehresmann connections [4], and in the context of port-hamiltonian systems and Poisson rackets [5], [6]. Both holonomic and nonholonomic constraints have een treated in the framework of Kane s equations [7], [8] and Boltzmann-Hamel equations [9], which use a type of quasi-coordinates as we do here, ut are nevertheless restricted to joints with a Euclidean joint space. This paper, which is ased partially on [10], presents a systematic method that is valid for general non-euclidean holonomic and nonholonomic joints. The structure of this paper is as follows. Section II gives the precise definition of the types of joints that are considered, and demonstrates how several specific joints can e formulated in the required framework. Section III shows how the dynamics can e derived for multiody systems composed of such joints. Section IV concludes the paper. II. GENERAL HOLONOMIC AND NONHOLONOMIC JOINTS This section defines a general class of joints for which the dynamics can e derived y the method of Section III. Section II-A gives a rief summary of the theory of homogeneous transformations and twists, and then presents the definitions of general holonomic joints Section II-B) /07/$ IEEE. 3342

2 Q 1 ϕ 2 ϕ 1 ϕ 2 ϕ 1 Q 2 ΦQ 1, ) ΦQ 2, ) Fig. 1. The mapping ΦQ, ϕ) assigns local Euclidean coordinates ϕ R k to a neighorhood of each gloal coordinate Q Q. and nonholonomic joints Section II-C). The definitions are illustrated with examples of commonly encountered joints. A. Configuration and Velocities of Rigid Bodies We first riefly summarize the theory and notation used to represent configurations and velocities of rigid odies. We refer to [1] and [11] for a more extensive ackground; in this paper, we follow the notation of [11]. The configuration of a rigid ody in three-dimensional space, meaning its position and orientation relative to some reference frame, can e descried y an element of the Lie group SE3), the Special Euclidean group. Numerically, this configuration can e expressed y a 4 4 homogeneous matrix H a of the form H a = [ ] R a p a 0 1 where R a is a 3 3 orthogonal matrix with detra ) = 1 that descries the orientation of the ody, and p a is a 3 1 vector that descries the position of its origin. The indices a and refer to two right-handed coordinate frames Ψ a the reference frame) and Ψ rigidly attached to the ody). The velocity of a rigid ody, meaning oth its linear and angular velocity, can e concisely descried y an element of se3), the Lie algera of SE3). Numerically, it can e expressed as a vector T c,a or matrix [ T c,a ω c,a] = v c,a R 6 c,a or T := c,a T c,a [ ω ϕ 2 ϕ 1 2) of the form v c,a ] R with ω c,a,v c,a R 3 the angular and linear velocity, respectively, of the rigid ody, and we define for every x R 3 x := x ) = 0 x 3 x 2 x 3 0 x 1 3) x 2 x 1 0 The twist T c,a denotes the relative velocity of frame Ψ with respect to Ψ a, expressed in coordinate frame Ψ c. It is related to the relative configuration 2) as T c,a = H c aḣa H c 4) with Ḣ denoting the time-derivative of H. B. Holonomic Joints Definition 1 Holonomic joint): A gloally parameterized holonomic joint is a smooth k-dimensional su-manifold Q SE3) that descries the permitted relative configurations Hj i of ody j relative to ody i, and satisfies the following properties: 1) Every joint configuration is uniquely descried y a coordinate matrix Q of aritrary ut constant dimensions), and Hj i = Hj i Q). We identify an astract element of Q with its coordinate representation Q and write Q Q; 2) Every allowed joint velocity an element of T Q Q) is uniquely descried y a vector v R k, and the joint twist can e expressed as T i,i j = XQ)v with XQ) R 6 k a matrix descriing the instantaneously allowed twists; 3) There exists a coordinate mapping Φ : Q R k Q, such that for each Q Q, ΦQ,0) = Q and ΦQ, ) defines a local diffeomorphism etween a neighorhood of 0 R k and a neighorhood of Q Q. Fig. 1 illustrates the third property: every point of the allowed configuration space is assigned a unique gloal) coordinate Q, and the mapping Φ assigns local) Euclidean coordinates ϕ to a neighorhood of every Q. Although the requirement for the mapping Φ may seem restrictive, the class of joints that satisfy Definition 1 is actually quite large. First, classical joints with a Euclidean configuration space can e formulated in the form of the definition. If k is the numer of degrees of freedom, the gloal configuration coordinate can e chosen as Q R k, its velocity coordinate as v = Q R k, and the coordinate mapping as ΦQ,ϕ) = Q + ϕ with ϕ R k. Secondly, joints with a configuration space descried y a Lie group e.g. all joints or free motion joints) can also e formulated as in Definition 1. In this case, the coordinate matrix Q is the appropriate matrix representation of the Lie group, and the velocity coordinates are the coordinates for the algera of the group. Finally, the coordinate mapping Φ can e chosen as the exponential coordinate mapping of the group, i.e. the mapping ΦQ,ϕ) = Qe P k i=1 iϕi 5) with i the appropriate asis elements for the algera. Indeed, ΦQ,0) = Qe 0 = Q and the mapping assigns local coordinates ϕ to a neighorhood of every Q Q. Example 1 Ball joint): Consider the all joint shown in Fig. 2. We choose the configuration matrix Q to e the 3 3 rotation matrix that descries the relative orientation of frames Ψ 1 and Ψ 2, such that their relative configuration satisfies [ ] H2 1 = H2Q) 1 Q 0 = R 4 4 6) 0 1 As the gloal velocity coordinates, we pick v R 3 1 to e the angular velocity vector of frame Ψ 2 relative to Ψ 1, 3343

3 Ψ i Q j Ψ 2 Ψ 1 z Ψ 1 x y v 1 Ψ 2 v 2 v 3 Ψ 5 Q 2 Q 5 Q i Q 4 Ψ 2 Ψ 3 Ψ 4 Ψ j Fig. 2. Two examples of generalized joints etween two odies with attached frames Ψ 1 and Ψ 2 : a all joint left) and a planar nonholonomic joint right). expressed in Ψ 1. The relative twist etween Ψ 1 and Ψ 2 then ecomes T v 1 T 1,1 2 = XQ)v = 7) v 2 v 3 Finally, we can choose the coordinate mapping Ψ using exponential coordinates, i.e. as ΦQ,ϕ) = Qe ϕ = Q I + ϕ ϕ2 + 1 ) 6 ϕ ) with ϕ := ϕ ) R 3 3 as efore. C. Nonholonomic Joints Definition 2 Nonholonomic joint): A gloally parameterized nonholonomic joint is a gloally parameterized holonomic joint together with a restriction on the allowed instantaneous velocities, given y an equation A T Q)v = 0 for some differentiale matrix AQ) R k k k) of constant rank k k). In addition to the properties given in Definition 1, there must exist a differentiale rank k matrix SQ) R k k such that A T Q) SQ) = 0 for all Q Q. Following the definition, a nonholonomic joint is asically a constrained holonomic joint, implicitly restricting the allowed velocities to a k-dimensional linear suspace. The columns of the matrix S form a asis for the space of allowed velocities, or in other words, allowed velocities have the form v = S v, automatically satisfying the constraint A T v = A T S v = 0. Example 2 Planar nonholonomic joint): Fig. 2 right) shows an example of a planar holonomic joint. The relative motion of the two frames Ψ 1 and Ψ 2 is constrained to e only translation in the horizontal plane and rotation around the vertical axis. In addition, the instantaneous relative velocity is constrained to e a comination of forward rolling and pure rotation around the vertical axis: no sideways velocity in the y-direction of Ψ 2 is allowed. As a gloal coordinate matrix, we choose the comination of a 2 2 rotation matrix and a 2 1 translation vector, i.e. a matrix of the form Q = [ [ ] ] Q11 Q Q rot Q tra = 12 Q 13 R 2 3 9) Q 21 Q 22 Q 23 Q 3 Ψ 0 Ψ 1 Q 1 Fig. 3. Setup of a general open rigid mechanism with rigid links interconnected y general joints. Frame Ψ 0 denotes the inertial reference frame, and each ody i with frame Ψ i ) connects to the parent ody in the tree y a joint with configuration coordinate Q i. such that Q rot is a 2 2 rotation matrix and H2Q) 1 equals Q 11 Q 12 0 Q 13 H2Q) 1 = Q 21 Q 22 0 Q ) We choose the velocity coordinates v to descrie the angular and linear velocities in ody frame, i.e. T Q 23 Q 13 0 v 1 T 1,1 2 = XQ)v = Q 11 Q Q 12 Q 22 0 v 2 v 3 such that v 1 descries the angular velocity around the z-axis of Ψ 2, and v 2,v 3 ) the linear velocity in the x,y) direction of Ψ 2. Finally, we use exponential coordinates for SE2) as the coordinate mapping ΦQ, ϕ), i.e. ΦQ,ϕ) = Qe ϕ 1 ϕ 2 ϕ 1 0 ϕ The nonholonomic constraint can e expressed simply as A T Q)v = [ ] v = v 3 = 0 11) due to the specific choice of coordinates for v. In this case, we can choose the matrix SQ) as 1 0 SQ) = which has constant rank k = 2 and satisfies A T S = 0. III. DYNAMICS OF OPEN MULTIBODY SYSTEMS In this section, we discuss the procedure to derive the dynamics of rigid mechanisms with general joints as defined in Section II. We only consider open mechanism, i.e. systems without closed kinematic chains, and lael the n joints and n links as in Fig. 3. Each joint has a gloal configuration coordinate Q i, velocity coordinate v i R ki, and coordinate mapping Φ i Q i,ϕ i ). 3344

4 A. The Boltzmann-Hamel Equations The derivation of the dynamic equations is ased on the Boltzmann-Hamel equations [12] as formulated in Theorem 1 elow. These equations descrie the dynamics of a system in quasi-coordinates, i.e. velocity coordinates v that are not the time-derivative of position coordinates q ut are related as v = Sq) q for some diffeomorphism Sq). Theorem 1 Boltzmann-Hamel): Given a mechanical system with configuration q, velocity v = Sq) q with Sq) invertile and continuously differentiale), inputs torques τ collocated with v, potential energy V q) and kinetic coenergy U k = 1 2 vt Mq)v. The dynamics can e written in q, v) coordinates as d dt L v ) T L S q + ) γ k v k k L v = τ 12) with Lq,v) := U k q,v) V q) = 1 2 vt Mq)v V q) and γ k ) ij q) := li Slj mk S ) lm 13) q m q j l,m Proof: Given the definition of the function Lq, v) and the coordinates v, we can write the Lagrangian L of the system in q, q) coordinates as Lq, q) = 1 2 qt S T q)mq)sq) q + V q) 14) Expressing its partial derivatives in terms of the partial derivatives of L, and sustituting into the classical Euler- Lagrange equations d dt ) L L q q = Bq)τ with B = S T since τ is collocated with v) gives 12). B. Mechanisms with only holonomic joints We now proceed with the derivation of the dynamic equations for general rigid mechanisms. From Definitions 1 and 2, we know that the relative twist of each joint can e expressed as T, i = X i Q i )v i, where denotes the index of the parent link in the tree. Furthermore, we can use the coordinate mapping Φ i Q i,ϕ i ) to represent the relative configuration of a joint as Hi Q i,ϕ i ). For fixed Q i, the time-derivative Ḣ i ecomes a function Ḣ i Q i,ϕ i, ϕ i ) that is linear in ϕ i. Comining this with the fact that 4) gives a and Ḣ i, we can conclude that there exists a linear relation etween v and ϕ, parameterized y Q i and Φ i. We express this relation as linear relation etween T, i v i = S i Q i,ϕ i ) ϕ i 15) and refer to the examples further on for typical expressions for S i Q i,ϕ i ) for common joints. For joints with a Euclidean joint space, we have v i = ϕ i and hence S i Q i,ϕ i ) = I. For a general mechanism with n joints, we loosely denote y Q the collection of all gloal joint coordinates Q i, y ϕ the vector stacking of all local coordinates ϕ i around a certain configuration Q, y v the vector stacking of all joint velocity coordinates v i, and y SQ,ϕ) the lock-diagonal matrix relating v to ϕ. Following standard procedures see e.g. [1] or [11]), we can derive an expression for the inertia matrix MQ) of the mechanism and write the kinetic co-energy as U k Q,v) = 1 2 vt MQ)v. The potential energy due to gravity can e derived y expressing the heights h i of the centers of mass of all rigid odies in terms of Q and writing V Q) = n i=1 m igh i Q), with m i the mass of ody i and g the gravitational constant. Additional potential energies can e added if required. Theorem 2 Dynamics for holonomic joints): Given an n-link open rigid mechanism with general holonomic joints, laeled as in Fig. 3, with joints descried y gloal coordinates Q, local coordinates ϕ, coordinate mapping ΦQ, ϕ), gloal velocity coordinates v, and the matrix S relating local and gloal velocity coordinates as v = SQ,ϕ) ϕ for fixed Q. Let it have kinetic co-energy U k = 1 2 vt MQ)v, potential energy V Q), and input torques τ collocated with v. The dynamics of the mechanism are given y with MQ) v + ĈQ,v)v + ˆNQ) = τ 16) T V ˆNQ) := S ϕ Ĉ ij Q,v) := k,l + mi k,l,m,s Mij kl 1 ϕ k 2 S 1 ki Smj ϕ s ) M jl v l ϕ k S ) ms sk kl) ϕ M v l j Partial derivatives of MQ) and V Q) with respect to ϕ should e computed y first sustituting the coordinate mappings ΦQ,ϕ) for Q and then taking the partial derivative, = MΦQ,ϕ)) ϕ k. so as MQ) ϕ k Proof: The theorem follows more or less directly y applying the Boltzmann-Hamel equations of Theorem 1 to the rigid mechanism expressed in ϕ, v) coordinates around a certain point Q and evaluating at ϕ = 0. More precisely, if we parameterize the configuration Q t around a certain fixed point Q as Q t = ΦQ,ϕ), we can write the Lagrangian in coordinates ϕ, v), parameterized y Q, as L Q ϕ,v) = 1 2 vt MΦQ,ϕ))v V ΦQ,ϕ)) 17) We can then apply Theorem 1 and calculate ) ) d LQ M = ϕ k v + M v dt v ϕ k k L Q = 1 M vt v V ϕ k 2 ϕ k ϕ k Comining all elements and using the definitions of Ĉ and ˆN) results in expression 16). It is important to note that only the gloal coordinates Q appear in the expression for the dynamics and are states of 3345

5 the dynamical system; the local coordinates ϕ are evaluated at zero. This means that 16) is a gloally valid equation for all coordinates Q, and does not require different expressions across the configuration manifold that depend on its exact covering y a coordinate atlas. Furthermore, the expressions evaluated at ϕ = 0 only depend on local joint properties not the rest of the mechanism) and can hence e evaluated offline and for each joint separately. This makes the presented algorithm suitale for software implementation. In order to otain the full set of differential equations for Q, v), the dynamic equations 16) can e augmented with the kinematic equations Q = QQ,v) which relate the velocity coordinates to the time derivatives of the position coordinates and are determined on joint level y the relations Hi = H i Q i) and T, i = X i Q i )v i. Example 3 Euclidean joints): For Euclidean joints with configuration coordinates Q = q R n and velocity coordinates v = q, the dynamic equations reduce to the standard equations 1) known from literature, i.e. SQ, ϕ) = I, ĈQ,v) = Cq, q), and ˆNQ) = Nq). Example 4 Ball joint continued): We give an example of how some of the terms in Theorem 2 would look for a all joint with coordinates Q, v) as in Example 1. From the choice of coordinates and coordinate mapping Φ), we can write for configurations Q t around fixed Q ṽ = Q t Q T t = Q ϕ + 1 ) 2 ϕ ϕ + ϕ ϕ) +... I ϕ +...) Q T = Q ϕ + 1 ) 2 ϕ ϕ ϕ ϕ) +... Q T where dots indicate terms of second and higher order in ϕ. This relation can e written in vector form as v = Q I + 12 ) ϕ +... ϕ = SQ,ϕ) ϕ 18) which gives the relation etween v and ϕ. From this expression, we can compute for example S T x) ϕ = I 1 x) ϕ 2 ϕ +...)QT 1 2 ϕqt x +...) = ϕ = ϕ 1 Q 2 T x)ϕ +...) = 1 2 Q T x) = 1 2 QT xq for any x R 3. This example is typical in the sense that, for joints with exponential Lie group coordinates, the final expressions to e used in the dynamic equations evaluated at ϕ = 0) are generally very simple. C. Mechanisms with holonomic and nonholonomic joints Just as Definition 2 for nonholonomic joints is a restriction of Definition 1 for holonomic joints, we consider the dynamics of mechanisms with nonholonomic joints as a restriction of the dynamics of holonomic joints. To e more precise, the dynamics of mechanism with velocity v is constrained to satisfy extra equations of the form A T Q)v = 0. These constraints are enforced y constraint forces λ that enter the dynamic equations as extra terms AQ)λ on the right-hand side of 16). The magnitude of λ is such that the constraints remain satisfied at all times. The following theorem presents how the dynamic equations for the restricted systems can e otained. Theorem 3 Dynamics for general joints): Given an n- link open rigid mechanism with general holonomic and nonholonomic joints, laeled as in Fig. 3, with joints descried y gloal coordinates Q, local coordinates ϕ, and coordinate mapping ΦQ, ϕ). Let S descrie the relation etween local and gloal velocity coordinates as v = SQ,ϕ) ϕ for fixed Q, and let S descrie the relation etween constrained velocities v and unconstrained velocities v as v = SQ) v with SQ) = I for holonomic joints). Let the mechanism have kinetic co-energy U k = 1 2 vt MQ)v, potential energy V Q), and input torques τ collocated with v. The dynamics of the mechanism are given y with MQ) v + CQ, v) v + S T Q) ˆNQ) = S T Q)τ 19) MQ) := S T M S CQ, v) := S T M i S )i) S 1 S v + ϕ i S T Ĉ S where ĈQ,v) = ĈQ, S v) and ˆNQ) as in Theorem 2. Proof: Starting from the result of Theorem 2, i.e. efore applying the constraint forces, the implicit dynamic equations of the mechanism are MQ) v + ĈQ,v)v + ˆNQ) = τ + AQ)λ 20) and the nonholonomic constraint equals A T Q)v = 0. If we sustitute v = S v which can e done for all velocities satisfying the constraint, since S defines a asis) and premultiply 20) y S T, we otain S T M S v + S v ) + S T Ĉ S v + S T ˆN = ST τ + S T Aλ The last term equals zero y definition of S, and the equation can e written directly as in the theorem. An expression for λ can e otained y pre-multiplying 20) with A T M 1 and sustituting v = S v, which gives A T S v + S v) + A T M 1 Ĉ S v + ˆN) = A T M 1 τ + Aλ) A T S v + A T M 1 Ĉ S v + ˆN τ) = A T M 1 A ) λ Since A T M 1 A is invertile, this expression uniquely determines λ from the state Q, v) in an equation that complements 19). The columns of M 1 A form a asis for the constrained velocities that is M-orthogonal to the asis defined y the columns of S since ST MM 1 A = 0). This orthogonality in the proper metric M results in two independent sets of equations, one for the accelerations v and one for the constraint forces λ. 3346

6 Example 5 Planar joint continued): Consider again the nonholonomic planar joint as descried in Example 2. If we consider Ψ 1 as the inertial frame and ody 2 has mass m and inertia J around the z-axis, the kinetic co-energy can e written in terms of the coordinates Q and v as U k Q,v) = 1 2 vt MQ)v = 1 J vt 0 m 0 v 0 0 m To find the mapping S, we compare the left-hand and righthand sides of the expression Xv) = T 1,1 2 = Ḣ1 2H 2 1 to find SQ,ϕ) = I. The dynamic equations for the planar joint without nonholonomic constraints can thus e written in coordinates Q,v) as J 0 0 v 1 τ 1 0 m 0 v = τ m v 3 τ 3 Using the definition of the constant) S from Example 2, the reduced equations in terms of v ecome [ ] [ ] J 0 ][ v 1 τ = 0 m v 2 The dynamics in this case are oviously not very interesting, ut the example serves to illustrate the systematic procedure to otain them, and the generality of using this particular joint as part of a larger mechanism say, y putting the cart on a moving platform and adding a rootic manipulator on top of it). Furthermore, the kinematics, i.e. the relation etween Q and v, also follows from the theory, in general as Ḣ 1 2Q, Q) = T 1,1 2 Q, v)h 1 2Q) = XQ) SQ) v)h 1 2 Q) which for this example can e simplified to 0 v 1 v 2 Q = Q v IV. CONCLUSIONS AND FUTURE WORK This paper presents a generalization of classical modeling results to an extended class of rigid multiody systems. In addition to joints with Euclidean joint spaces with configuration descried y R n ), general joints with configuration spaces different from R n can e included, requiring only mild and local modifications to the classical Lagrangian results known from literature. The equations are gloally valid for all configurations and do not require local configuration states. In addition, nonholonomic constraints can e added as a trivial extension, reducing the dimension of the velocity space, ut again not drastically modifying the equations. The generalized class of joints includes all joints descried y Lie groups, such as all joints, free motion joints unconstrained 6D motion), and planar motion. However, any other general joint type can e included as well, as long as it can e formulated as in Definition 1. τ 2 The extra elements that appear in the dynamic equation have a lock-diagonal form, which means they can e specified at joint level and do not depend on the rest of the mechanism. This makes the presented approach suitale for software implementation, as it allows many different joints to e specified as lirary elements with representations of the specific gloal coordinates for position and velocity, as well as the extra structure elements that appear in the equation: the matrix SQ, ϕ), its inverse, and its partial derivatives with respect to each of the local coordinates ϕ, all evaluated at ϕ = 0, can e stored in the lirary element, and then used as systematic uilding locks in the dynamic equations. The general form of the equations is currently eing implemented in the modeling and simulation package 20sim [13]. As a possile extension for future work, the precise structure of the expressions for C should e analyzed in more detail, in order to find fast and numerically roust ways to express these terms in simulation code. A future paper will also descrie the presented results in port-hamiltonian terms, i.e. using momentum instead of velocity variales. ACKNOWLEDGMENTS This work has een done in the context of the European sponsored project GeoPlex with reference code IST Further information is availale at the project wesite Vincent Duindam is sponsored y the Netherlands Organization for Scientific Research NWO). REFERENCES [1] R. M. Murray, Z. Li, and S. S. Sastry, A Mathematical Introduction to Rootic Manipulation. CRC Press, [2] J. E. Marsden and T. S. Ratiu, Introduction to Mechanics and Symmetry, 2nd ed., ser. Texts in Applied Mathematics. Springer-Verlag, 1999, vol. 17. [3] F. Bullo and A. D. Lewis, Geometric Control of Mechanical Systems: Modeling, Analysis, and Design for Simple Mechanical Control Systems, ser. Texts in Applied Mathematics. Springer, Novemer 2004, vol. 49. [4] A. M. Bloch, P. S. Krishnaprasad, J. E. Marsden, and R. M. Murray, Nonholonomic mechanical systems with symmetry, Archive for Rational Mechanics and Analysis, vol. 136, pp , [5] A. J. van der Schaft and B. M. Maschke, On the Hamiltonian formulation of nonholonomic mechanical systems, Reports on Mathematical Physics, vol. 34, pp , [6] V. Duindam, G. Blankenstein, and S. Stramigioli, Port-ased modeling and analysis of snakeoard locomotion, in Proceeding of the International Symposium on Mathematical Theory of Networks and Systems, July [7] T. R. Kane and C. F. Wang, On the derivation of equations of motion, Journal of the Society for Industrial and Applied Mathematics, vol. 13, no. 2, pp , June [8] W. Blajer, A geometrical interpretation and uniform matrix formulation of multiody system dynamics, Zeitschrift für angewandte Mathematik und Mechanik, vol. 81, no. 4, pp , [9] J. M. Cameron and W. J. Book, Modeling mechanisms with nonholonomic joints using the Boltzmann-Hamel equations, International Journal of Rootics Research, vol. 16, pp , [10] V. Duindam, Port-ased modeling and control for efficient ipedal walking roots, Ph.D. dissertation, University of Twente, March [Online]. Availale: [11] S. Stramigioli, Modeling and IPC Control of Interactive Mechanical Systems A Coordinate-free Approach. Springer-Verlag, [12] E. T. Whittaker, A Treatise on the Analytical Dynamics of Particles and Rigid Bodies, 4th ed. Camridge University Press, [13] Control La Products, 20sim version 3.6, [Online]. Availale:

Singularity-Free Dynamic Equations of Spacecraft-Manipulator Systems

Singularity-Free Dynamic Equations of Spacecraft-Manipulator Systems Singularity-Free Dynamic Equations of Spacecraft-Manipulator Systems Pål J. From Kristin Y. Pettersen Jan T. Gravdahl Engineering Cyernetics, Norwegian University of Science & Technology, Norway Astract:

More information

Modeling and Motion Planning for Mechanisms on a Non-Inertial Base

Modeling and Motion Planning for Mechanisms on a Non-Inertial Base 9 IEEE International Conference on Rootics and Automation Koe International Conference Center Koe, Japan, May 1-17, 9 Modeling and Motion Planning for Mechanisms on a Non-Inertial Base Pål J. From 1 Vincent

More information

Port-based Modeling and Control for Efficient Bipedal Walking Machines

Port-based Modeling and Control for Efficient Bipedal Walking Machines Port-based Modeling and Control for Efficient Bipedal Walking Machines Vincent Duindam vincentd@eecs.berkeley.edu Control Laboratory, EE-Math-CS University of Twente, Netherlands Joint work with Stefano

More information

HAMILTONIAN FORMULATION OF PLANAR BEAMS. Goran Golo,,1 Arjan van der Schaft,1 Stefano Stramigioli,1

HAMILTONIAN FORMULATION OF PLANAR BEAMS. Goran Golo,,1 Arjan van der Schaft,1 Stefano Stramigioli,1 HAMILTONIAN FORMULATION OF PLANAR BEAMS Goran Golo,,1 Arjan van der Schaft,1 Stefano Stramigioli,1 Department of Appl. Mathematics, University of Twente P.O. Box 217, 75 AE Enschede, The Netherlands ControlLab

More information

EN Nonlinear Control and Planning in Robotics Lecture 2: System Models January 28, 2015

EN Nonlinear Control and Planning in Robotics Lecture 2: System Models January 28, 2015 EN53.678 Nonlinear Control and Planning in Robotics Lecture 2: System Models January 28, 25 Prof: Marin Kobilarov. Constraints The configuration space of a mechanical sysetm is denoted by Q and is assumed

More information

In most robotic applications the goal is to find a multi-body dynamics description formulated

In most robotic applications the goal is to find a multi-body dynamics description formulated Chapter 3 Dynamics Mathematical models of a robot s dynamics provide a description of why things move when forces are generated in and applied on the system. They play an important role for both simulation

More information

Dynamics. Basilio Bona. Semester 1, DAUIN Politecnico di Torino. B. Bona (DAUIN) Dynamics Semester 1, / 18

Dynamics. Basilio Bona. Semester 1, DAUIN Politecnico di Torino. B. Bona (DAUIN) Dynamics Semester 1, / 18 Dynamics Basilio Bona DAUIN Politecnico di Torino Semester 1, 2016-17 B. Bona (DAUIN) Dynamics Semester 1, 2016-17 1 / 18 Dynamics Dynamics studies the relations between the 3D space generalized forces

More information

Nonholonomic Constraints Examples

Nonholonomic Constraints Examples Nonholonomic Constraints Examples Basilio Bona DAUIN Politecnico di Torino July 2009 B. Bona (DAUIN) Examples July 2009 1 / 34 Example 1 Given q T = [ x y ] T check that the constraint φ(q) = (2x + siny

More information

Multibody simulation

Multibody simulation Multibody simulation Dynamics of a multibody system (Euler-Lagrange formulation) Dimitar Dimitrov Örebro University June 16, 2012 Main points covered Euler-Lagrange formulation manipulator inertia matrix

More information

Multibody simulation

Multibody simulation Multibody simulation Dynamics of a multibody system (Newton-Euler formulation) Dimitar Dimitrov Örebro University June 8, 2012 Main points covered Newton-Euler formulation forward dynamics inverse dynamics

More information

Trajectory-tracking control of a planar 3-RRR parallel manipulator

Trajectory-tracking control of a planar 3-RRR parallel manipulator Trajectory-tracking control of a planar 3-RRR parallel manipulator Chaman Nasa and Sandipan Bandyopadhyay Department of Engineering Design Indian Institute of Technology Madras Chennai, India Abstract

More information

Geometric Mechanics and Global Nonlinear Control for Multi-Body Dynamics

Geometric Mechanics and Global Nonlinear Control for Multi-Body Dynamics Geometric Mechanics and Global Nonlinear Control for Multi-Body Dynamics Harris McClamroch Aerospace Engineering, University of Michigan Joint work with Taeyoung Lee (George Washington University) Melvin

More information

Artificial Intelligence & Neuro Cognitive Systems Fakultät für Informatik. Robot Dynamics. Dr.-Ing. John Nassour J.

Artificial Intelligence & Neuro Cognitive Systems Fakultät für Informatik. Robot Dynamics. Dr.-Ing. John Nassour J. Artificial Intelligence & Neuro Cognitive Systems Fakultät für Informatik Robot Dynamics Dr.-Ing. John Nassour 25.1.218 J.Nassour 1 Introduction Dynamics concerns the motion of bodies Includes Kinematics

More information

Hybrid Routhian Reduction of Lagrangian Hybrid Systems

Hybrid Routhian Reduction of Lagrangian Hybrid Systems Hybrid Routhian Reduction of Lagrangian Hybrid Systems Aaron D. Ames and Shankar Sastry Department of Electrical Engineering and Computer Sciences University of California at Berkeley Berkeley, CA 94720

More information

Physical Dynamics (PHY-304)

Physical Dynamics (PHY-304) Physical Dynamics (PHY-304) Gabriele Travaglini March 31, 2012 1 Review of Newtonian Mechanics 1.1 One particle Lectures 1-2. Frame, velocity, acceleration, number of degrees of freedom, generalised coordinates.

More information

Lecture Note 12: Dynamics of Open Chains: Lagrangian Formulation

Lecture Note 12: Dynamics of Open Chains: Lagrangian Formulation ECE5463: Introduction to Robotics Lecture Note 12: Dynamics of Open Chains: Lagrangian Formulation Prof. Wei Zhang Department of Electrical and Computer Engineering Ohio State University Columbus, Ohio,

More information

Physical Dynamics (SPA5304) Lecture Plan 2018

Physical Dynamics (SPA5304) Lecture Plan 2018 Physical Dynamics (SPA5304) Lecture Plan 2018 The numbers on the left margin are approximate lecture numbers. Items in gray are not covered this year 1 Advanced Review of Newtonian Mechanics 1.1 One Particle

More information

Equations of motion for general constrained systems in Lagrangian mechanics

Equations of motion for general constrained systems in Lagrangian mechanics cta Mech DOI 10.1007/s00707-009-0272-2 Firdaus E. Udwadia aron D. Schutte Equations of motion for general constrained systems in Lagrangian mechanics Received: 24 Novemer 2009 Springer-Verlag 2010 stract

More information

Noether s Theorem. 4.1 Ignorable Coordinates

Noether s Theorem. 4.1 Ignorable Coordinates 4 Noether s Theorem 4.1 Ignorable Coordinates A central recurring theme in mathematical physics is the connection between symmetries and conservation laws, in particular the connection between the symmetries

More information

Kinematics. Chapter Multi-Body Systems

Kinematics. Chapter Multi-Body Systems Chapter 2 Kinematics This chapter first introduces multi-body systems in conceptual terms. It then describes the concept of a Euclidean frame in the material world, following the concept of a Euclidean

More information

Dynamics. describe the relationship between the joint actuator torques and the motion of the structure important role for

Dynamics. describe the relationship between the joint actuator torques and the motion of the structure important role for Dynamics describe the relationship between the joint actuator torques and the motion of the structure important role for simulation of motion (test control strategies) analysis of manipulator structures

More information

Discrete Dirac Mechanics and Discrete Dirac Geometry

Discrete Dirac Mechanics and Discrete Dirac Geometry Discrete Dirac Mechanics and Discrete Dirac Geometry Melvin Leok Mathematics, University of California, San Diego Joint work with Anthony Bloch and Tomoki Ohsawa Geometric Numerical Integration Workshop,

More information

DYNAMICS OF SERIAL ROBOTIC MANIPULATORS

DYNAMICS OF SERIAL ROBOTIC MANIPULATORS DYNAMICS OF SERIAL ROBOTIC MANIPULATORS NOMENCLATURE AND BASIC DEFINITION We consider here a mechanical system composed of r rigid bodies and denote: M i 6x6 inertia dyads of the ith body. Wi 6 x 6 angular-velocity

More information

Global Formulations of Lagrangian and Hamiltonian Dynamics on Embedded Manifolds

Global Formulations of Lagrangian and Hamiltonian Dynamics on Embedded Manifolds 1 Global Formulations of Lagrangian and Hamiltonian Dynamics on Embedded Manifolds By Taeyoung Lee, Melvin Leok, and N. Harris McClamroch Mechanical and Aerospace Engineering, George Washington University,

More information

Steering the Chaplygin Sleigh by a Moving Mass

Steering the Chaplygin Sleigh by a Moving Mass Steering the Chaplygin Sleigh by a Moving Mass Jason M. Osborne Department of Mathematics North Carolina State University Raleigh, NC 27695 jmosborn@unity.ncsu.edu Dmitry V. Zenkov Department of Mathematics

More information

Dirac Structures and the Legendre Transformation for Implicit Lagrangian and Hamiltonian Systems

Dirac Structures and the Legendre Transformation for Implicit Lagrangian and Hamiltonian Systems Dirac Structures and the Legendre Transformation for Implicit Lagrangian and Hamiltonian Systems Hiroaki Yoshimura Mechanical Engineering, Waseda University Tokyo, Japan Joint Work with Jerrold E. Marsden

More information

Spacecraft Math. Stephen Leake

Spacecraft Math. Stephen Leake Spacecraft Math Stephen Leake 27 Septemer 2008 2 Chapter 1 Introduction This document presents a thorough summary of vector, quaternion, and matrix math used in spacecraft applications, in oth flight and

More information

CDS 205 Final Project: Incorporating Nonholonomic Constraints in Basic Geometric Mechanics Concepts

CDS 205 Final Project: Incorporating Nonholonomic Constraints in Basic Geometric Mechanics Concepts CDS 205 Final Project: Incorporating Nonholonomic Constraints in Basic Geometric Mechanics Concepts Michael Wolf wolf@caltech.edu 6 June 2005 1 Introduction 1.1 Motivation While most mechanics and dynamics

More information

COMPLETE ALL ROUGH WORKINGS IN THE ANSWER BOOK AND CROSS THROUGH ANY WORK WHICH IS NOT TO BE ASSESSED.

COMPLETE ALL ROUGH WORKINGS IN THE ANSWER BOOK AND CROSS THROUGH ANY WORK WHICH IS NOT TO BE ASSESSED. BSc/MSci EXAMINATION PHY-304 Time Allowed: Physical Dynamics 2 hours 30 minutes Date: 28 th May 2009 Time: 10:00 Instructions: Answer ALL questions in section A. Answer ONLY TWO questions from section

More information

PHYS 705: Classical Mechanics. Introduction and Derivative of Moment of Inertia Tensor

PHYS 705: Classical Mechanics. Introduction and Derivative of Moment of Inertia Tensor 1 PHYS 705: Classical Mechanics Introduction and Derivative of Moment of Inertia Tensor L and N depends on the Choice of Origin Consider a particle moving in a circle with constant v. If we pick the origin

More information

10 Lorentz Group and Special Relativity

10 Lorentz Group and Special Relativity Physics 129 Lecture 16 Caltech, 02/27/18 Reference: Jones, Groups, Representations, and Physics, Chapter 10. 10 Lorentz Group and Special Relativity Special relativity says, physics laws should look the

More information

Introduction to Robotics

Introduction to Robotics J. Zhang, L. Einig 277 / 307 MIN Faculty Department of Informatics Lecture 8 Jianwei Zhang, Lasse Einig [zhang, einig]@informatik.uni-hamburg.de University of Hamburg Faculty of Mathematics, Informatics

More information

Representation theory of SU(2), density operators, purification Michael Walter, University of Amsterdam

Representation theory of SU(2), density operators, purification Michael Walter, University of Amsterdam Symmetry and Quantum Information Feruary 6, 018 Representation theory of S(), density operators, purification Lecture 7 Michael Walter, niversity of Amsterdam Last week, we learned the asic concepts of

More information

Classical Mechanics III (8.09) Fall 2014 Assignment 3

Classical Mechanics III (8.09) Fall 2014 Assignment 3 Classical Mechanics III (8.09) Fall 2014 Assignment 3 Massachusetts Institute of Technology Physics Department Due September 29, 2014 September 22, 2014 6:00pm Announcements This week we continue our discussion

More information

Differential Geometry of Surfaces

Differential Geometry of Surfaces Differential Geometry of urfaces Jordan mith and Carlo équin C Diision, UC Berkeley Introduction These are notes on differential geometry of surfaces ased on reading Greiner et al. n. d.. Differential

More information

112 Dynamics. Example 5-3

112 Dynamics. Example 5-3 112 Dynamics Gravity Joint 1 Figure 6-7: Remotely driven two d.o.r. planar manipulator. Note that, since no external force acts on the endpoint, the generalized forces coincide with the joint torques,

More information

q 1 F m d p q 2 Figure 1: An automated crane with the relevant kinematic and dynamic definitions.

q 1 F m d p q 2 Figure 1: An automated crane with the relevant kinematic and dynamic definitions. Robotics II March 7, 018 Exercise 1 An automated crane can be seen as a mechanical system with two degrees of freedom that moves along a horizontal rail subject to the actuation force F, and that transports

More information

In this section of notes, we look at the calculation of forces and torques for a manipulator in two settings:

In this section of notes, we look at the calculation of forces and torques for a manipulator in two settings: Introduction Up to this point we have considered only the kinematics of a manipulator. That is, only the specification of motion without regard to the forces and torques required to cause motion In this

More information

A Symbolic Vector/Dyadic Multibody Formalism For Tree- Topology Systems

A Symbolic Vector/Dyadic Multibody Formalism For Tree- Topology Systems A Symbolic Vector/Dyadic Multibody Formalism For Tree- Topology Systems Michael W. Sayers * The University of Michigan Transportation Research Institute Abstract A multibody formalism is presented that

More information

Physics 106a, Caltech 4 December, Lecture 18: Examples on Rigid Body Dynamics. Rotating rectangle. Heavy symmetric top

Physics 106a, Caltech 4 December, Lecture 18: Examples on Rigid Body Dynamics. Rotating rectangle. Heavy symmetric top Physics 106a, Caltech 4 December, 2018 Lecture 18: Examples on Rigid Body Dynamics I go through a number of examples illustrating the methods of solving rigid body dynamics. In most cases, the problem

More information

Solving high order nonholonomic systems using Gibbs-Appell method

Solving high order nonholonomic systems using Gibbs-Appell method Solving high order nonholonomic systems using Gibbs-Appell method Mohsen Emami, Hassan Zohoor and Saeed Sohrabpour Abstract. In this paper we present a new formulation, based on Gibbs- Appell method, for

More information

GEOMETRY FINAL CLAY SHONKWILER

GEOMETRY FINAL CLAY SHONKWILER GEOMETRY FINAL CLAY SHONKWILER 1 a: If M is non-orientale and p M, is M {p} orientale? Answer: No. Suppose M {p} is orientale, and let U α, x α e an atlas that gives an orientation on M {p}. Now, let V,

More information

Quivers. Virginia, Lonardo, Tiago and Eloy UNICAMP. 28 July 2006

Quivers. Virginia, Lonardo, Tiago and Eloy UNICAMP. 28 July 2006 Quivers Virginia, Lonardo, Tiago and Eloy UNICAMP 28 July 2006 1 Introduction This is our project Throughout this paper, k will indicate an algeraically closed field of characteristic 0 2 Quivers 21 asic

More information

Transverse Linearization for Controlled Mechanical Systems with Several Passive Degrees of Freedom (Application to Orbital Stabilization)

Transverse Linearization for Controlled Mechanical Systems with Several Passive Degrees of Freedom (Application to Orbital Stabilization) Transverse Linearization for Controlled Mechanical Systems with Several Passive Degrees of Freedom (Application to Orbital Stabilization) Anton Shiriaev 1,2, Leonid Freidovich 1, Sergey Gusev 3 1 Department

More information

Rigid Body Equations of Motion for Modeling and Control of Spacecraft Formations - Part 1: Absolute Equations of Motion.

Rigid Body Equations of Motion for Modeling and Control of Spacecraft Formations - Part 1: Absolute Equations of Motion. Rigid ody Equations of Motion for Modeling and Control of Spacecraft Formations - Part 1: Absolute Equations of Motion. Scott R. Ploen, Fred Y. Hadaegh, and Daniel P. Scharf Jet Propulsion Laboratory California

More information

Robot Dynamics II: Trajectories & Motion

Robot Dynamics II: Trajectories & Motion Robot Dynamics II: Trajectories & Motion Are We There Yet? METR 4202: Advanced Control & Robotics Dr Surya Singh Lecture # 5 August 23, 2013 metr4202@itee.uq.edu.au http://itee.uq.edu.au/~metr4202/ 2013

More information

ON GENERAL NONLINEAR CONSTRAINED MECHANICAL SYSTEMS. Firdaus E. Udwadia. Thanapat Wanichanon

ON GENERAL NONLINEAR CONSTRAINED MECHANICAL SYSTEMS. Firdaus E. Udwadia. Thanapat Wanichanon NUMERICAL ALGEBRA, doi:10.3934/naco.2013.3.425 CONTROL AND OPTIMIZATION Volume 3, Numer 3, Septemer 2013 pp. 425 443 ON GENERAL NONLINEAR CONSTRAINED MECHANICAL SYSTEMS Firdaus E. Udwadia Aerospace and

More information

Operational Space Control of Constrained and Underactuated Systems

Operational Space Control of Constrained and Underactuated Systems Robotics: Science and Systems 2 Los Angeles, CA, USA, June 27-3, 2 Operational Space Control of Constrained and Underactuated Systems Michael Mistry Disney Research Pittsburgh 472 Forbes Ave., Suite Pittsburgh,

More information

Advanced Robotic Manipulation

Advanced Robotic Manipulation Lecture Notes (CS327A) Advanced Robotic Manipulation Oussama Khatib Stanford University Spring 2005 ii c 2005 by Oussama Khatib Contents 1 Spatial Descriptions 1 1.1 Rigid Body Configuration.................

More information

Chapter 3 Numerical Methods

Chapter 3 Numerical Methods Chapter 3 Numerical Methods Part 3 3.4 Differential Algebraic Systems 3.5 Integration of Differential Equations 1 Outline 3.4 Differential Algebraic Systems 3.4.1 Constrained Dynamics 3.4.2 First and Second

More information

Flat Nonholonomic Matching

Flat Nonholonomic Matching Flat Nonholonomic Matching Dmitry V. Zenkov 1 Department of Mathematics North Carolina State University Raleigh, NC 27695 dvzenkov@unity.ncsu.edu Anthony M. Bloch 2 Department of Mathematics University

More information

On mechanical control systems with nonholonomic constraints and symmetries

On mechanical control systems with nonholonomic constraints and symmetries ICRA 2002, To appear On mechanical control systems with nonholonomic constraints and symmetries Francesco Bullo Coordinated Science Laboratory University of Illinois at Urbana-Champaign 1308 W. Main St,

More information

Controllability Analysis of A Two Degree of Freedom Nonlinear Attitude Control System

Controllability Analysis of A Two Degree of Freedom Nonlinear Attitude Control System Controllability Analysis of A Two Degree of Freedom Nonlinear Attitude Control System Jinglai Shen, Amit K Sanyal, and N Harris McClamroch Department of Aerospace Engineering The University of Michigan

More information

Variational Collision Integrators and Optimal Control

Variational Collision Integrators and Optimal Control Variational Collision Integrators and Optimal Control David Pekarek, and Jerrold Marsden 1 Abstract This paper presents a methodology for generating locally optimal control policies for mechanical systems

More information

Lecture Note 12: Dynamics of Open Chains: Lagrangian Formulation

Lecture Note 12: Dynamics of Open Chains: Lagrangian Formulation ECE5463: Introduction to Robotics Lecture Note 12: Dynamics of Open Chains: Lagrangian Formulation Prof. Wei Zhang Department of Electrical and Computer Engineering Ohio State University Columbus, Ohio,

More information

Massachusetts Institute of Technology Department of Physics. Final Examination December 17, 2004

Massachusetts Institute of Technology Department of Physics. Final Examination December 17, 2004 Massachusetts Institute of Technology Department of Physics Course: 8.09 Classical Mechanics Term: Fall 004 Final Examination December 17, 004 Instructions Do not start until you are told to do so. Solve

More information

Case Study: The Pelican Prototype Robot

Case Study: The Pelican Prototype Robot 5 Case Study: The Pelican Prototype Robot The purpose of this chapter is twofold: first, to present in detail the model of the experimental robot arm of the Robotics lab. from the CICESE Research Center,

More information

DETC IS THERE AN OPTIMAL CHOICE OF CONFIGURATION SPACE FOR LIE GROUP INTEGRATION SCHEMES APPLIED TO CONSTRAINED MBS?

DETC IS THERE AN OPTIMAL CHOICE OF CONFIGURATION SPACE FOR LIE GROUP INTEGRATION SCHEMES APPLIED TO CONSTRAINED MBS? Proceedings of the ASME 3 International Design Engineering Technical Conferences & Computers and Information in Engineering Conference IDETC/CIE 3 August -5, 3, Portland, OR, USA DETC3-5 IS THERE AN OPTIMAL

More information

Review of Lagrangian Mechanics and Reduction

Review of Lagrangian Mechanics and Reduction Review of Lagrangian Mechanics and Reduction Joel W. Burdick and Patricio Vela California Institute of Technology Mechanical Engineering, BioEngineering Pasadena, CA 91125, USA Verona Short Course, August

More information

Port-Hamiltonian Systems: from Geometric Network Modeling to Control

Port-Hamiltonian Systems: from Geometric Network Modeling to Control Port-Hamiltonian Systems: from Geometric Network Modeling to Control, EECI, April, 2009 1 Port-Hamiltonian Systems: from Geometric Network Modeling to Control, EECI, April, 2009 2 Port-Hamiltonian Systems:

More information

A Reduced Rank Kalman Filter Ross Bannister, October/November 2009

A Reduced Rank Kalman Filter Ross Bannister, October/November 2009 , Octoer/Novemer 2009 hese notes give the detailed workings of Fisher's reduced rank Kalman filter (RRKF), which was developed for use in a variational environment (Fisher, 1998). hese notes are my interpretation

More information

Lecture Schedule Week Date Lecture (M: 2:05p-3:50, 50-N202)

Lecture Schedule Week Date Lecture (M: 2:05p-3:50, 50-N202) J = x θ τ = J T F 2018 School of Information Technology and Electrical Engineering at the University of Queensland Lecture Schedule Week Date Lecture (M: 2:05p-3:50, 50-N202) 1 23-Jul Introduction + Representing

More information

Lecture I: Constrained Hamiltonian systems

Lecture I: Constrained Hamiltonian systems Lecture I: Constrained Hamiltonian systems (Courses in canonical gravity) Yaser Tavakoli December 15, 2014 1 Introduction In canonical formulation of general relativity, geometry of space-time is given

More information

THE purpose of this paper is to develop a bond graph

THE purpose of this paper is to develop a bond graph Modeling of Generic Offshore Vessel in Crane Operations with Focus on Strong Rigid Body Connections Børge Rokseth, Stian Skjong, and Eilif Pedersen Astract Both marine surface vehicles and underwater vehicles

More information

Port-Hamiltonian systems: network modeling and control of nonlinear physical systems

Port-Hamiltonian systems: network modeling and control of nonlinear physical systems Port-Hamiltonian systems: network modeling and control of nonlinear physical systems A.J. van der Schaft February 3, 2004 Abstract It is shown how port-based modeling of lumped-parameter complex physical

More information

Planar Rigid Body Kinematics Homework

Planar Rigid Body Kinematics Homework Chapter 2: Planar Rigid ody Kinematics Homework Chapter 2 Planar Rigid ody Kinematics Homework Freeform c 2018 2-1 Chapter 2: Planar Rigid ody Kinematics Homework 2-2 Freeform c 2018 Chapter 2: Planar

More information

138. Last Latexed: April 25, 2017 at 9:45 Joel A. Shapiro. so 2. iψ α j x j

138. Last Latexed: April 25, 2017 at 9:45 Joel A. Shapiro. so 2. iψ α j x j 138. Last Latexed: April 25, 2017 at 9:45 Joel A. Shapiro The Hamiltonian for a noninteracting fermion 1 is H = d 3 x H 1, with H 1 = iψ j α ψ j + mψ j βψ j j Chapter 13 Local Symmetry So far, we have

More information

ON FLATNESS OF NONLINEAR IMPLICIT SYSTEMS

ON FLATNESS OF NONLINEAR IMPLICIT SYSTEMS ON FLATNESS OF NONLINEAR IMPLICIT SYSTEMS Paulo Sergio Pereira da Silva, Simone Batista Escola Politécnica da USP Av. Luciano Gualerto trav. 03, 158 05508-900 Cidade Universitária São Paulo SP BRAZIL Escola

More information

Dynamics of Open Chains

Dynamics of Open Chains Chapter 9 Dynamics of Open Chains According to Newton s second law of motion, any change in the velocity of a rigid body is caused by external forces and torques In this chapter we study once again the

More information

SU(N) representations

SU(N) representations Appendix C SU(N) representations The group SU(N) has N 2 1 generators t a which form the asis of a Lie algera defined y the commutator relations in (A.2). The group has rank N 1 so there are N 1 Casimir

More information

Analytical Mechanics for Relativity and Quantum Mechanics

Analytical Mechanics for Relativity and Quantum Mechanics Analytical Mechanics for Relativity and Quantum Mechanics Oliver Davis Johns San Francisco State University OXPORD UNIVERSITY PRESS CONTENTS Dedication Preface Acknowledgments v vii ix PART I INTRODUCTION:

More information

Supporting Information. Dynamics of the Dissociating Uracil Anion. Following Resonant Electron Attachment

Supporting Information. Dynamics of the Dissociating Uracil Anion. Following Resonant Electron Attachment Supporting Information Dynamics of the Dissociating Uracil Anion Following Resonant Electron Attachment Y. Kawarai,, Th. Weer, Y. Azuma, C. Winstead, V. McKoy, A. Belkacem, and D.S. Slaughter, Department

More information

Hamilton-Jacobi theory on Lie algebroids: Applications to nonholonomic mechanics. Manuel de León Institute of Mathematical Sciences CSIC, Spain

Hamilton-Jacobi theory on Lie algebroids: Applications to nonholonomic mechanics. Manuel de León Institute of Mathematical Sciences CSIC, Spain Hamilton-Jacobi theory on Lie algebroids: Applications to nonholonomic mechanics Manuel de León Institute of Mathematical Sciences CSIC, Spain joint work with J.C. Marrero (University of La Laguna) D.

More information

An Explicit Formulation of Singularity-Free Dynamic Equations of Mechanical Systems in Lagrangian Form Part Two: Multibody Systems

An Explicit Formulation of Singularity-Free Dynamic Equations of Mechanical Systems in Lagrangian Form Part Two: Multibody Systems Moeng, Ientification an Control, Vol 33, No 2, 2012, pp 61 68 An Expcit Formulation of Singularity-Free Dynamic Equations of Mechanical Systems in Lagrangian Form Part Two: Multiboy Systems Pål Johan From

More information

(W: 12:05-1:50, 50-N202)

(W: 12:05-1:50, 50-N202) 2016 School of Information Technology and Electrical Engineering at the University of Queensland Schedule of Events Week Date Lecture (W: 12:05-1:50, 50-N202) 1 27-Jul Introduction 2 Representing Position

More information

GENERAL FORMULATION OF AN EFFICIENT RECURSIVE ALGORITHM BASED ON CANONICAL MOMENTA FOR FORWARD DYNAMICS OF CLOSED-LOOP MULTIBODY SYSTEMS

GENERAL FORMULATION OF AN EFFICIENT RECURSIVE ALGORITHM BASED ON CANONICAL MOMENTA FOR FORWARD DYNAMICS OF CLOSED-LOOP MULTIBODY SYSTEMS Proceedings of the XI DINAME, 28th February-4th March, 2005 - Ouro Preto - MG - Brazil Edited by D.A. Rade and V. Steffen Jr GENERAL FORMULATION OF AN EFFICIENT RECURSIVE ALGORITHM BASED ON CANONICAL MOMENTA

More information

1 Systems of Differential Equations

1 Systems of Differential Equations March, 20 7- Systems of Differential Equations Let U e an open suset of R n, I e an open interval in R and : I R n R n e a function from I R n to R n The equation ẋ = ft, x is called a first order ordinary

More information

= 0. = q i., q i = E

= 0. = q i., q i = E Summary of the Above Newton s second law: d 2 r dt 2 = Φ( r) Complicated vector arithmetic & coordinate system dependence Lagrangian Formalism: L q i d dt ( L q i ) = 0 n second-order differential equations

More information

DYNAMICS OF PARALLEL MANIPULATOR

DYNAMICS OF PARALLEL MANIPULATOR DYNAMICS OF PARALLEL MANIPULATOR The 6nx6n matrices of manipulator mass M and manipulator angular velocity W are introduced below: M = diag M 1, M 2,, M n W = diag (W 1, W 2,, W n ) From this definitions

More information

Impedance Control for a Free-Floating Robot in the Grasping of a Tumbling Target with Parameter Uncertainty

Impedance Control for a Free-Floating Robot in the Grasping of a Tumbling Target with Parameter Uncertainty Impedance Control for a Free-Floating Root in the Grasping of a Tumling Target with arameter Uncertainty Satoko Aiko, Roerto ampariello and Gerd Hirzinger Institute of Rootics and Mechatronics German Aerospace

More information

Robotics. Dynamics. Marc Toussaint U Stuttgart

Robotics. Dynamics. Marc Toussaint U Stuttgart Robotics Dynamics 1D point mass, damping & oscillation, PID, dynamics of mechanical systems, Euler-Lagrange equation, Newton-Euler recursion, general robot dynamics, joint space control, reference trajectory

More information

Lagrangian Dynamics. January 30, 2004

Lagrangian Dynamics. January 30, 2004 Lagrangian Dynamics Miloš Žefran and Francesco Bullo January 30, 2004 The motion of a mechanical system is related via a set of dynamic equations to the forces and torques it is subject to. In this work

More information

PHYSICS 110A : CLASSICAL MECHANICS

PHYSICS 110A : CLASSICAL MECHANICS PHYSICS 110A : CLASSICAL MECHANICS 1. Introduction to Dynamics motion of a mechanical system equations of motion : Newton s second law ordinary differential equations (ODEs) dynamical systems simple 2.

More information

Appell-Hamel dynamical system: a nonlinear test of the Chetaev and the vakonomic model

Appell-Hamel dynamical system: a nonlinear test of the Chetaev and the vakonomic model ZAMM Z. Angew. Math. Mech. 87, No. 10, 692 697 (2007) / DOI 10.1002/zamm.200710344 Appell-Hamel dynamical system: a nonlinear test of the Chetaev and the vakonomic model Shan-Shan Xu 1, Shu-Min Li 1,2,

More information

Physics 106b/196b Problem Set 9 Due Jan 19, 2007

Physics 106b/196b Problem Set 9 Due Jan 19, 2007 Physics 06b/96b Problem Set 9 Due Jan 9, 2007 Version 3: January 8, 2007 This problem set focuses on dynamics in rotating coordinate systems (Section 5.2), with some additional early material on dynamics

More information

Chapter 1 Lagrangian Dynamics

Chapter 1 Lagrangian Dynamics Robotics and Automation Handbook, (T. R. Kurfess, ed.), 2005 Chapter 1 Lagrangian Dynamics Miloš Žefran, University of Illinois at Chicago Francesco Bullo, University of Illinois at Urbana-Champaign The

More information

A Factorization Method for 3D Multi-body Motion Estimation and Segmentation

A Factorization Method for 3D Multi-body Motion Estimation and Segmentation 1 A Factorization Method for 3D Multi-body Motion Estimation and Segmentation René Vidal Department of EECS University of California Berkeley CA 94710 rvidal@eecs.berkeley.edu Stefano Soatto Dept. of Computer

More information

Superluminal Hidden Communication as the Underlying Mechanism for Quantum Correlations: Constraining Models

Superluminal Hidden Communication as the Underlying Mechanism for Quantum Correlations: Constraining Models 38 Brazilian Journal of Physics, vol. 35, no. A, June, 005 Superluminal Hidden Communication as the Underlying Mechanism for Quantum Correlations: Constraining Models Valerio Scarani and Nicolas Gisin

More information

Rigid bodies - general theory

Rigid bodies - general theory Rigid bodies - general theory Kinetic Energy: based on FW-26 Consider a system on N particles with all their relative separations fixed: it has 3 translational and 3 rotational degrees of freedom. Motion

More information

Integer Sequences and Circle Chains Inside a Circular Segment

Integer Sequences and Circle Chains Inside a Circular Segment Forum Geometricorum Volume 18 018) 47 55. FORUM GEOM ISSN 1534-1178 Integer Sequences and Circle Chains Inside a Circular Segment Giovanni Lucca Astract. We derive the conditions for inscriing, inside

More information

DESIGN SUPPORT FOR MOTION CONTROL SYSTEMS Application to the Philips Fast Component Mounter

DESIGN SUPPORT FOR MOTION CONTROL SYSTEMS Application to the Philips Fast Component Mounter DESIGN SUPPORT FOR MOTION CONTROL SYSTEMS Application to the Philips Fast Component Mounter Hendri J. Coelingh, Theo J.A. de Vries and Jo van Amerongen Dreel Institute for Systems Engineering, EL-RT, University

More information

Simple Examples. Let s look at a few simple examples of OI analysis.

Simple Examples. Let s look at a few simple examples of OI analysis. Simple Examples Let s look at a few simple examples of OI analysis. Example 1: Consider a scalar prolem. We have one oservation y which is located at the analysis point. We also have a ackground estimate

More information

A NEW HYBRID TESTING PROCEDURE FOR THE LOW CYCLE FATIGUE BEHAVIOR OF STRUCTURAL ELEMENTS AND CONNECTIONS

A NEW HYBRID TESTING PROCEDURE FOR THE LOW CYCLE FATIGUE BEHAVIOR OF STRUCTURAL ELEMENTS AND CONNECTIONS SDSS Rio 010 STABILITY AND DUCTILITY OF STEEL STRUCTURES E. Batista, P. Vellasco, L. de Lima (Eds.) Rio de Janeiro, Brazil, Septemer 8-10, 010 A NEW HYBRID TESTING PROCEDURE FOR THE LOW CYCLE FATIGUE BEHAVIOR

More information

Constrained motion and generalized coordinates

Constrained motion and generalized coordinates Constrained motion and generalized coordinates based on FW-13 Often, the motion of particles is restricted by constraints, and we want to: work only with independent degrees of freedom (coordinates) k

More information

A Normal Form for Energy Shaping: Application to the Furuta Pendulum

A Normal Form for Energy Shaping: Application to the Furuta Pendulum Proc 4st IEEE Conf Decision and Control, A Normal Form for Energy Shaping: Application to the Furuta Pendulum Sujit Nair and Naomi Ehrich Leonard Department of Mechanical and Aerospace Engineering Princeton

More information

Expansion formula using properties of dot product (analogous to FOIL in algebra): u v 2 u v u v u u 2u v v v u 2 2u v v 2

Expansion formula using properties of dot product (analogous to FOIL in algebra): u v 2 u v u v u u 2u v v v u 2 2u v v 2 Least squares: Mathematical theory Below we provide the "vector space" formulation, and solution, of the least squares prolem. While not strictly necessary until we ring in the machinery of matrix algera,

More information

ON COLISSIONS IN NONHOLONOMIC SYSTEMS

ON COLISSIONS IN NONHOLONOMIC SYSTEMS ON COLISSIONS IN NONHOLONOMIC SYSTEMS DMITRY TRESCHEV AND OLEG ZUBELEVICH DEPT. OF THEORETICAL MECHANICS, MECHANICS AND MATHEMATICS FACULTY, M. V. LOMONOSOV MOSCOW STATE UNIVERSITY RUSSIA, 119899, MOSCOW,

More information

Physics 6010, Fall 2016 Constraints and Lagrange Multipliers. Relevant Sections in Text:

Physics 6010, Fall 2016 Constraints and Lagrange Multipliers. Relevant Sections in Text: Physics 6010, Fall 2016 Constraints and Lagrange Multipliers. Relevant Sections in Text: 1.3 1.6 Constraints Often times we consider dynamical systems which are defined using some kind of restrictions

More information

Video 2.1a Vijay Kumar and Ani Hsieh

Video 2.1a Vijay Kumar and Ani Hsieh Video 2.1a Vijay Kumar and Ani Hsieh Robo3x-1.3 1 Introduction to Lagrangian Mechanics Vijay Kumar and Ani Hsieh University of Pennsylvania Robo3x-1.3 2 Analytical Mechanics Aristotle Galileo Bernoulli

More information

Dynamic Optimization of Geneva Mechanisms

Dynamic Optimization of Geneva Mechanisms Dynamic Optimization of Geneva Mechanisms Vivek A. Suan and Marco A. Meggiolaro Department of Mechanical Engineering Massachusetts Institute of Technology Camridge, MA 09 ABSTRACT The Geneva wheel is the

More information