Modeling and Motion Planning for Mechanisms on a Non-Inertial Base
|
|
- Brendan Brown
- 5 years ago
- Views:
Transcription
1 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 Duindam Jan T. Gravdahl 1 Shankar Sastry 1 Department of Eng. Cyernetics, Norwegian Univ. of Science and Technology, Trondheim, Norway Department of EECS, University of California, 53 Cory Hall, Berkeley, CA , USA {from,tommy.gravdahl}@itk.ntnu.no v.duindam@ieee.org sastry@eecs.erkeley.edu Astract Rootic manipulators on ships and platforms suffer from large inertial forces due to the non-inertial motion of the ship or platform. When operating in high sea state, operation of such manipulators can e made more efficient and roust if these non-inertial effects are taken into account in the motion planning and control systems. Motivated y this application, we present a rigorous and singularity-free formulation of the dynamics of a rootic manipulator mounted on a non-inertial ase. We extend the classical dynamics equations for a serial manipulator to include the -DoF motion of the non-inertial ase. Then, we show two examples of a 1-DoF and a -DoF manipulator to illustrate how these non-inertial effects can e taken into account in the motion planning. q q 1 q 3 q Ψ Ψ I. INTRODUCTION The use of unmanned and autonomous vehicles operating in hostile environments has shown oth to e cost efficient and to protect humans from potentially dangerous situations. One such hostile environment is high sea state. We look into the case when a manipulator mounted on a ship or a platform is required to operate independently of the sea state. Large inertial forces may influence the manipulator and make the operation inaccurate, extremely energy demanding, or impossile due to torque limits. The inertial forces thus need to e taken into account in oth the path planning and control of the root. Ships and oil platforms are expected to ecome increasingly unmanned in the future and hence the need for continuously operating roots for surveillance, maintenance, and operation will grow [1, [. All these tasks ecome increasingly important in harsh environments such as high sea state. To e ale to continue operation under these conditions, a good understanding is needed of the effects of the inertial forces due to the motion of the ship or platform. We therefore develop the dynamic equations of the rootic manipulator including these effects. Research on several related topics can e found in literature. Love et al. [1 addressed the impact of wave generated disturances on the tracking control of a manipulator mounted on a ship ased on the classical Lagrangian approach. Repetitive learning control was used and performance was improved for purely periodic motions, ut no formal derivation of the dynamics equations was presented. The use of cale roots for loading and unloading cargo etween two ships has also een addressed y Kitarovic et al. [ and Oh et al. [3. In the Ampelmann project [, a Stewart platform is mounted on a ship and is used to compensate Fig. 1. Model setup for a four-link root attached to a non-inertial ase with coordinate frame Ψ. Frame Ψ denotes the inertial reference frame. for the motion of the ship y keeping the platform still with respect to the world frame. Leans et al. [5 give a cursory description of a telerootic shipoard handling system, and Kosuge et al. [, [7 addresses the control of roots floating on the water utilizing vehicle restoring forces. Other related research areas are macro/micro manipulators [, [9, underwater vehicle/manipulator systems [1 and spacecraft/manipulator systems [11. Most previous work deals with roots mounted on a free-floating ase. There is, however, an important difference etween modeling a root on a forced and a free-floating ase. A forced ase motion will add inertial forces to the dynamic equations that do not arise in free-floating case, such as spacecraft/manipulator systems and manipulators on small AUVs. Our approach differs from previous work in that the dynamic equations are derived for rigid multiody systems including oth Euclidean joints and generalized joints with configuration spaces different from R n. We follow the generalized Lagrangian approach presented in Duindam et al. [1, [13, which allows us to comine the Euclidean joints (the manipulator) and more general joints (the ase), i.e. joints that can e descried y the Lie group SE(3) or one of its ten sugroups. In our case, the transformation from the inertial frame to the ase frame (the platform) is represented as a free motion joint descried y the Lie group SE(3). We also show through the examples how the ase motion can e expressed as sugroups of SE(3), in our case SO(). For marine vessels in high sea state, very large inertial /9/$5. 9 IEEE 33
2 forces are added to the manipulator dynamics. To illustrate the effect of the inertial forces and how these appear in the root equations, we look into the prolem of finding the optimal trajectory in terms of actuator torque. There are many motivations for doing this. First of all the wear and tear on the manipulator is reduced and, for cooperative manipulation, the possiility of reaking an oject manipulated y two roots is also reduced. Secondly, the solution is more energy efficient as the inertial forces will, if possile, contriute to the desired motion instead of working against it. The final motivation is that a good understanding of the effects of the inertial forces on the dynamic equations is essential in tasks that require high accuracy and the need to compensate for these effects [1. We assume that the motion of the free moving ase is forced externally y forces unknown to us and that the pose, velocity, and acceleration of the ase relative to the inertial world are known for all times. This means we also assume that the motion of the root does not influence the motion of the ase. The motion of the ase will add inertial forces to the dynamics equations of the root and the pose of the ase will influence the gravitational forces acting on each link. Finally, we assume the root to e an ideal rigid frictionless mechanism with purely torque driven actuators. Given these assumptions, we consider the following two prolems: first, we derive the dynamic equations descriing the motion of the root under the influence of the non-inertial ase motion. Second, we consider the path planning prolem of finding the trajectory etween two given configurations for a given ase motion. Intuitively, the optimal solution is the trajectory for which the inertial forces help accelerate and decelerate the root as much as possile, such that little control torque is required. II. MULTIBODY DYNAMICS WITH A NON-INERTIAL BASE We extend the classical dynamics equations for a serial manipulator arm with 1-DoF joints to include the forced - DoF motion of the non-inertial ase. A. Manipulator kinematics on a non-inertial ase Consider the setup of Figure 1 descriing a general n-link root manipulator arm attached to a moving ase. Choose an inertial coordinate frame Ψ, a frame Ψ rigidly attached to the moving ase, and n frames Ψ i (not shown) attached to each link i at the center of mass with axes aligned with the principal directions of inertia. Finally, choose a vector q R n that descries the configuration of the n joints. Using standard notation [1, we can descrie the pose of each frame Ψ i relative to Ψ as a homogeneous transformation matrix g i SE(3) of the form [ Ri p g i i R (1) 1 with rotation matrix R i SO(3) and translation vector p i R 3. This pose can also e descried using the vector of joint coordinates q as g i g g i g g i (q) () The ase pose g and the joint positions q thus fully determine the configuration state of the root. In a similar way, the spatial velocity of each link can e expressed using twists [1: [ Vi v i V + Vi ( Ad g V + J i (q) ) (3) ω i where vi and ωi are the linear and angular velocities, respectively, of link i relative to the inertial frame, J i (q) R n is the geometric Jacoian of link i relative to Ψ, the adjoint is defined as Ad g : [ R ˆpR R R, and ˆp R 3 3 is the skew symmetric matrix such that ˆpx p x for all p,x R 3. The velocity state is thus fully determined given the twist V of the ase and the joint velocities. B. Manipulator dynamics on a non-inertial ase The previous section shows how the kinematics of the system can e naturally descried in terms of the (gloal) state variales g, q, V, and. We now derive the dynamics equations for the system in terms of these state variales. We first assume the ase to e free-moving under the influence of some prescried external wrench F, and then restrict the ase motion to e kinematically constrained. To derive the dynamics of the complete mechanism (including the -DoF etween Ψ and Ψ ), we follow the generalized Lagrangian method introduced y Duindam et al. [1, [13. This method gives the dynamics equations for a general mechanism descried y a set Q {Q i } of configuration states Q i (not necessarily Euclidean), a vector v of velocity states v i R ni, and several mappings that descrie the local Euclidean structure of the configuration states and their relation to the velocity states. More precisely, the neighorhood of every state Q i is locally descried y a set of Euclidean coordinates φ i R ni as Q i Q i ( Q i,φ i ) with Q i ( Q i,) Q i, and there exist differentiale matrices S i such that we can write v i S i (Q i,φ i ) φ i for every Q i. Given a mechanism with coordinates formulated in this generalized form, we can write its kinetic energy as U k (Q,v) 1 vt M(Q)v with M(Q) the inertia matrix in coordinates Q. The dynamics of this system then satisfy M(Q) v + C(Q,v)v τ () with τ the vector of gravitational, friction, and other external torques (collocated with v), and C(Q,v) the matrix descriing Coriolis and centrifugal forces and given y C ij (Q,v) : ( Mij S 1 kl 1 ) M jl φ k S 1 ki v l φ k k,l φ + ( ( S 1 Smj mi S ) kl) (5) ms S 1 sk φ s φ M v l j φ k,l,m,s More details and proofs can e found in references [1 and [13. To apply this general result to systems of the form of Figure 1, we write Q {g,q} as the set of configuration states, and v [ V as the vector of velocity states. 331
3 The local Euclidean structure for the state g is given y exponential coordinates [1, while the state q is gloally Euclidean of itself. Mathematically, we can express configurations (g,q) around a fixed state (ḡ, q) as g ḡ exp j (φ ) j () j1 q i q i + φ i i {1,...,n} (7) with j the standard asis elements of the Lie algera se(3). The corresponding matrices S i can e collected in one lockdiagonal matrix S given y [15 [( I 1 S(Q,φ) ad φ + 1 ad φ... ) I [ ˆp... ˆp ˆp... R (+n) (+n) with ad p R for p R. This shows that the choice of coordinates (Q,v) has the required form. From expression (3) for the twist of each link in the mechanism, we can derive an expression for the total kinetic energy. Let I i R denote the constant positive-definite diagonal inertia tensor of link i expressed in Ψ i. The kinetic energy U k,i of link i then follows as U k,i 1 ( ) V i T i Ii Vi i 1 ( V + J i (q) ) T ( Ad T gi I i Ad gi V + J i (q) ) 1 [ (V ) [ T V T M i (q) 1 vt M i (q)v () with [ Ad T M i (q) : I gi i Ad gi Ad T g I i i Ad J gi i Ji T Ad T g i I i Ad gi Ji T Ad T g i I i Ad gi J i The total kinetic energy of the mechanism is given y the sum of the kinetic energies of the mechanism links and the non-inertial ase, that is, ( U k (q,v) 1 [I ) vt + M i (q) v (1) i1 inertia matrix M(q) with M(q) the inertia matrix of the total system. Note that neither U k (q,v) nor M(q) depend on the pose g and hence the choice of inertial reference frame Ψ. We can write () in lock-form as follows [ MV V M T qv M qv M qq [ V q [ CV + V CV q C qv Cqq [ V [ F τ (9) (11) with F the external wrench on the ase link, expressed in coordinates Ψ (such that it is collocated with the twist V ). To compute the matrix C(Q,v) for our system, we can use the oservations that M(q) is independent of g, that S(Q,φ) is independent of q, and that S(Q,) I. Furthermore, the partial derivative of M with respect to φ is zero since M is independent of g, and the second term of (5) is only non-zero for the C V V lock of C(Q,v). 33 The precise computational details of the partial derivatives follow the same steps as in the classical approach [1. To compute the partial derivatives of the adjoint matrices, one can use a relatively simple relation. If we express the velocity of joint k as V (k 1) (k 1)k X k k for constant X k, then the following holds: Ad gij q k Ad gi(k 1) ad Xk Ad g(k 1)j for i < k j Ad gi(k 1) ad Xk Ad g(k 1)j for j < k i otherwise To prove this, we start y writing out the spatial velocity of frame Ψ k with respect to Ψ (k 1) when i < k j: (k 1) ˆX k k ˆV (k 1)k ġ (k 1)kg 1 (k 1)k g (k 1)k g k(k 1) k q k where ˆX [ : ˆXω X v. If we compare the first and the last terms, we get R (k 1)k q ˆX ω R (k 1)k, k (1) p (k 1)k q ˆX ω p (k 1)k + X v. k (13) We can use this relation in the expression for the partial derivative of Ad g(k 1)k : [ R(k 1)k ˆp Ad (k 1)k R g(k 1)k q k q k R (k 1)k +ˆp (k 1)k (k 1)k q k R q (k 1)k q [ [ k ˆXω ˆXv R(k 1)k ˆp (k 1)k R (k 1)k ˆXω R (k 1)k ad Xk Ad g(k 1)k (1) It is now straight forward to show that Ad gij q k Similarly when j < k i. Ad g(k 1)k Ad gi(k 1) Ad gkj q k Ad gi(k 1) ad Xk Ad g(k 1)k Ad gkj Ad gi(k 1) ad Xk Ad g(k 1)j. (15) C. Manipulator dynamics on a forced non-inertial ase We now simplify and specialize the dynamics equations y assuming that the motion of the platform is fully determined y external forces that are neither known nor of interest. We only assume that the relative pose g, velocity V, and acceleration V of the ase relative to the inertial world are known from measurements. This implicitly implies that the torques applied to the internal root joints do not influence the motion of the platform, which is a reasonale assumption in our application of a relatively small root attached to a large moving ase. Since we are not interested in the external forces on the mechanism, we can consider just the second lock-row of (11), which expresses the root accelerations q as a function
4 of the joint torques τ as well as the non-inertial motion of the ase. This can e rewritten as M qq q + C qq + M qv V + C qv V τ (1) inertial forces which partially separates the usual root dynamics (first two terms) from the inertial forces (third and fourth term), although the matrix C qq generally still depends on V. For a static ase frame (V ), the equations reduce to the regular dynamics of an n-link rootic mechanism. Note that for constant V, the terms due to the non-inertial ase motion generally do not drop out, since a constant twist can also contain (non-inertial) angular components. Note also that neither the inertia of the ase nor the second term in (5) appear in these equations. The terms C qv and C qq can e written more explicitly as C qv C qq k1 k1 M qv q k k 1 T q M qq q k k 1 T q ( [MV V M T qv ( [MqV M T qq [ V [ V ) ) This approach can e used to otain the dynamics equations for an aritrary n-link mechanism attached to a non-inertial ase. Specific examples are presented in Section IV. D. Gravitational forces Finally we include the gravitational forces. Let the wrench associated with the gravitational force of link i with respect to coordinate frame Ψ i e given y [ [ Fg i fg Ri e ˆr gf i m i g z g ˆr gr i (17) i e z where e z [ 1 T and r i g is the center of mass of link i expressed in frame Ψ i. In our case Ψ i is chosen so that r i g is in the origin of Ψ i so we have r i g. The equivalent joint torque associated with link i is given y τ i g J i (q)ad T g i (Q)F i g(q) (1) where J i is the geometric Jacoian and Ad gi Ad g Ad gi is the transformation from the inertial frame to frame i. We note that oth R i and Ad gi depend on the ase configuration with respect to the inertial frame. The total effect of the gravity from all the links is then given y τ g n i1 τi g which enters Equation (1) the same way as the control torque. III. COMPENSATION USING MOTION PLANNING In general there are two ways to deal with the inertial forces. We can try to compensate for the effects in the controller or in the motion planning algorithm. In the first method we cancel the effects of the inertial forces in the feed-forward terms of the controller. Consider the control law τ τ ff + τ PD (19) where τ ff M qq q d + C qq d tracking terms n1 (J i Ad T g i F i g) } {{ } gravity compensation τ PD K P (q d q) + K D ( d ) PD-controller + M qv V + C qv V compensation for inertial forces () (1) This is the standard augmented PD control law which in our case also compensates for the inertial forces. As we are mainly interested in the feed-forward terms, we will assume perfect tracking, i.e. q(t) q d (t). With this control law the non-inertial and gravitational terms are regarded as disturances and are canceled. When large inertial forces are present, canceling these terms may e very energy demanding. Thus, instead of regarding these terms as disturances, we will find the trajectory for which the non-inertial and gravitational terms coincide with the tracking terms to an as large extent as possile. In doing this, the inertial forces will contriute to the desired motion instead of working against it. This will reduce the wear and tear on the manipulator, require less actuator torques and allow more accurate manipulation. Given the dynamic equations, the initial position q, and desired end position q des in joint coordinates, we want to find the optimal trajectory given y the minimum of the cost function P, i.e. T1 P min min P(τ)dt () q(t) tt where P(τ) is some cost function representing the torque required for the motion, q(t ) q, q(t 1 ) q des, (3) are the vectors descriing the initial and end positions of all the joints and M qq q + C qq + M qv V + C qv V τ g τ () determines the dynamics of the system. The gloal solution to this prolem is generally very complex. Assuming g, V (t) and V (t) known, we first need to compute M qq (q), Cqq (q,,v ), M qv (q) and C qv (q,,v ). Then we need to find the optimal trajectory (q(t), (t), q(t)) which requires the least amount of torque. Both these operations are computationally very demanding. IV. EXAMPLES We now present specific examples of how the previous modeling and planning methods can e applied in case of specific root motion ojectives and given ase motion. Here, we make specific choices as to how to discretize and approximate the prolem to make it solvale; future work will investigate different and more general approaches. 333
5 A. Parameterization of joint motion To reduce the search space, we assume that the shape of each joint trajectory is given so that we only need to find the starting time and the length of the motion for each joint. We also consider a cost function P(τ) that is quadratic in τ and thus reduce the prolem to T1 P min min τ T Dτ dt (5) t,t 1 tt where D is a positive definite matrix that defines a metric in τ-space, t [ t 1, t i, t n, T are the starting times and t 1 [ t 1,1 t i,1 t n,1 T are the end times for the n joints, which can all e chosen independently, with the restriction that T t i, < t i,1 T 1 for all i and for a fixed prescried time interval (T,T 1 ). We choose sinusoidal joint motions given y q i (t) a i sin( i (t t i, )), i (t) a i i a i i cos ( i (t t i, )), q i (t) q i, + a i (t t i, ) a i i sin ( i (t t i, )), () i for t (t i,,t i,1 ) and q i (t) constant otherwise. The oundary conditions q i (t i, ) q i, and q i (t i,1 ) q i,des give rise to the following two equations a i (q i,des q i, ) i π i π t i,1 t i, (7) C. 1-DoF manipulator Consider first a mechanism with a single 1-DoF prismatic joint located at p 1 [ l 1 T in Ψ and moving in the direction of the y-axis. Let the ase motion e given as in (). We set m 1 and the dynamics equations reduce to τ dt τ q l 1 φ q φ g sin(φ). (9) t Fig.. The torques needed to move the prismatic joint from q to q des 1.5 for high frequency ase motion φ(t) 1/5 sin (t) plotted with respect to the start time t and the motion length t t 1 t. The minima found are marked with an X t and hence the motion is fully parameterized y t i, and t i,1 for given q and q des. The motion planning prolem is thus reduced to finding the optimal time intervals (t i,,t i,1 ) for all joints i 1,...,n. B. Base motion The environmental disturances that affect the platform motion are wind, waves and ocean currents. The ocean currents are low frequency disturances and will not affect the manipulator dynamics. It is common to assume the principle of superposition when considering wave and wind disturances [1 and they are normally modeled in the frequency spectrum. Many good models of the ship motion for different sea states are availale in literature [1, [17. The platform motion is modeled as g (t) SE(3). Large marine vessels are often found to have a characteristic motion which we can represent as a vector suspace of se(3). For the purpose of this paper, we will estimate the main angular motion of the platform somewhat roughly y a sinusoidal motion in SO(). Assume that the waves hit the platform with a velocity in the direction of the y-axis in Ψ. The platform pose and acceleration are then given y an angular motion aout the x-axis: φ Asin (Bt) () This is a simplified motion, ut the dynamic equations are valid for any motion in SE(3). Specific examples of how this ase motion affects the manipulator motion are shown in the following. 33 Fig. 3. Optimal and worst case trajectories. The required torque is the total torque required for the desired joint motion, which is the sum of the actuator and the inertial torques. The actuator torque is the torque applied y the actuator so that the total torque is equal to the required torque, i.e. the inertial torques sutracted from the required torque. This is the torque to e minimized. The optimal interval is found at t [ The worst case is found at t [ The integrated torque (squared) for the optimal solution is.7 and 11.3 for the worst case. As the length of the motion increases ( t increases in Figure ), the integrated torque increases unounded, thus the worst case starting point search is performed with a fixed motion length of.s. We start y approximating the ase motion given in () y the Taylor approximation sin (x) x x3 3! + x5 5! x7 7! + O(x9 ). (3)
6 We can write φ(t), φ(t) and φ(t) as ) φ(t) A (Bt (Bt)3 + (Bt)5 (Bt)7 + O(t 9 ), 3! 5! 7! ) φ(t) AB (1 (Bt) + (Bt) (Bt) + O(t ),!!! ( φ(t) AB (Bt) ) + (Bt)3 (Bt)5 + O(t 7 ). 1! 3! 5! This is typically a good approximation for one period of sinusoidal motion. We approximate the desired joint motion given y () in the same way. As we have only one joint we set t T and t 1 T 1. The minimization prolem is then reduced to t1 P min min ( q l 1 φ q φ g sin(φ)) dt (31) t,t 1 t which after sustituting the Taylor approximations reduces to the prolem of finding the minimum of a polynomial equation. We can now quickly find the optimal solution with respect to the start and end times t and t 1. We define the search space as the time interval for which the Taylor approximation is accurate, i.e., (t,t 1 ) ( t T,t T ) where t T is the wave period of the principal frequency of the waves. Figure illustrates the value of the integral (31) for different start and end times for φ(t) 1/5sin (t), q and q des 1.5. The optimal and worst case trajectories are shown in Figure 3. D. -DoF manipulator The previous example can e solved efficiently as it reduces to finding the minimum of a polynomial equation. As a second example, we show how numerical methods can e used to compute optimal motion paths for the - DoF manipulator shown in Figure 1 with realistic mass and inertia parameters. We now use the exact equations for ase motion and the manipulator dynamics. The ase moves along the angular motion pattern () at a relatively low frequency, which means the inertial forces mostly enter through a changing direction of gravity. We solve the motion planning prolem y numerically minimizing the ojective function () and parameterize the prolem as follows: each joint trajectory is given y a separate sinusoidal motion () with parameters t i, and t i,1, the total motion from start to goal is to e finished within a fixed prescried time interval (T,T 1 ) (,1), and the cost function is chosen as (5) with D 1 I and integrated over the fixed time interval (T,T 1 ). We choose the start and end configurations as q() [.5 T q(t) [.5 π π π T and the ase motion as () with A 5 π and B π 5. The motion planning prolem thus amounts to finding the eight parameters (one start and end time for each joint) that minimize the total squared required torque integrated over a t t t t t t 1 Fig.. Still shots from the simulation of the fully optimized trajectory corresponding to the solid lines in Figure 5. fixed time interval while starting and finishing the root in the required configurations. Figures and 5 show the solution otained using Matla s constrained minimization function fmincon. A full animation of the resulting motions can e found in the video accompaniment to this paper. Figure shows still shots of the optimal solution and illustrates the sinusoidal motion of the ase. Figure 5 compares three solutions: one aseline solution that simply takes the start time for each joint trajectory at t i, T and the finish time at t i,1 T 1, one solution that optimizes the cost function assuming zero ase motion (a horizontal stationary ase), and one solution that optimizes the cost function taking the real ase motion into account. The associated costs are 19, 1, and 11, respectively. The figure shows that, for this example, taking the ase motion into account can significantly reduce the cost and hence the required torque. The joint motions optimized for a static ase (dashed line) even perform worse than the aseline joint motions (dotted line) when applied during non-static ase motion. When optimizing the joint motions while taking the ase motion into account (solid line), the result is much improved, and the enefit of the resulting motions can e understood intuitively: the prismatic motion is delayed and shortened as to optimally use the changing gravity direction (due to ase rotation) in the acceleration and deceleration 335
7 q q q q 1.5 (a) Joint trajectories (m,rad) τ 1 τ 5 τ τ () Required joint torques (N,Nm). Fig. 5. Optimal motion trajectory for a -DoF manipulator. Three different trajectories are shown: a aseline trajectory with maximum motion duration (dotted lines), an optimized trajectory assuming zero ase motion (dashed lines), and an optimized trajectory taking the correct non-zero ase motion into account (solid lines). phase, similar to the previous 1-DoF example. The resulting required actuator torque τ 1 is thus reduced to close to zero during the motion, i.e., in the time interval (t 1,,t 1,1 ) (3.,7.). Similarly, the motion of joints 3 and is delayed as to minimize the amount of time spent holding up the links against gravity. The example shows how knowledge of the ase motion can e used to significantly reduce torque requirements, even with only little freedom in the optimization (only t i, and t i,1 can e optimized). If the shapes of the trajectories are allowed to e changed and optimized in more detail, improvement should e even more significant. Including more parameters makes the optimization prolem more complex, though, and numerical solutions may get more easily trapped in local minima. V. CONCLUSIONS The classical dynamics equations for a serial manipulator have een extended to also include the motion of a forced non-inertial ase. The dynamics equations are derived using a generalized Lagrangian method. This allows us to model the ase motion as a free motion joint serially connected with the 1-DoF joints of the manipulator. Examples for a 1-DoF and -DoF manipulator mounted on a platform are presented. We include the platform motion in the dynamics and find the trajectory that takes the manipulator from an initial position to an end position with the least amount of torque and compare this with the optimal trajectory when the platform is assumed not to e moving. The simulations show that when the ship motion is known the amount of torque needed for a given task can e sustantially reduced if the inertial forces are taken into account. A possile extension for future work is to optimize the shape of the joint trajectories with more variales. Adding more details to the joint trajectories should increase performance even more. If a sufficiently accurate model of the platform can e otained, this may allow us to compensate for the inertial forces in high accuracy applications. Another interesting topic for future work is to look into how model predictive control can e used to compensate for the platform motion. ACKNOWLEDGMENTS The first and third authors wish to acknowledge the support of the Norwegian Research Council and the TAIL IO project for their continued funding and support for this research. The TAIL IO project is an international cooperative research project led y StatoilHydro and an R&D consortium consisting of ABB, IBM, Aker Kvaerner and SKF. During the work with this paper the first author was with the University of California at Berkeley. The second author is sponsored through a Ruicon grant from the Netherlands Organization for Scientific Research (NWO). REFERENCES [1 L. J. Love, J. F. Jansen, and F. G. Pin, On the modeling of roots operating on ships, IEEE International Conference on Rootics and Automation, vol. 3, pp. 3 3,. [ J. Kitarovic, V. Tomas, and D. Čišic, The electronic and informatics age - a new stage in developing highly effective ships, 7th International ELMAR Symposium, pp. 35 3, 5. [3 S.-R. Oh, K. Mankala, S. Agrawal, and J. Alus, Dynamic modeling and roust controller design of a two-stage parallel cale root, IEEE International Conference on Rootics and Automation, vol., pp ,. [ D. C. Salzmann, Ampelmann prototype - developing a motion compensating platform for offshore access, European Wind Energy Conference, 7. [5 G. Leans, K. Wilkie, R. Duay, D. Cratree, and T. Edmonds, Telerootic shipoard handling system, OCEANS, vol., pp , [ K. Kosuge, M. Okuda, and T. Fukuda, Motion control of manipulator/vehicle system floating on water, Proc. of nd IEEE Int l Workshop on Advanced Motion Control, pp. 11 1, 199. [7 H. Kajita and K. Kosuge, Force control of root floating on the water utilizing vehicle restoring force, IEEE/RSJ International Conference on Intelligent Root and Systems, vol. 1, pp. 1 17, [ T. Yoshikawa, K. Harada, and A. Matsumoto, Hyrid position/force control of flexile-macro/rigid-micro manipulator systems, IEEE Transactions on Rootics and Automation, vol. 1, no., pp. 33, 199. [9 A. Bowling and O. Khati, Design of macro/mini manipulators for optimal dynamic performance, Proc. IEEE International Conference on Rootics and Automation,, vol. 1, pp. 9 5, [1 S. McMillan, D. E. Orin, and R. B. McGhee, Efficient dynamic simulation of an underwater vehicle with a rootic manipulator, IEEE Transactions on systems, man and cyernetics, vol. 5, no., pp , [11 O. Egeland and J. R. Sagli, Coordination of motion in a spacecraft/manipulator system, International Journal of Rootics Research, vol. 1 no., pp , [1 V. Duindam and S. Stramigioli, Lagrangian dynamics of open multiody systems with generalized holonomic and nonholonomic joints, in Proceedings of the IEEE/RSJ International Conference on Intelligent Roots and Systems, Octoer 7, pp [13, Singularity-free dynamic equations of open-chain mechanisms with general holonomic and nonholonomic joints, IEEE Transactions on Rootics, vol., no. 3, pp , June. [1 R. M. Murray, Z. Li, and S. S. Sastry, A Mathematical Introduction to Rootic Manipulation. CRC Press, 199. [15 V. Duindam, Port-ased modeling and control for efficient ipedal walking roots, Ph.D. dissertation, University of Twente, March. [Online. Availale: [1 T. I. Fossen, Marine Control Systems, 3rd printing. Marine Cyernetics,. [17 N. Salvesen, E. O. Tuck, and O. M. Faltinsen, Ship motions and sea loads, Trans SNAME, vol. 7, p. 57,
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 informationLagrangian Dynamics of Open Multibody Systems with Generalized Holonomic and Nonholonomic Joints
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
More informationAutonomous Underwater Vehicles: Equations of Motion
Autonomous Underwater Vehicles: Equations of Motion Monique Chyba - November 18, 2015 Departments of Mathematics, University of Hawai i at Mānoa Elective in Robotics 2015/2016 - Control of Unmanned Vehicles
More informationPort-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 informationMultibody 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 informationTrajectory-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 informationCase 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 informationModel Reference Adaptive Control of Underwater Robotic Vehicle in Plane Motion
Proceedings of the 11th WSEAS International Conference on SSTEMS Agios ikolaos Crete Island Greece July 23-25 27 38 Model Reference Adaptive Control of Underwater Robotic Vehicle in Plane Motion j.garus@amw.gdynia.pl
More informationImpedance 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 informationArtificial 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 informationDynamics. 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 informationq 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 informationLecture 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 informationRobot 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 informationIn 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 information1 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 informationComments on A Time Delay Controller for Systems with Uncertain Dynamics
Comments on A Time Delay Controller for Systems with Uncertain Dynamics Qing-Chang Zhong Dept. of Electrical & Electronic Engineering Imperial College of Science, Technology, and Medicine Exhiition Rd.,
More informationExperimental Comparison of Adaptive Controllers for Trajectory Tracking in Agricultural Robotics
Experimental Comparison of Adaptive Controllers for Trajectory Tracking in Agricultural Rootics Jarle Dørum, Tryve Utstumo, Jan Tommy Gravdahl Department of Engineering Cyernetics Norwegian University
More information(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 informationDynamics. 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 informationMultibody 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 informationDESIGN 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 informationRobotics & Automation. Lecture 06. Serial Kinematic Chain, Forward Kinematics. John T. Wen. September 11, 2008
Robotics & Automation Lecture 06 Serial Kinematic Chain, Forward Kinematics John T. Wen September 11, 2008 So Far... We have covered rigid body rotational kinematics: representations of SO(3), change of
More informationDYNAMICS 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 informationOperational 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 informationPHYS 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 informationReal-time Motion Control of a Nonholonomic Mobile Robot with Unknown Dynamics
Real-time Motion Control of a Nonholonomic Mobile Robot with Unknown Dynamics TIEMIN HU and SIMON X. YANG ARIS (Advanced Robotics & Intelligent Systems) Lab School of Engineering, University of Guelph
More information10 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 informationPHYS 705: Classical Mechanics. Euler s Equations
1 PHYS 705: Classical Mechanics Euler s Equations 2 Euler s Equations (set up) We have seen how to describe the kinematic properties of a rigid body. Now, we would like to get equations of motion for it.
More informationDYNAMICS 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 informationSection 8.5. z(t) = be ix(t). (8.5.1) Figure A pendulum. ż = ibẋe ix (8.5.2) (8.5.3) = ( bẋ 2 cos(x) bẍ sin(x)) + i( bẋ 2 sin(x) + bẍ cos(x)).
Difference Equations to Differential Equations Section 8.5 Applications: Pendulums Mass-Spring Systems In this section we will investigate two applications of our work in Section 8.4. First, we will consider
More informationRobust Control of Cooperative Underactuated Manipulators
Robust Control of Cooperative Underactuated Manipulators Marcel Bergerman * Yangsheng Xu +,** Yun-Hui Liu ** * Automation Institute Informatics Technology Center Campinas SP Brazil + The Robotics Institute
More informationIntroduction 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 informationIn 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 informationKinematics. 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 informationThe Dynamics of Fixed Base and Free-Floating Robotic Manipulator
The Dynamics of Fixed Base and Free-Floating Robotic Manipulator Ravindra Biradar 1, M.B.Kiran 1 M.Tech (CIM) Student, Department of Mechanical Engineering, Dayananda Sagar College of Engineering, Bangalore-560078
More informationNonlinear PD Controllers with Gravity Compensation for Robot Manipulators
BULGARIAN ACADEMY OF SCIENCES CYBERNETICS AND INFORMATION TECHNOLOGIES Volume 4, No Sofia 04 Print ISSN: 3-970; Online ISSN: 34-408 DOI: 0.478/cait-04-00 Nonlinear PD Controllers with Gravity Compensation
More informationBase Force/Torque Sensing for Position based Cartesian Impedance Control
Base Force/Torque Sensing for Position ased Cartesian Impedance Control Christian Ott and Yoshihiko Nakamura Astract In this paper, a position ased impedance controller i.e. admittance controller is designed
More informationDifferential 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 informationDynamics. 1 Copyright c 2015 Roderic Grupen
Dynamics The branch of physics that treats the action of force on bodies in motion or at rest; kinetics, kinematics, and statics, collectively. Websters dictionary Outline Conservation of Momentum Inertia
More information8.012 Physics I: Classical Mechanics Fall 2008
MIT OpenCourseWare http://ocw.mit.edu 8.012 Physics I: Classical Mechanics Fall 2008 For information about citing these materials or our Terms of Use, visit: http://ocw.mit.edu/terms. MASSACHUSETTS INSTITUTE
More informationA Sliding Mode Controller Using Neural Networks for Robot Manipulator
ESANN'4 proceedings - European Symposium on Artificial Neural Networks Bruges (Belgium), 8-3 April 4, d-side publi., ISBN -9337-4-8, pp. 93-98 A Sliding Mode Controller Using Neural Networks for Robot
More informationAdaptive Robust Tracking Control of Robot Manipulators in the Task-space under Uncertainties
Australian Journal of Basic and Applied Sciences, 3(1): 308-322, 2009 ISSN 1991-8178 Adaptive Robust Tracking Control of Robot Manipulators in the Task-space under Uncertainties M.R.Soltanpour, M.M.Fateh
More informationEffect of Uniform Horizontal Magnetic Field on Thermal Instability in A Rotating Micropolar Fluid Saturating A Porous Medium
IOSR Journal of Mathematics (IOSR-JM) e-issn: 78-578, p-issn: 39-765X. Volume, Issue Ver. III (Jan. - Fe. 06), 5-65 www.iosrjournals.org Effect of Uniform Horizontal Magnetic Field on Thermal Instaility
More informationA 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 informationMulti-Robotic Systems
CHAPTER 9 Multi-Robotic Systems The topic of multi-robotic systems is quite popular now. It is believed that such systems can have the following benefits: Improved performance ( winning by numbers ) Distributed
More informationThe Virtual Linkage: A Model for Internal Forces in Multi-Grasp Manipulation
The Virtual Linkage: A Model for Internal Forces in Multi-Grasp Manipulation David Williams Oussama Khatib Robotics Laboratory Department of Computer Science Stanford University Stanford, California 94305
More informationMEAM 520. More Velocity Kinematics
MEAM 520 More Velocity Kinematics Katherine J. Kuchenbecker, Ph.D. General Robotics, Automation, Sensing, and Perception Lab (GRASP) MEAM Department, SEAS, University of Pennsylvania Lecture 12: October
More informationVideo 1.1 Vijay Kumar and Ani Hsieh
Video 1.1 Vijay Kumar and Ani Hsieh 1 Robotics: Dynamics and Control Vijay Kumar and Ani Hsieh University of Pennsylvania 2 Why? Robots live in a physical world The physical world is governed by the laws
More informationRobotics & Automation. Lecture 25. Dynamics of Constrained Systems, Dynamic Control. John T. Wen. April 26, 2007
Robotics & Automation Lecture 25 Dynamics of Constrained Systems, Dynamic Control John T. Wen April 26, 2007 Last Time Order N Forward Dynamics (3-sweep algorithm) Factorization perspective: causal-anticausal
More informationLecture 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 informationLinear Feedback Control Using Quasi Velocities
Linear Feedback Control Using Quasi Velocities Andrew J Sinclair Auburn University, Auburn, Alabama 36849 John E Hurtado and John L Junkins Texas A&M University, College Station, Texas 77843 A novel approach
More informationPolynomial Degree and Finite Differences
CONDENSED LESSON 7.1 Polynomial Degree and Finite Differences In this lesson, you Learn the terminology associated with polynomials Use the finite differences method to determine the degree of a polynomial
More informationExponential Controller for Robot Manipulators
Exponential Controller for Robot Manipulators Fernando Reyes Benemérita Universidad Autónoma de Puebla Grupo de Robótica de la Facultad de Ciencias de la Electrónica Apartado Postal 542, Puebla 7200, México
More informationDistributed control of "ball on beam" system
XI International PhD Workshop OWD 29, 17 2 Octoer 29 Distriuted control of "all on eam" system Michał Ganois, University of Science and Technology AGH Astract This paper presents possiilities of control
More informationNonholonomic 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 informationPredictive Control of Gyroscopic-Force Actuators for Mechanical Vibration Damping
ARC Centre of Excellence for Complex Dynamic Systems and Control, pp 1 15 Predictive Control of Gyroscopic-Force Actuators for Mechanical Vibration Damping Tristan Perez 1, 2 Joris B Termaat 3 1 School
More informationTHE 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 information112 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 informationReconstructing Null-space Policies Subject to Dynamic Task Constraints in Redundant Manipulators
Reconstructing Null-space Policies Subject to Dynamic Task Constraints in Redundant Manipulators Matthew Howard Sethu Vijayakumar September, 7 Abstract We consider the problem of direct policy learning
More informationUnderactuated Dynamic Positioning of a Ship Experimental Results
856 IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY, VOL. 8, NO. 5, SEPTEMBER 2000 Underactuated Dynamic Positioning of a Ship Experimental Results Kristin Y. Pettersen and Thor I. Fossen Abstract The
More informationCONTROL OF ROBOT CAMERA SYSTEM WITH ACTUATOR S DYNAMICS TO TRACK MOVING OBJECT
Journal of Computer Science and Cybernetics, V.31, N.3 (2015), 255 265 DOI: 10.15625/1813-9663/31/3/6127 CONTROL OF ROBOT CAMERA SYSTEM WITH ACTUATOR S DYNAMICS TO TRACK MOVING OBJECT NGUYEN TIEN KIEM
More informationDynamic Model of a Badminton Stroke
ISEA 28 CONFERENCE Dynamic Model of a Badminton Stroke M. Kwan* and J. Rasmussen Department of Mechanical Engineering, Aalborg University, 922 Aalborg East, Denmark Phone: +45 994 9317 / Fax: +45 9815
More informationDynamic 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 informationLesson Rigid Body Dynamics
Lesson 8 Rigid Body Dynamics Lesson 8 Outline Problem definition and motivations Dynamics of rigid bodies The equation of unconstrained motion (ODE) User and time control Demos / tools / libs Rigid Body
More informationExercise 1b: Differential Kinematics of the ABB IRB 120
Exercise 1b: Differential Kinematics of the ABB IRB 120 Marco Hutter, Michael Blösch, Dario Bellicoso, Samuel Bachmann October 5, 2016 Abstract The aim of this exercise is to calculate the differential
More informationQuiz Samples for Chapter 7 Kinetic Energy and Work
Name: Department: Student ID #: Notice ˆ + ( 1) points per correct (incorrect) answer ˆ No penalty for an unanswered question ˆ Fill the lank ( ) with ( ) if the statement is correct (incorrect) ˆ : corrections
More informationThe Jacobian. Jesse van den Kieboom
The Jacobian Jesse van den Kieboom jesse.vandenkieboom@epfl.ch 1 Introduction 1 1 Introduction The Jacobian is an important concept in robotics. Although the general concept of the Jacobian in robotics
More informationFuzzy Based Robust Controller Design for Robotic Two-Link Manipulator
Abstract Fuzzy Based Robust Controller Design for Robotic Two-Link Manipulator N. Selvaganesan 1 Prabhu Jude Rajendran 2 S.Renganathan 3 1 Department of Instrumentation Engineering, Madras Institute of
More informationNonlinear Tracking Control of Underactuated Surface Vessel
American Control Conference June -. Portland OR USA FrB. Nonlinear Tracking Control of Underactuated Surface Vessel Wenjie Dong and Yi Guo Abstract We consider in this paper the tracking control problem
More informationRigid Manipulator Control
Rigid Manipulator Control The control problem consists in the design of control algorithms for the robot motors, such that the TCP motion follows a specified task in the cartesian space Two types of task
More informationOn the design of reactionless 3-DOF planar parallel mechanisms
Mechanism and Machine Theory 41 (2006) 70 82 Mechanism and Machine Theory www.elsevier.com/locate/mechmt On the design of reactionless 3-DOF planar parallel mechanisms Abbas Fattah *, Sunil K. Agrawal
More informationAdvanced 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 informationVideo 8.1 Vijay Kumar. Property of University of Pennsylvania, Vijay Kumar
Video 8.1 Vijay Kumar 1 Definitions State State equations Equilibrium 2 Stability Stable Unstable Neutrally (Critically) Stable 3 Stability Translate the origin to x e x(t) =0 is stable (Lyapunov stable)
More informationPhysics 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 informationLecture «Robot Dynamics»: Dynamics and Control
Lecture «Robot Dynamics»: Dynamics and Control 151-0851-00 V lecture: CAB G11 Tuesday 10:15 12:00, every week exercise: HG E1.2 Wednesday 8:15 10:00, according to schedule (about every 2nd week) Marco
More informationVideo 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 informationControlling the Apparent Inertia of Passive Human- Interactive Robots
Controlling the Apparent Inertia of Passive Human- Interactive Robots Tom Worsnopp Michael Peshkin J. Edward Colgate Kevin Lynch Laboratory for Intelligent Mechanical Systems: Mechanical Engineering Department
More informationPosition in the xy plane y position x position
Robust Control of an Underactuated Surface Vessel with Thruster Dynamics K. Y. Pettersen and O. Egeland Department of Engineering Cybernetics Norwegian Uniersity of Science and Technology N- Trondheim,
More informationAn experimental robot load identification method for industrial application
An experimental robot load identification method for industrial application Jan Swevers 1, Birgit Naumer 2, Stefan Pieters 2, Erika Biber 2, Walter Verdonck 1, and Joris De Schutter 1 1 Katholieke Universiteit
More informationChapter 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 informationERASMUS UNIVERSITY ROTTERDAM Information concerning the Entrance examination Mathematics level 2 for International Business Administration (IBA)
ERASMUS UNIVERSITY ROTTERDAM Information concerning the Entrance examination Mathematics level 2 for International Business Administration (IBA) General information Availale time: 2.5 hours (150 minutes).
More informationCDS 101: Lecture 2.1 System Modeling
CDS 0: Lecture. System Modeling Richard M. Murray 4 Octoer 004 Goals: Define what a model is and its use in answering questions aout a system Introduce the concepts of state, dynamics, inputs and outputs
More informationRobot Position from Wheel Odometry
Root Position from Wheel Odometry Christopher Marshall 26 Fe 2008 Astract This document develops equations of motion for root position as a function of the distance traveled y each wheel as a function
More informationRobotics I Kinematics, Dynamics and Control of Robotic Manipulators. Velocity Kinematics
Robotics I Kinematics, Dynamics and Control of Robotic Manipulators Velocity Kinematics Dr. Christopher Kitts Director Robotic Systems Laboratory Santa Clara University Velocity Kinematics So far, we ve
More informationGame Physics. Game and Media Technology Master Program - Utrecht University. Dr. Nicolas Pronost
Game and Media Technology Master Program - Utrecht University Dr. Nicolas Pronost Rigid body physics Particle system Most simple instance of a physics system Each object (body) is a particle Each particle
More informationMelnikov s Method Applied to a Multi-DOF Ship Model
Proceedings of the th International Ship Staility Workshop Melnikov s Method Applied to a Multi-DOF Ship Model Wan Wu, Leigh S. McCue, Department of Aerospace and Ocean Engineering, Virginia Polytechnic
More informationQUADRATIC EQUATIONS EXPECTED BACKGROUND KNOWLEDGE
6 QUADRATIC EQUATIONS In this lesson, you will study aout quadratic equations. You will learn to identify quadratic equations from a collection of given equations and write them in standard form. You will
More informationRobotics. 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 informationDifferential Flatness-based Kinematic and Dynamic Control of a Differentially Driven Wheeled Mobile Robot
Differential Flatness-ased Kinematic and Dynamic Control of a Differentially Driven Wheeled Moile Root Chin Pei Tang, IEEE Memer Astract In this paper, we present an integrated motion planning and control
More informationu (surge) X o p (roll) Body-fixed r o v (sway) w (heave) Z o Earth-fixed X Y Z r (yaw) (pitch)
Nonlinear Modelling of Marine Vehicles in Degrees of Freedom Thor I. Fossen and Ola-Erik Fjellstad The Norwegian Institute of Technology Department of Engineering Cybernetics N-0 Trondheim, NORWAY (E-mail:tif@itk.unit.no)
More informationControl of a Handwriting Robot with DOF-Redundancy based on Feedback in Task-Coordinates
Control of a Handwriting Robot with DOF-Redundancy based on Feedback in Task-Coordinates Hiroe HASHIGUCHI, Suguru ARIMOTO, and Ryuta OZAWA Dept. of Robotics, Ritsumeikan Univ., Kusatsu, Shiga 525-8577,
More informationRobotics. Dynamics. University of Stuttgart Winter 2018/19
Robotics Dynamics 1D point mass, damping & oscillation, PID, dynamics of mechanical systems, Euler-Lagrange equation, Newton-Euler, joint space control, reference trajectory following, optimal operational
More informationP = ρ{ g a } + µ 2 V II. FLUID STATICS
II. FLUID STATICS From a force analysis on a triangular fluid element at rest, the following three concepts are easily developed: For a continuous, hydrostatic, shear free fluid: 1. Pressure is constant
More informationManipulator Dynamics 2. Instructor: Jacob Rosen Advanced Robotic - MAE 263D - Department of Mechanical & Aerospace Engineering - UCLA
Manipulator Dynamics 2 Forward Dynamics Problem Given: Joint torques and links geometry, mass, inertia, friction Compute: Angular acceleration of the links (solve differential equations) Solution Dynamic
More informationMixed Control Moment Gyro and Momentum Wheel Attitude Control Strategies
AAS03-558 Mixed Control Moment Gyro and Momentum Wheel Attitude Control Strategies C. Eugene Skelton II and Christopher D. Hall Department of Aerospace & Ocean Engineering Virginia Polytechnic Institute
More informationExpansion 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 informationTrajectory Planning from Multibody System Dynamics
Trajectory Planning from Multibody System Dynamics Pierangelo Masarati Politecnico di Milano Dipartimento di Ingegneria Aerospaziale Manipulators 2 Manipulator: chain of
More informationPhysics 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 informationTHRUST OPTIMIZATION OF AN UNDERWATER VEHICLE S PROPULSION SYSTEM
THRUST OPTIMIZATION OF AN UNDERWATER VEHICLE S PROPULSION SYSTEM Senior lecturer Vasile DOBREF Lecturer Octavian TARABUTA Mircea cel Batran Naval Academy, Constanta, Romania Keywords: underwater vehicle,
More information