Robots with Flexible Links: Modeling and Control
|
|
- Britney Grant
- 6 years ago
- Views:
Transcription
1 Scuola di Dottorato CIRA Controllo di Sistemi Robotici per la Manipolazione e la Cooperazione Bertinoro (FC), Luglio 23 Robots with Flexible Links: Modeling and Control Alessandro De Luca Dipartimento di Informatica e Sistemistica (DIS) Università di Roma La Sapienza
2 Outline Motivation for considering distributed link flexibility Dynamic modeling of FL robots: single link and multiple link cases Formulation of control problems Controllers for regulation tasks Controllers for joint and end-effector trajectory tracking tasks Controllers for rest-to-rest motion tasks Conclusions References 2
3 Motivation distributed link deformation in robot manipulators arises when the design of very long and slender arms is needed for the application lightweight materials are used (without special care) link rigidity is always an ideal assumption and may fail when increasing payload-to-weight ratio motion speed control bandwidth flexible structures in motion are present in different domains: space manipulators, robots for underwater and underground waste sites, automated cranes,... as for joint elasticity, neglected link flexibility limits static (steady-state error) or dynamic (vibrations, poor tracking) task performance from the control point of view, there is an additional problem of non-colocation between input commands and typical outputs to be controlled 3
4 Robots with link flexibility SSRMS Space Shuttle Remote Manipulation System (Canadarm) telemanipulated by astronauts link bending due to fast motion (not gravity!) 4
5 Robots with link flexibility Sam II developed at Georgia Tech (W. Book) macro-micro concept for remote exploration and manipulation of nuclear waste sites 5
6 Robots with link flexibility prototypes in Roma DMA harmonic steel beam (.5 kg): DD-DC motor, encoder, 7 strain gauges DIS/DIA FLEXARM: planar two-link with flexible forearm (1.8 kg), DD-DC motors, encoders, on-board optical sensor measuring deformation at three points 6
7 Robots with link flexibility prototype in Waterloo WATFLEX planar 2R with both link flexible (each with 2 strain gauges), moving with air bearings on a glass table to support the weight of the second motor; encoders, tachometers, overviewing CCD camera 7
8 Robots with link flexibility prototypes in Japan spatial 3R flexible arm at Kyoto cooperating 6R flexible arms at Tohoku 8
9 Frequency identification of a single flexible link deg/s s [ left ] frequency sweep joint acceleration signal: plant vs. model [ right ] joint acceleration frequency response: plant vs. model (matching within 1% of resonances at f 1 = 14.4, f 2 = 34.2, and f 3 = 69.3 Hz) 9
10 Dynamic modeling of a single flexible link one-link flexible arm modeled as a Euler-Bernoulli beam in rotation Y m p J p x y CoM J θt θ θ c X length l, uniform density ρ, Young modulus cross-section inertia EI actuator inertia J, payload mass m p and inertia J p reference frames: (X, Y ) absolute; (x, y) moving with instantaneous CoM 1
11 Assumptions and definitions Euler-Bernoulli theory applies to slender arm design (length vs. section) beam undergoes small deformations of pure bending type in the plane of motion (no torsion or compression) bending deformation w(x, t), with x [,l], is directed along the y direction (no shear) rotational inertia of beam sections is neglected ( Timoshenko theory) as well as the isoperimetric constraint ( extension of beam neutral axis is negligible) definition of other relevant angular variables: position θ(t) of the CoM (not measurable, but convenient) position θ c (t) of the tangent to the link base (measured by motor encoder) position θ t (t) of a line pointing to the beam tip (measurable in several ways) 11
12 build the Lagrangian from kinetic and elastic potential energy of the beam using Hamilton principle and calculus of variations, the bending deformation w(x, t) and angle θ(t) satisfy the linear differential equations EIw (x, t)+ρ(ẅ(x, t)+x θ(t)) = τ(t) J θ(t) = i.e., a PDE and an ODE (rigid motion), where J = J +(ρl 3 )/3+J p +m p l 2 and τ = torque input geometric/dynamic boundary conditions associated to the PDE w(,t) = EIw (,t) = J ( θ(t)+ẅ (,t)) τ(t) (balance of moments at base) EIw (l, t) = J p ( θ(t)+ẅ (l, t)) (balance of moments at tip) EIw (l, t) = m p (l θ(t)+ẅ(l, t)) (balance of shear forces at tip) 12
13 in free evolution (τ(t) θ(t) =), PDE solved by separation of variables w(x, t) =φ(x)δ(t) EI ρ φ (x) φ(x) = δ(t) δ(t) = ω 2 for a positive constant ω 2 (self-adjoint problem) to be determined time solution δ(t) = ω 2 δ(t) δ(t) =c 1 sin ωt + c 2 cos ωt with c 1,c 2 depending on the initial conditions δ() and δ() space solution (try it!) φ (x) =β 4 φ(x) β 4 = ρω2 EI φ(x) =A sin βx + B cos βx + C sinh βx + D cosh βx with A, B, C, D obtained from the geometric/dynamic b.c. s on w(x, t) 13
14 using w(x, t) =φ(x)δ(t) and δ = ω 2 δ, and holding the b.c. s for any δ(t), these are rewritten in terms of φ(x) only φ() = EIφ () + J ω 2 φ () = EIφ (l) J p ω 2 φ (l) = EIφ (l)+m p ω 2 φ(l) = using the general solution φ(x), a system of linear homogeneus equations follows A(EI,ρ,l,J,m p,j p, β) A B C D = to exclude the trivial solution, the determinant of matrix A should be zero (eigenvalue problem) ( ) 14
15 det A(β) =at infinite (but countable!) positive increasing roots β i of the trascendental characteristic equation (csh sch) 2m p ρ β i ssh m p ρ 2 β4 i (J + J p )(csh sch) 2J p ρ β3 i cch J ρ β 3 i (1 + cch)+j J p ρ 2 β6 i (csh+ sch) J J p m p ρ 3 βi 7 where s = sin β i l, c = cos β i l, sh = sinh β i l, ch = cosh β i l (1 cch)= this is an exact result, that includes common physical approximations clamped-free model: m p = J p =, J 1+cch= pinned-free model: m p = J p = J = csh sch = 15
16 associated to each root β i we have: an eigenfrequency ω i = EIβi 4 /ρ, characterizing a system vibration an eigenvector φ i (x) a spatial deformation mode, defined up to a constant a deformation variable δ i (t), oscillatory in time a finite-dimensional approximation of the distributed bending deformation is obtained by truncation w(x, t) = i=1 φ i (x)δ i (t) n e i=1 φ i (x)δ i (t) where n e is the (arbitrary) number of orthogonal modes that we wish to include normalization of the modes can be chosen in different ways (some integral of the φ i (x) equal to 1, to m,...) 16
17 resulting dynamic model is particularly simple (after fairly complex analysis...) J θ = τ δ i + ω 2 i δ i = φ i ()τ i =1,...,n e remarkable properties: rigid motion θ(t) and each vibratory motion δ i (t) are decoupled in free evolution (τ(t) ) all modes are excited by an input command τ(t), with a weighting that depends on φ i () the tangent at the link base of each deformation mode arm stiffness is summarized by the (squared) eigenfrequencies ω i each vibratory motion is persistent during free evolution, if initially excited by δ i () (absence of damping) 17
18 modal damping can be easily included in the dynamic model J θ = τ δ i +2ζ i ω i δ i + ωi 2 δ i = φ i ()τ i =1,...,n e with coefficients ζ i [, 1) its matrix version, with generalized coordinates q = ( θδ 1...δ ne ) T IR n e+1, shows the classical mass-spring-damper form with M = [ J I ] D = M q + D q + Kq = Bτ [ ] 2ZΩ K = [ ] Ω 2 B = [ ] 1 Φ Ω=diag {ω 1,...,ω ne }, Z = diag {ζ 1,...,ζ ne }, Φ = ( φ 1 ()...φ n e () ) T 18
19 a different (but equivalent) choice of generalized coordinates may let the input τ appear in just one equation leads to [ J JΦ (θ, δ) =(θ, δ 1,...,δ ne ) (θ c,δ)=(θ + δ T Φ,δ)=(θ + φ i ()δ i,δ 1,...,δ ne ) JΦ T I + J 2 Φ Φ T ][ θ c δ ] [ + 2ZΩ ][ θ c δ ] [ + Ω 2 ][ ] θc with same (diagonal) damping D and stiffness K matrices, but full inertia matrix δ = [ ] 1 τ 19
20 Choice of the controlled output joint level angular output (clamped angle) θ c = θ + n e i=1 φ i () δ i!! is always minimum phase (zeros in left-hand side of complex plane) tip level angular output θ t = θ + n e i=1 φ i (l)!! is typically non-minimum phase (at least for no tip payload) output at a point x [,l] along the link θ x = θ + n e i=1 l φ i (x) x δ i δ i 2
21 torque τ clamped joint angle θ c = P c (s) = 1 ne Js J i=1 Transfer functions φ i ()2 s 2 +2ζ i ω i s + ω 2 i ne i=1 (s2 +2ζ i ω i s + ω 2 i )+s2 n e i=1 φ i ()2 ne j i (s2 +2ζ j ω j s + ω 2 j ) torque τ tip angle θ t = P t (s) = 1 ne Js J i=1 s 2 n e i=1 (s2 +2ζ i ω i s + ω 2 i ) φ i () φ i(l) l s 2 +2ζ i ω i s + ω 2 i ne i=1 (s2 +2ζ i ω i s + ωi 2)+s2 n e i=1 φ i () φ i(l) ne l j i (s2 +2ζ j ω j s + ωj 2) s 2 n e i=1 (s2 +2ζ i ω i s + ωi 2) 21
22 A numerical example physical data J =.2, l =1, ρ =.5, EI =1 (m p = J p =) by considering up to n e =5modes (and no damping), we obtain Ω 2 = diag { , , , , } Φ [ T = ] Φ T l = [ ]!! note the alternating signs of φ i (l) s... 22
23 First four mode shapes phi_ x [m] 2 phi_ x [m] phi_3 -.5 phi_ x [m] x [m] at f 1 =3.2678, f 2 =8.8936, f 3 = , and f 4 = [Hz] 23
24 Pole-zero patterns 6 poli-zeri FdT di giunto (2 modi) 6 poli-zeri FdT di tip (2 modi) 15 poli-zeri FdT di giunto (3 modi) 15 poli-zeri FdT di tip (3 modi) Imag Axis Imag Axis Imag Axis Imag Axis Real Axis Real Axis Real Axis Real Axis two modes clamped joint and tip output three modes 24
25 Frequency responses 1 1 Magnitude (db) 5-5 Magnitude (db) Frequency (rad/sec) Frequency (rad/sec) Phase (deg) -9 Phase (deg) Frequency (rad/sec) Frequency (rad/sec) clamped joint three modes tip 25
26 Useful control-oriented remarks in pole-zero patterns of P c (s), zeros precede and alternate with poles on the imaginary axis passivity property zero patterns of P t (s) are symmetric w.r.t. the imaginary axis non-minimum phase property no direct system inversion is feasible while moving the output along the link (P x (s)), zeros migrate along imaginary axis and several phenomema occurr: total pole-zero cancellation when pointing at CoM (vibrations unobservable from rigid motion variable θ) for a particular x (,l), all zeros vanishes together at infinity (P x (s) has maximum relative degree equal to 2(n e +1)) beyond x (e.g., for x = l), all pairs of zeros reappear in Re + /Re 26
27 modal damping destroys perfect symmetry in zeros and poles (system is anyway asymptotically stable), but not the non-minimum phase property of P t (s) from the Bode plots, it follows that classical controller synthesis in the frequency domain is harder for the tip output multiple crossing of db axis of P t (jω) especially for high control gain increasing phase lag when adding modes 27
28 Dynamic modeling of robots with multiple flexible links a convenient kinematic description should be used, both for rigid body motion and flexible deformation recursive procedures can be set up for open chains with flexible links, similarly to the rigid case differential kinematic relationships are needed for computing kinetic and potential energy, within a Lagrangian approach modeling results from the one-link case can be embedded (with caution) in the description of each flexible link of the robot to limit complexity, we sketch here only the planar case (with gravity) of robots with N flexible links undergoing small bending deformations 28
29 Kinematics X 2 X 1 w θ 2 (x 2 ) 2 Y 2 Y 2 =Y 3 X 2 =X 3 Y 1 Y 1 Y w 1 (x 1 ) X 1 θ 1 X link i: rigid motion by clamped angle θ i (t); lateral bending w i (x i,t), x i [,l i ] position vectors and (rigid/flexible) rotation matrices (w ie = w i i p i (x i )= [ ] x i w i (x i ) i r i+1 = i p i (l i ) A i = [ cos θi sin θ i sin θ i cos θ i ] x i xi =l i ) E i = [ 1 w ie w ie 1 29 ]
30 recursive equations for absolute quantities in ( ˆX, Ŷ ) p i = r i + W i i p i r i+1 = r i + W i i r i+1 W i = W i 1 E i 1 A i differential kinematics absolute angular velocity of frame (X i,y i ) α i = i j=1 θ j + i 1 ẇ ke k=1 absolute linear velocity of a point on link i ṗ i =ṙ i + Ẇ i i p i + W iiṗ i where i ṗ i = [ ẇ i (x i )] T (link extension is neglected) 3
31 Kinetic energy hub i T = N i=1 T hi + N i=1 T li + T p T hi = 1 2 m hiṙ T i ṙi J hi α 2 i link i payload T li = 1 2 li ρ i(x i )ṗ i (x i ) T ṗ i (x i )dx i T p = 1 2 m pṙ T N+1ṙN J p( α N +ẇ Ne )2 31
32 U = N i=1 elastic energy of link i U ei = 1 2 U ei + Potential energy li N i=1 U ghi + (EI) i(x i ) gravitational energy of hub i and of link i N i=1 U gli + U gp ( d 2 ) 2 w i (x i ) dx i dx 2 i U ghi = m hi g T r i U gli = g T gravitational energy of payload li ρ i(x i )p i (x i )dx i U gp = m p g T r N+1 where g is the gravity acceleration vector 32
33 Euler-Lagrange equations introduce any finite-dimensional discretization for w i (x i,t) w i (x i,t)= n ei j=1 ϕ ij (x i )δ ij (t) i =1,...,N Lagrangian is in terms of N + M generalized coordinates, M = N i=1 n ei, L = T U = L ( {θ i (t),δ ij (t), θ i (t), δ ij (t)} ) and satifies to ( ) d L L = τ i i =1,...,N dt ( θ i ) θ i d L L = j =1,...,n ei i =1,...,N dt δ ij δ ij being τ i the torque delivered by the actuator at joint i 33
34 the general dynamic model of flexible robots (including modal damping) is then [ ] [ ] [ ] [ ] [ Mθθ (θ, δ) M θδ (θ, δ) ][ θ cθ (θ, δ, θ, δ) gθ (θ, δ) τ Mθδ T (θ, δ) M = δδ(θ, δ) δ c δ (θ, δ, θ, δ) g δ (θ, δ) D δ + Kδ with blocks of suitable dimensions (e.g., M θδ in the inertia matrix is (N M)), or in the more compact form M(q) q + c(q, q)+g(q)+ with q := (θ, δ) IR N+M [ D δ + Kδ vector of centrifugal/coriolis terms can be factorized using Christoffel symbols [ ][ ] Cθθ (q, q) C c(q, q) =C(q, q) q = θδ (q, q) θ C δθ (q, q) C δδ (q, q) δ ] = [ τ ] 34 ]
35 Model properties as usual, matrix Ṁ 2C is skew-symmetric also blockwise, e.g. Ṁ δδ 2C δδ spatial dependence in the kinetic and potential energy of the links can be resolved introducing a set of dynamic coefficients so that (De Luca, Siciliano, 1991) [ ] τ Y (θ, δ, θ, δ, θ, δ)a = where constant vector a summarizes the mechanical (rigid + flexible) properties of the links and can be computed off-line (or identified experimentally) choice of assumed modes basis functions ϕ ij (x i ) for bending deformation admissible functions satisfy only geometric b.c. s comparison functions (FE method, Ritz-Kantorovich) satisfy also natural b.c. s orthonormal eigenfunctions (links modeled as Euler-Bernoulli beams) leads to simplifications in inertia submatrix M δδ (block diagonal, constant) 35
36 a common approximation evaluates total kinetic energy in the undeformed arm configuration δ = M = M(θ) and thus c = c(θ, θ, δ) c δ loses quadratic dependence on δ moreover, if M δδ is constant c θ loses quadratic dependence on δ c δ is a quadratic function of θ only if also M θδ is constant c δ c θ is a quadratic function of θ only finally, small deformation of each link implies g δ = g δ (θ) 36
37 Control problems regulation to a constant equilibrium configuration (θ, δ, θ, δ) =(θ d,δ d,, ) only the desired joint position θ d is assigned, while δ d has to be determined θ d may come from the kineto-static inversion of a desired cartesian pose x d, but no closed-form solution exists (see De Luca, Panzieri, 1994) direct kinematics of FL robots is in fact a complete function of rigid and flexible variables: x = kin(θ, δ) tracking of a joint trajectory θ d (t) the easy case tracking of a end-effector trajectory x d (t) the difficult case rest-to-rest motion in given time T (a trajectory planning problem in first place) in tracking problems, controllers try to stiffen the flexible arm at a point in a way or the other 37
38 Sensing requirements full state feedback requires sensing of joint/motor variables (θ, θ), deflections δ, and deflection rates δ (no direct sensor available) at least encoder + tachometer on the motor axis (sometimes is enough...) a range of sensors for measuring δ (or deformation related quantities), each with pros and cons: strain gauges, accelerometers, optical sensors, video camera (on-board or fixed in workspace), piezoelectric actuating/sensing devices,... 38
39 problems with camera: frame rate, field of view/accuracy 39
40 Regulation with joint PD + feedforward for regulation tasks, consider the control law τ = K P (θ d θ) K D θ + g θ (θ d,δ d ) with symmetric (diagonal) K P >, K D >, and the associated link deflection δ d := K 1 g δ (θ d ) Theorem (De Luca, Siciliano, 1993) If λ min ([ KP K ]) >α then the closed-loop equilibrium state (θ d,δ d,, ) is asymptotically stable 4
41 Remarks Lyapunov-based proof similar to the joint elastic case (not repeated here) determination of α in view of small deformation U e = 1 2 δt Kδ U e,max δ bound on the gradient of the gravitational term g q α + α 1 δ α + α 1 2Ue,max 2Ue,max λ max (K) λ max (K) =: α in absence of modal damping D =, special care in LaSalle analysis for tip regulation, compute θ d by solving via iterative techniques kin ( θ, K 1 g δ (θ) ) = x d 41
42 Numerical results a two-link flexible arm with two bending modes for each link with f 11 =1.4, f 12 =5.1, f 21 =5.2, f 22 =32.4 [Hz] point-to-point motion: θ() = ( 9, ) θ d =( 45, ) 5 joint angles 2 joint torques 1 deg Nm sec sec.1 1st link deflections.5 2nd link deflections m m sec sec 42
43 Joint trajectory tracking given a desired θ d (t) C 2, assuming that the state is measurable and the dynamic model of FL robot is available, we proceed by system inversion from the joint position output θ a nonlinear static state feedback is obtained that decouples and linearizes the input-output behavior, leaving an unobservable internal (nonlinear) dynamics exponential stabilization of the output tracking error is performed on the linear side of the problem some stability/boundedness of the internal system dynamics should be enforced original results in (De Luca, Siciliano, 1993b) 43
44 System inversion from second set of M equations in the dynamic model, solve (globally) for δ δ = M 1 δδ (c δ + g δ + Kδ + D δ + M T θδ θ) and plug in first set of N equations effects of flexible dynamics onto rigid dynamics ( Mθθ M θδ Mδδ 1 M θδ T ) θ + c θ + g θ M θδ Mδδ 1 ( cδ + g δ + Kδ + D δ ) = τ Matrix M θθ M θδ M 1 [ Mθθ M θδ M T θδ M δδ ][ δδ M T θδ I Mδδ 1 M θδ T I has always full rank, since ] = [ Mθθ M θδ Mδδ 1 M θδ T M θδ M δδ ] 44
45 system output θ has uniform vector relative degree {2, 2,..., 2} ( θ depends on τ in a nonsingular way) define the nonlinear control law τ = ( M θθ M θδ Mδδ 1 M θδ T ) a + cθ + g θ M θδ Mδδ 1 (c δ + g δ + Kδ + D δ) in which only the inversion inertia block M 1 the closed-loop system is δδ is required θ = a δ = Mδδ 1 ( M T θδ a + c δ + g δ + D δ + Kδ ) for stabilizing the output tracking error e = θ d θ, choose with (diagonal) K P >, K D > a = θ d + K D ( θ d θ)+k P (θ d θ) 45
46 Analysis of internal dynamics zero dynamics, when output θ(t) (or constant): δ = Mδδ 1 ( cδ + g δ + D δ + Kδ ) asymptotically stable (via Lyapunov argument) whole closed-loop system too clamped dynamics, when output θ(t) θ d (t): δ = A 2 (t) δ A 1 (t)δ + f δ (t) where (in the case M independent of δ) f δ (t) = Mδδ 1 d)(mθδ T (θ d) θ d + c δ (θ d, θ d )+g δ (θ d )) A 1 (t) = Mδδ 1 d)k A 2 (t) = Mδδ 1 d)d all time-varying functions are bounded closed-loop stability is ensured 46
47 Remarks on joint trajectory tracking the input-output linearization result is the nonlinear/mimo counterpart of the transfer function τ θ c with minimum phase zeros (stable zero dynamics) the more rigid is the tracking of a desired joint trajectory, the less vibration energy is taken out from (or the more is injected into) the rest of flexible arm!! a nominal feedforward is computed by forward integration of flexible dynamics δ = M 1 δδ (θ d, δ)(c δ (θ d, δ, θ d, δ)+g δ (θ d )+D δ + Kδ + M T θδ (θ d, δ) θ d ) from δ() = δ, δ() = δ nominal (and bounded) evolution δ d (t), δ d (t) substitution of (θ d (t),δ d (t), θ d (t), δ d (t)) in the expression of the control law (w/out feedback) yields τ d (t) and the simple local tracking controller τ = τ d (t)+k P (θ d θ)+k D ( θ d θ) 47
48 End-effector trajectory tracking accurate end-effector trajectory tracking is the toughest control problem for flexible robots direct extension of inversion strategies to end-effector output closed-loop instabilities linear (single-link) case: non-minimum phase tip transfer function nonlinear (multilink) case: unstable zero dynamics for end-effector motion main ideas proposed in the literature: resort to suitable feedforward strategy (non-causal solutions) use feedback, but avoid cancellation (causal solutions) selection of suitable end-effector trajectories that induce smaller arm deflections is of interest in any case 48
49 Inversion in frequency domain idea: desired motion trajectory as being part of a periodic profile use Fourier transforms (Bayo, 1987) single-link flexible arm (with generic variables) [ mθθ m T ] [ ][ ] [ ][ ] [ ] δθ ][ θ θ θ τ + + = δ D δ K δ m δθ M δδ tip position output rewrite in terms of (y, δ) [ mθθ m T δθ m θθc T e m δθ M δδ m δθ c T e y(t) =[1 c T e ] ][ÿ ] δ + [ D [ ] θ δ ][ẏ ] δ + [ K ][ ] y δ = [ τ 49 ]
50 take bilateral Fourier transforms Ÿ (ω) = and obtain m θθ exp(jωt)ÿ(t)dt (ω) = T (ω) = exp(jωt)τ(t)dt m T δθ m θθc T e m δθ M δδ m δθ c T e + 1 jω D 1 ω 2 K solve for accelerations [ ] Ÿ (ω) (ω) = exp(jωt) δ(t)dt [ Ÿ (ω) (ω) [ g11 (ω) g12 T (ω) ][ T (ω) g 21 (ω) G 22 (ω) ] = ] [ T (ω) ] 5
51 torque is obtained through inversion (in the frequency domain) T (ω) = 1 g 11 (ω)ÿ (ω) =r(ω)ÿ (ω) for a given zero-mean ÿ d (t), with ÿ d (t) =for t T/2 and t T/2, this can be embedded into a periodic signal from (, + ) ÿ d (t) Ÿ d (ω) T d (ω) τ d (t) from finite inverse Fourier transform τ d (t) = r(t τ)ÿ d(τ)dτ = T/2 T/2 r(t τ)ÿ d(τ)dτ expanding beyond [ T/2,T/2] (non-causal inverse system) 51
52 Remarks outside the given interval T of output motion, the computed input torque has a precharging action, bringing internal flexible state from rest to a suitable initial state at t = T/2 discharging action, bringing internal flexible state from the final state at t = T/2 to rest obtained initial condition is the unique state from which inversion control does lead to bounded internal evolution for the desired end-effector output trajectory! truncations (in time or frequency domain) inherent to actual computations (FFT) can be extended to the nonlinear (multilink flexible) setting, by repeated linear approximations along nominal trajectory (starting from rigid body motion) 52
53 Extension to nonlinear case: End-effector bang-bang trajectory gradi / sec ^ sec Nm sec y (m) x (m) acceleration profiles command torques FLEXARM motion 53
54 Extension to nonlinear case: End-effector sinusoidal trajectory gradi / sec ^2 Nm.5 y (m) sec sec x (m) acceleration profiles command torques FLEXARM motion 54
55 Regulation theory end-effector trajectory tracking in robots with flexible links is an instance of asymptotic output tracking with internal state stability (regulation problem) well-established technique in linear case and, by now, also in nonlinear case idea: compute the (bounded!) state trajectory associated to the desired output trajectory (generated by an autonomous antistable system, the exosystem) in linear case, write state-space equations (with x =(q, q)) for the flexible arm ẋ = Ax + Bτ e = y y d and for the generator of desired output ẇ = Sw y d = Qw 55
56 when (A, B) is stabilizable, the problem has a solution if and only if the following regulator equations are solvable in Π and Γ ΠS = AΠ+BΓ CΠ+Q = a state feedback + feedforward controller is then τ = F (x Πw)+Γw with feedback matrix F such that (A + BF) is Hurwitz the computed Πw is the desired state trajectory; x d () = Πw() is the unique initial state from which inversion control does lead to bounded internal evolution! control solutions with dynamic output feedback are also available 56
57 Numerical results for sinusoidal end-effector trajectory 1 autovalori in -1 (quattro) e -1 (quattro) 7 autovalori in -1 (quattro) e -1 (quattro) uscita tip (deg) 2-2 errore al tip (deg) sec sec tip output tip error 57
58 .3 autovalori in -1 (quattro) e -1 (quattro) 1.5 autovalori in -1 (quattro) e -1 (quattro).2 1 variabili deformazione delta (m) controllo (Nm) sec sec deformation variables torque input 58
59 1 autovalori in -1 (quattro) e -1 (quattro) uscita al giunto (deg) sec clamped joint angle (and desired tip output) 59
60 Rest-to-rest motion task: execute a slew motion with a FL robot arm between two undeformed configurations in given time problem: fast transfers induce residual oscillations extending the actual task completion time strategy: design a suitable output and plan output trajectories (and associated torque profiles) inducing complete absence of vibrations at the desired final time solution: output with maximum relative degree (no zeros); closed-form algorithm in the linear case; direct extension to MIMO nonlinear case (DFL or flat output, no zero dynamics) 6
61 Time-based algorithm for a single flexible link choose a parametric output y (unknown c i s) (De Luca, Di Giovanni, 21) y = θ + n e i=1 c i δ i = θ + c T δ impose τ-independence of (even) output derivatives ÿ = ( 1 n e J + i=1 y [4] =: d4 ne y dt 4 = c i φ n e i ())τ i=1 i=1 c i ωi 2 n e φ i () τ + c i ωi 2 δ i c i φ i () = 1/J i=1 c i ω 4 i δ i c i ω 2 i φ i () = and so on, until a set of n e equations are generated (torque τ appears in the 2(n e +1)-th output derivative) 61
62 solve for the coefficients c =(c 1,...,c ne ) V diag{φ 1 (),...,φ n e ()} c = [ 1/J...] T with Vandermonde matrix V generated by (ω 2 1,...,ω2 n e ) nominal torque τ d (t) computed by inversion on highest derivative imposing y [2(n e+1)] = y [2(n e+1)] d for a suitably planned output trajectory y d (t), t [, T ] (given trasfer time) for the output trajectory y d (t), solve a simple interpolation problem d i y y d () = θ i y d (T )=θ d f dt i () = di y d dt i (T )= i =1,...,2n e +1 e.g., a polynomial of degree 4n e +3will be sufficient 62
63 Laplace-based algorithm (only in the linear case) impose that the transfer function has no zeros y(s) τ(s) = 1 ne Js 2 + c i φ i () i=1 s 2 + ωi 2 partial fractions expansion yields closed-form expressions = K s 2 n e i=1 (s2 + ω 2 i ) K = 1 J n e i=1 ω 2 i c i = 1 Jφ i () ne j=1 j i ω 2 j ω 2 j ω2 i (i =1,...,n e ) set y = y d and invert in the transformed domain (then back to time τ d (t)) τ d (s) = s 2 n e (s 2 + ωi 2 ) y d (s) J ne i=1 ω2 i i=1 63
64 Remarks method applies to any linear (controllable) model of a single-link flexible arm output structure for modal damping (De Luca, Caiano, Del Vescovo, 23) y = θ + n e i=1 c i δ i + γ θ + design output is (in the limit) a specific point x on the physical beam: for a given n e, c i = φ i (x n e )/x n e while lim ne x n e = x for improved torque/time performance, modified method generates smoothed bang-bang/bang-coast-bang torque profiles, with polynomial interpolating phases n e i=1 d i δ i trajectory planning (feedforward) combined with feedback control τ = τ d (t)+k P (θ c,d (t) θ c )+K D ( θ c,d (t) θ c ) with clamped joint reference θ c,d (t) computed from the algorithm 64
65 Numerical results n e =3modes with f 1 =4.5, f 2 =12.34, f 3 =22.87 [Hz] θ f θ i =9 in T =2s 19th degree polynomial (continuous torque derivative) deg 5 Nm s output trajectory s rest-to-rest torque 65
66 deg 5 m s s m clamped ( ), tip angle (- -) deformation variables arm motion 66
67 Experiment on DMA single flexible link 67
68 Extension to nonlinear case: Rest-to-rest motion time-based algorithm for two-link with flexible forearm (De Luca, Di Giovanni, 21b).25 delta 8 u1, u Nm m s s m first deformation mode command torques FLEXARM motion 68
69 Conclusions extra effort in dynamic modeling pays off model-based controllers for accurate trajectory tracking proof of stability for model-inpedendent regulation controllers conventional control strategies tend to suppress vibrations wherever they arise outcome of the analysis: controlled system should be brought to a vibratory behavior compatible with the given output task EJ robots are similar to FL robots in mechanical modeling, but intrinsically different from the control point of view 69
70 What has been left out... singular perturbation modeling and control (for joint or link stiffness K ), including corrective and invariant manifold controllers iterative learning control that yields same accuracy (for all types of tasks) without using a dynamic model but assuming repetitive tasks model uncertainties, disturbances,... 7
71 References (Bayo, 1987) A finite-element approach to control the end-point motion of a single-link flexible robot, JRS, 4, (De Luca, Caiano, Del Vescovo, 23) Experiments on rest-to-rest motion of a flexible arm, in Experimental Robotics VIII (Siciliano, Dario Eds), STAR 5, Springer, (De Luca, Di Giovanni, 21) Rest-to-rest motion of a one-link flexible forearm, IEEE/ASME AIM 1, (De Luca, Di Giovanni, 21b) Rest-to-rest motion of a two-link robot with a flexible forearm, IEEE/ASME AIM 1, (De Luca, Lanari, Ulivi, 1991) End-effector trajectory tracking in flexible arms: Comparison of approaches based on regulation theory, in Advanced Robot Control (Canudas de Wit Ed), LNCIS 162, Springer, (De Luca, Panzieri, 1994) An iterative scheme for learning gravity compensation in flexible robot arms, Automatica, 3(6),
72 (De Luca, Panzieri, Ulivi, 1998) Stable inversion control for flexible link manipulators, IEEE ICRA, (De Luca, Siciliano, 1991) Closed-form dynamic model of planar multi-link lightweight robots, IEEE SMC, 21(4), (De Luca, Siciliano, 1993) Regulation of flexible arms under gravity, IEEE TRA, 9(4), (De Luca, Siciliano, 1993b) Inversion-based nonlinear control of robot arms with flexible links, AIAA JGCD, 16(6), (De Luca, Siciliano, 1996) Flexible links, in Theory of Robot Control (Canudas de Wit, Siciliano, Bastin Eds), Springer,
Robots with Elastic Joints: Modeling and Control
Scuola di Dottorato CIRA Controllo di Sistemi Robotici per la Manipolazione e la Cooperazione Bertinoro (FC), 14 16 Luglio 2003 Robots with Elastic Joints: Modeling and Control Alessandro De Luca Dipartimento
More informationAn Iterative Scheme for Learning Gravity Compensation in Flexible Robot Arms
An Iterative Scheme for Learning Gravity Compensation in Flexible Robot Arms A. DE LUCA, S. PANZIERI Dipartimento di Informatica e Sistemistica, Università di Roma La Sapienza Via Eudossiana 8, 84 Roma,
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 informationLYAPUNOV-BASED FORCE CONTROL OF A FLEXIBLE ARM CONSIDERING BENDING AND TORSIONAL DEFORMATION
Copyright IFAC 5th Triennial World Congress, Barcelona, Spain YAPUNOV-BASED FORCE CONTRO OF A FEXIBE ARM CONSIDERING BENDING AND TORSIONA DEFORMATION Yoshifumi Morita Fumitoshi Matsuno Yukihiro Kobayashi
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 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 informationStructural Dynamics Lecture Eleven: Dynamic Response of MDOF Systems: (Chapter 11) By: H. Ahmadian
Structural Dynamics Lecture Eleven: Dynamic Response of MDOF Systems: (Chapter 11) By: H. Ahmadian ahmadian@iust.ac.ir Dynamic Response of MDOF Systems: Mode-Superposition Method Mode-Superposition Method:
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 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 informationA SIMPLE ITERATIVE SCHEME FOR LEARNING GRAVITY COMPENSATION IN ROBOT ARMS
A SIMPLE ITERATIVE SCHEME FOR LEARNING GRAVITY COMPENSATION IN ROBOT ARMS A. DE LUCA, S. PANZIERI Dipartimento di Informatica e Sistemistica Università degli Studi di Roma La Sapienza ABSTRACT The set-point
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 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 informationA Physically-Based Fault Detection and Isolation Method and Its Uses in Robot Manipulators
des FA 4.13 Steuerung und Regelung von Robotern A Physically-Based Fault Detection and Isolation Method and Its Uses in Robot Manipulators Alessandro De Luca Dipartimento di Informatica e Sistemistica
More informationShape Optimization of Revolute Single Link Flexible Robotic Manipulator for Vibration Suppression
15 th National Conference on Machines and Mechanisms NaCoMM011-157 Shape Optimization of Revolute Single Link Flexible Robotic Manipulator for Vibration Suppression Sachindra Mahto Abstract In this work,
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 informationApplication of singular perturbation theory in modeling and control of flexible robot arm
Research Article International Journal of Advanced Technology and Engineering Exploration, Vol 3(24) ISSN (Print): 2394-5443 ISSN (Online): 2394-7454 http://dx.doi.org/10.19101/ijatee.2016.324002 Application
More informationControl of Mobile Robots
Control of Mobile Robots Regulation and trajectory tracking Prof. Luca Bascetta (luca.bascetta@polimi.it) Politecnico di Milano Dipartimento di Elettronica, Informazione e Bioingegneria Organization and
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 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 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 informationDesign and Control of Variable Stiffness Actuation Systems
Design and Control of Variable Stiffness Actuation Systems Gianluca Palli, Claudio Melchiorri, Giovanni Berselli and Gabriele Vassura DEIS - DIEM - Università di Bologna LAR - Laboratory of Automation
More informationControl of Electromechanical Systems
Control of Electromechanical Systems November 3, 27 Exercise Consider the feedback control scheme of the motor speed ω in Fig., where the torque actuation includes a time constant τ A =. s and a disturbance
More information2.010 Fall 2000 Solution of Homework Assignment 1
2. Fall 2 Solution of Homework Assignment. Compact Disk Player. This is essentially a reprise of Problems and 2 from the Fall 999 2.3 Homework Assignment 7. t is included here to encourage you to review
More informationIntroduction to Control (034040) lecture no. 2
Introduction to Control (034040) lecture no. 2 Leonid Mirkin Faculty of Mechanical Engineering Technion IIT Setup: Abstract control problem to begin with y P(s) u where P is a plant u is a control signal
More informationControl of constrained spatial three-link flexible manipulators
Control of constrained spatial three-link flexible manipulators Sinan Kilicaslan, M. Kemal Ozgoren and S. Kemal Ider Gazi University/Mechanical Engineering Department, Ankara, Turkey Middle East Technical
More informationMODELLING OF FLEXIBLE MECHANICAL SYSTEMS THROUGH APPROXIMATED EIGENFUNCTIONS L. Menini A. Tornambe L. Zaccarian Dip. Informatica, Sistemi e Produzione
MODELLING OF FLEXIBLE MECHANICAL SYSTEMS THROUGH APPROXIMATED EIGENFUNCTIONS L. Menini A. Tornambe L. Zaccarian Dip. Informatica, Sistemi e Produzione, Univ. di Roma Tor Vergata, via di Tor Vergata 11,
More information, respectively to the inverse and the inverse differential problem. Check the correctness of the obtained results. Exercise 2 y P 2 P 1.
Robotics I July 8 Exercise Define the orientation of a rigid body in the 3D space through three rotations by the angles α β and γ around three fixed axes in the sequence Y X and Z and determine the associated
More informationStabilization of a 3D Rigid Pendulum
25 American Control Conference June 8-, 25. Portland, OR, USA ThC5.6 Stabilization of a 3D Rigid Pendulum Nalin A. Chaturvedi, Fabio Bacconi, Amit K. Sanyal, Dennis Bernstein, N. Harris McClamroch Department
More informationAdvanced Vibrations. Distributed-Parameter Systems: Exact Solutions (Lecture 10) By: H. Ahmadian
Advanced Vibrations Distributed-Parameter Systems: Exact Solutions (Lecture 10) By: H. Ahmadian ahmadian@iust.ac.ir Distributed-Parameter Systems: Exact Solutions Relation between Discrete and Distributed
More informationTable of Contents. Preface... 13
Table of Contents Preface... 13 Chapter 1. Vibrations of Continuous Elastic Solid Media... 17 1.1. Objective of the chapter... 17 1.2. Equations of motion and boundary conditions of continuous media...
More informationAutonomous Helicopter Landing A Nonlinear Output Regulation Perspective
Autonomous Helicopter Landing A Nonlinear Output Regulation Perspective Andrea Serrani Department of Electrical and Computer Engineering Collaborative Center for Control Sciences The Ohio State University
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 informationRobotics I. February 6, 2014
Robotics I February 6, 214 Exercise 1 A pan-tilt 1 camera sensor, such as the commercial webcams in Fig. 1, is mounted on the fixed base of a robot manipulator and is used for pointing at a (point-wise)
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 informationfound that it is possible to achieve excellent results but with unrealistically high torques. This problem
---- --- David Wang Department of Electrical and Computer Engineering University of Waterloo Waterloo, Ontario, Canada N2L-3G1 M. Vidyasagar Center for Artificial Intelligence and Robotics Bangalore 560
More informationInverse differential kinematics Statics and force transformations
Robotics 1 Inverse differential kinematics Statics and force transformations Prof Alessandro De Luca Robotics 1 1 Inversion of differential kinematics! find the joint velocity vector that realizes a desired
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 informationOutput tracking control of a exible robot arm
Proceedings of the 44th IEEE Conference on Decision and Control, and the European Control Conference 25 Seville, Spain, December 12-15, 25 WeB12.4 Output tracking control of a exible robot arm Tu Duc Nguyen
More information202 Index. failure, 26 field equation, 122 force, 1
Index acceleration, 12, 161 admissible function, 155 admissible stress, 32 Airy's stress function, 122, 124 d'alembert's principle, 165, 167, 177 amplitude, 171 analogy, 76 anisotropic material, 20 aperiodic
More informationFinal Exam Solution Dynamics :45 12:15. Problem 1 Bateau
Final Exam Solution Dynamics 2 191157140 31-01-2013 8:45 12:15 Problem 1 Bateau Bateau is a trapeze act by Cirque du Soleil in which artists perform aerial maneuvers on a boat shaped structure. The boat
More informationVirtual Passive Controller for Robot Systems Using Joint Torque Sensors
NASA Technical Memorandum 110316 Virtual Passive Controller for Robot Systems Using Joint Torque Sensors Hal A. Aldridge and Jer-Nan Juang Langley Research Center, Hampton, Virginia January 1997 National
More informationAdvanced Vibrations. Elements of Analytical Dynamics. By: H. Ahmadian Lecture One
Advanced Vibrations Lecture One Elements of Analytical Dynamics By: H. Ahmadian ahmadian@iust.ac.ir Elements of Analytical Dynamics Newton's laws were formulated for a single particle Can be extended to
More informationDynamic modelling, simulation and control of a manipulator with flexible links and joints
Robotics and Autonomous Systems 41 (22) 257 27 Dynamic modelling, simulation and control of a manipulator with flexible links and joints B. Subudhi, A.S. Morris Department of Automatic Control & Systems
More informationsc Control Systems Design Q.1, Sem.1, Ac. Yr. 2010/11
sc46 - Control Systems Design Q Sem Ac Yr / Mock Exam originally given November 5 9 Notes: Please be reminded that only an A4 paper with formulas may be used during the exam no other material is to be
More informationCOPYRIGHTED MATERIAL. Index
Index A Admissible function, 163 Amplification factor, 36 Amplitude, 1, 22 Amplitude-modulated carrier, 630 Amplitude ratio, 36 Antinodes, 612 Approximate analytical methods, 647 Assumed modes method,
More informationAdvanced Robotic Manipulation
Advanced Robotic Manipulation Handout CS37A (Spring 017 Solution Set # Problem 1 - Redundant robot control The goal of this problem is to familiarize you with the control of a robot that is redundant with
More informationCHAPTER 4 DESIGN AND ANALYSIS OF CANTILEVER BEAM ELECTROSTATIC ACTUATORS
61 CHAPTER 4 DESIGN AND ANALYSIS OF CANTILEVER BEAM ELECTROSTATIC ACTUATORS 4.1 INTRODUCTION The analysis of cantilever beams of small dimensions taking into the effect of fringing fields is studied and
More informationGeneral procedure for formulation of robot dynamics STEP 1 STEP 3. Module 9 : Robot Dynamics & controls
Module 9 : Robot Dynamics & controls Lecture 32 : General procedure for dynamics equation forming and introduction to control Objectives In this course you will learn the following Lagrangian Formulation
More informationStabilization of a Specified Equilibrium in the Inverted Equilibrium Manifold of the 3D Pendulum
Proceedings of the 27 American Control Conference Marriott Marquis Hotel at Times Square New York City, USA, July 11-13, 27 ThA11.6 Stabilization of a Specified Equilibrium in the Inverted Equilibrium
More informationRobot Control Basics CS 685
Robot Control Basics CS 685 Control basics Use some concepts from control theory to understand and learn how to control robots Control Theory general field studies control and understanding of behavior
More informationControl of industrial robots. Centralized control
Control of industrial robots Centralized control Prof. Paolo Rocco (paolo.rocco@polimi.it) Politecnico di Milano ipartimento di Elettronica, Informazione e Bioingegneria Introduction Centralized control
More informationAA242B: MECHANICAL VIBRATIONS
AA242B: MECHANICAL VIBRATIONS 1 / 50 AA242B: MECHANICAL VIBRATIONS Undamped Vibrations of n-dof Systems These slides are based on the recommended textbook: M. Géradin and D. Rixen, Mechanical Vibrations:
More informationCollocated versus non-collocated control [H04Q7]
Collocated versus non-collocated control [H04Q7] Jan Swevers September 2008 0-0 Contents Some concepts of structural dynamics Collocated versus non-collocated control Summary This lecture is based on parts
More informationIntroduction to Continuous Systems. Continuous Systems. Strings, Torsional Rods and Beams.
Outline of Continuous Systems. Introduction to Continuous Systems. Continuous Systems. Strings, Torsional Rods and Beams. Vibrations of Flexible Strings. Torsional Vibration of Rods. Bernoulli-Euler Beams.
More informationDynamical Systems & Lyapunov Stability
Dynamical Systems & Lyapunov Stability Harry G. Kwatny Department of Mechanical Engineering & Mechanics Drexel University Outline Ordinary Differential Equations Existence & uniqueness Continuous dependence
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 informationLUMPED MASS MODELLING WITH APPLICATIONS
LUMPED MASS MODELLING WITH APPLICATIONS July, 8, 07 Lumped Mass Modelling with Applications . Motivation. Some examples 3. Basic control scheme 4. Single joint single link - single mass INDEX 5. Extensions
More informationMEM04: Rotary Inverted Pendulum
MEM4: Rotary Inverted Pendulum Interdisciplinary Automatic Controls Laboratory - ME/ECE/CHE 389 April 8, 7 Contents Overview. Configure ELVIS and DC Motor................................ Goals..............................................3
More informationEN Nonlinear Control and Planning in Robotics Lecture 3: Stability February 4, 2015
EN530.678 Nonlinear Control and Planning in Robotics Lecture 3: Stability February 4, 2015 Prof: Marin Kobilarov 0.1 Model prerequisites Consider ẋ = f(t, x). We will make the following basic assumptions
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 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 informationRobotics 2 Robot Interaction with the Environment
Robotics 2 Robot Interaction with the Environment Prof. Alessandro De Luca Robot-environment interaction a robot (end-effector) may interact with the environment! modifying the state of the environment
More informationRest-to-Rest Motion for Planar Multi-Link Flexible Manipulator Through Backward Recursion
M. Benosman LAM, Université de Reims Champagne-Ardenne, BP 1039, 51687 Reims Cedex 2, France e-mail: mouhacine.benosman@univ-reims.fr G. Le Vey Institut de Recherche en Cybernétique de Nantes, UMR 6597-CNRS
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 informationPierre Bigot 2 and Luiz C. G. de Souza 3
INTERNATIONAL JOURNAL OF SYSTEMS APPLICATIONS, ENGINEERING & DEVELOPMENT Volume 8, 2014 Investigation of the State Dependent Riccati Equation (SDRE) adaptive control advantages for controlling non-linear
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 informationIndex. Index. More information. in this web service Cambridge University Press
A-type elements, 4 7, 18, 31, 168, 198, 202, 219, 220, 222, 225 A-type variables. See Across variable ac current, 172, 251 ac induction motor, 251 Acceleration rotational, 30 translational, 16 Accumulator,
More informationAppendix C. Modal Analysis of a Uniform Cantilever with a Tip Mass. C.1 Transverse Vibrations. Boundary-Value Problem
Appendix C Modal Analysis of a Uniform Cantilever with a Tip Mass C.1 Transverse Vibrations The following analytical modal analysis is given for the linear transverse vibrations of an undamped Euler Bernoulli
More information3 Rigid Spacecraft Attitude Control
1 3 Rigid Spacecraft Attitude Control Consider a rigid spacecraft with body-fixed frame F b with origin O at the mass centre. Let ω denote the angular velocity of F b with respect to an inertial frame
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 informationEQUIVALENT SINGLE-DEGREE-OF-FREEDOM SYSTEM AND FREE VIBRATION
1 EQUIVALENT SINGLE-DEGREE-OF-FREEDOM SYSTEM AND FREE VIBRATION The course on Mechanical Vibration is an important part of the Mechanical Engineering undergraduate curriculum. It is necessary for the development
More informationDIFFERENTIAL KINEMATICS. Geometric Jacobian. Analytical Jacobian. Kinematic singularities. Kinematic redundancy. Inverse differential kinematics
DIFFERENTIAL KINEMATICS relationship between joint velocities and end-effector velocities Geometric Jacobian Analytical Jacobian Kinematic singularities Kinematic redundancy Inverse differential kinematics
More informationPositioning Servo Design Example
Positioning Servo Design Example 1 Goal. The goal in this design example is to design a control system that will be used in a pick-and-place robot to move the link of a robot between two positions. Usually
More informationA Light Weight Rotary Double Pendulum: Maximizing the Domain of Attraction
A Light Weight Rotary Double Pendulum: Maximizing the Domain of Attraction R. W. Brockett* and Hongyi Li* Engineering and Applied Sciences Harvard University Cambridge, MA 38, USA {brockett, hongyi}@hrl.harvard.edu
More informationComputing Optimized Nonlinear Sliding Surfaces
Computing Optimized Nonlinear Sliding Surfaces Azad Ghaffari and Mohammad Javad Yazdanpanah Abstract In this paper, we have concentrated on real systems consisting of structural uncertainties and affected
More informationIntroduction to Feedback Control
Introduction to Feedback Control Control System Design Why Control? Open-Loop vs Closed-Loop (Feedback) Why Use Feedback Control? Closed-Loop Control System Structure Elements of a Feedback Control System
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 informationAcceleration Feedback
Acceleration Feedback Mechanical Engineer Modeling & Simulation Electro- Mechanics Electrical- Electronics Engineer Sensors Actuators Computer Systems Engineer Embedded Control Controls Engineer Mechatronic
More informationControl for. Maarten Steinbuch Dept. Mechanical Engineering Control Systems Technology Group TU/e
Control for Maarten Steinbuch Dept. Mechanical Engineering Control Systems Technology Group TU/e Motion Systems m F Introduction Timedomain tuning Frequency domain & stability Filters Feedforward Servo-oriented
More informationStable Limit Cycle Generation for Underactuated Mechanical Systems, Application: Inertia Wheel Inverted Pendulum
Stable Limit Cycle Generation for Underactuated Mechanical Systems, Application: Inertia Wheel Inverted Pendulum Sébastien Andary Ahmed Chemori Sébastien Krut LIRMM, Univ. Montpellier - CNRS, 6, rue Ada
More informationA NOTE ON RELATIONSHIP BETWEEN FIXED-POLE AND MOVING-POLE APPROACHES IN STATIC AND DYNAMIC ANALYSIS OF NON-LINEAR SPATIAL BEAM STRUCTURES
European Congress on Computational Methods in Applied Sciences and Engineering (ECCOMAS 212) J. Eberhardsteiner et.al. (eds.) Vienna, Austria, September 1-14, 212 A NOTE ON RELATIONSHIP BETWEEN FIXED-POLE
More informationFinite element analysis of rotating structures
Finite element analysis of rotating structures Dr. Louis Komzsik Chief Numerical Analyst Siemens PLM Software Why do rotor dynamics with FEM? Very complex structures with millions of degrees of freedom
More informationDr Ian R. Manchester Dr Ian R. Manchester AMME 3500 : Review
Week Date Content Notes 1 6 Mar Introduction 2 13 Mar Frequency Domain Modelling 3 20 Mar Transient Performance and the s-plane 4 27 Mar Block Diagrams Assign 1 Due 5 3 Apr Feedback System Characteristics
More informationINSTRUCTIONS TO CANDIDATES:
NATIONAL NIVERSITY OF SINGAPORE FINAL EXAMINATION FOR THE DEGREE OF B.ENG ME 444 - DYNAMICS AND CONTROL OF ROBOTIC SYSTEMS October/November 994 - Time Allowed: 3 Hours INSTRCTIONS TO CANDIDATES:. This
More informationPosition and orientation of rigid bodies
Robotics 1 Position and orientation of rigid bodies Prof. Alessandro De Luca Robotics 1 1 Position and orientation right-handed orthogonal Reference Frames RF A A p AB B RF B rigid body position: A p AB
More informationVibration Suppression Control of a Space Robot with Flexible Appendage based on Simple Dynamic Model*
213 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) November 3-7, 213 Tokyo, Japan Vibration Suppression Control of a Space Robot with Flexible Appendage based on Simple Dynamic
More informationRobot Manipulator Control. Hesheng Wang Dept. of Automation
Robot Manipulator Control Hesheng Wang Dept. of Automation Introduction Industrial robots work based on the teaching/playback scheme Operators teach the task procedure to a robot he robot plays back eecute
More informationLecture 9 Nonlinear Control Design
Lecture 9 Nonlinear Control Design Exact-linearization Lyapunov-based design Lab 2 Adaptive control Sliding modes control Literature: [Khalil, ch.s 13, 14.1,14.2] and [Glad-Ljung,ch.17] Course Outline
More information3 2 6 Solve the initial value problem u ( t) 3. a- If A has eigenvalues λ =, λ = 1 and corresponding eigenvectors 1
Math Problem a- If A has eigenvalues λ =, λ = 1 and corresponding eigenvectors 1 3 6 Solve the initial value problem u ( t) = Au( t) with u (0) =. 3 1 u 1 =, u 1 3 = b- True or false and why 1. if A is
More informationAdvanced Vibrations. Distributed-Parameter Systems: Approximate Methods Lecture 20. By: H. Ahmadian
Advanced Vibrations Distributed-Parameter Systems: Approximate Methods Lecture 20 By: H. Ahmadian ahmadian@iust.ac.ir Distributed-Parameter Systems: Approximate Methods Rayleigh's Principle The Rayleigh-Ritz
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 information9.1 Introduction to bifurcation of equilibrium and structural
Module 9 Stability and Buckling Readings: BC Ch 14 earning Objectives Understand the basic concept of structural instability and bifurcation of equilibrium. Derive the basic buckling load of beams subject
More informationMotion System Classes. Motion System Classes K. Craig 1
Motion System Classes Motion System Classes K. Craig 1 Mechatronic System Design Integration and Assessment Early in the Design Process TIMING BELT MOTOR SPINDLE CARRIAGE ELECTRONICS FRAME PIPETTE Fast
More informationD(s) G(s) A control system design definition
R E Compensation D(s) U Plant G(s) Y Figure 7. A control system design definition x x x 2 x 2 U 2 s s 7 2 Y Figure 7.2 A block diagram representing Eq. (7.) in control form z U 2 s z Y 4 z 2 s z 2 3 Figure
More informationVirtual Work and Variational Principles
Virtual Work and Principles Mathematically, the structural analysis problem is a boundary value problem (BVP). Forces, displacements, stresses, and strains are connected and computed within the framework
More information1 Trajectory Generation
CS 685 notes, J. Košecká 1 Trajectory Generation The material for these notes has been adopted from: John J. Craig: Robotics: Mechanics and Control. This example assumes that we have a starting position
More informationThe dynamics of a Mobile Inverted Pendulum (MIP)
The dynamics of a Mobile Inverted Pendulum (MIP) 1 Introduction Saam Ostovari, Nick Morozovsky, Thomas Bewley UCSD Coordinated Robotics Lab In this document, a Mobile Inverted Pendulum (MIP) is a robotic
More informationMCE493/593 and EEC492/592 Prosthesis Design and Control
MCE493/593 and EEC492/592 Prosthesis Design and Control Control Systems Part 3 Hanz Richter Department of Mechanical Engineering 2014 1 / 25 Electrical Impedance Electrical impedance: generalization of
More informationDynamics of structures
Dynamics of structures 2.Vibrations: single degree of freedom system Arnaud Deraemaeker (aderaema@ulb.ac.be) 1 Outline of the chapter *One degree of freedom systems in real life Hypothesis Examples *Response
More informationNatural and artificial constraints
FORCE CONTROL Manipulator interaction with environment Compliance control Impedance control Force control Constrained motion Natural and artificial constraints Hybrid force/motion control MANIPULATOR INTERACTION
More information