L ECTURE 10A: F EEDBACK - BASED C ONTROL 2A I NSTRUCTOR : G IANNI A. - PowerPoint PPT Presentation

16-311-Q I NTRODUCTION TO R OBOTICS L ECTURE 10A: F EEDBACK - BASED C ONTROL 2A I NSTRUCTOR : G IANNI A. D I C ARO

T O B E D O N E … Stability properties of linear systems Linearization of previous control systems Stability domain for feedback-based gains Other types of controllers? 2

CONTROLLABILITY OF A DYNAMICAL SYSTEM Time-invariant dynamical system with m control inputs u � � x = f ˙ x ( t ) , u ( t ) x ∈ R n , u ∈ R m , Control inputs are defined u ( t ) = K x ( t ) , K is an n × m feedback Gain matrix according to a feedback law : Controllability: Any initial state x (0) can be steered to any final state x 1 at a finite time t 1 based on the inputs from the feedback law. For a robot: All configurations can be achieved in finite time from a given initial configuration. Note: The trajectory between 0 and t 1 is not specified For non-linear dynamical systems, general For linear dynamical systems controllability criteria are not available! � � x ( t ) , u ( t ) = A x ( t ) + B u ( t ) f Local (in space and time) notions of algebraic criteria for controllability are available: controllability are employed C = [ B AB A 2 B · · · A n − 1 B ] , rank( C ) = n (C has full rank) 3

STABILITY OF A DYNAMICAL SYSTEM Equilibrium: A state x e of is said to be an equilibrium state if and only if x e = x (t; x e , u(t)=0) for all t ≥ 0. If a trajectory reaches an equilibrium state and if no input is applied the trajectory will stay at the equilibrium state forever (internal system’s dynamics doesn’t move the system away from the equilibrium point) For a linear system the zero state is a always an equilibrium state Stable equilibrium: An equilibrium state x e is said to be stable if and only if for any positive ε , there exists a positive number δ ( ε ) such that the inequality || x (0) − x e || ≤ δ Lyapunov stability implies that || x (t; x (0), u(t)=0) − x e || ≤ ε for all t ≥ 0. An equilibrium state x e is stable if the response following after starting at any initial state x(0) that is su ffi ciently near to x e will not move the state far away from x e . Asymptotically stable equilibrium: If the equilibrium x e is Lyapunov-stable and if every motion starting su ffi ciently near to x e converges (go back) to x e as t → ∞ . 4

I L L U S T R AT I O N O F S TA B I L I T Y T Y P E S Equilibrium u(t) = 0 u(t) ≷ 0 u(t) = 0 x e t t Stable equilibrium u(t) = 0 Lyapunov x e ε δ ( ε ) t Asymptotically Stable Lyapunov equilibrium u(t) = 0 x e δ ( ε ) t 5

CONTROLLABILITY VS. STABILIZABILITY Stabilizability: The problem of finding a feedback control law so as to make a closed-loop equilibrium point x e or admissible trajectory x e (t) asymptotically stable . Stabilizability is very important in practice to be able to cope with real-world disturbances u ( t ) = K ( x e ( t )- x ( t )) x e δ ( ε ) t Stabilizability of Linear dynamic systems: Controllability implies asymptotic (actually, exponential) stabilizability by a smooth state feedback law. In fact, the controllability condition implies that there exist choices of the constant gain matrix K such that the linear P control u ( t ) = K ( x e ( t )- x ( t )) makes x e (t) asymptotically stable Non-Linear systems: Linear systems: Controllability ? Stabilizability Controllability ➔ Stabilizability 6

LINEAR DYNAMIC SYSTEMS Given a linear dynamic system in the form of a homogeneous system of ODEs: x ( t ) = A x ( t ) + ˙ • Where will the system state go? ➔ Solve the system to find the time-dependent function x ( t ) for the evolution of the state variables. " dx 1 # " # " # " # x 1 ( t ) 4 8 x 1 ( t ) dt = A = dx 2 x 2 ( t ) 10 2 x 2 ( t ) dt The solution function for the state variables is the following, with c 1 and c 2 integration constants depending on the initial point x (0): c 1 e 12 t + c 2 4 e − 6 t 2 3 " # " # " # x 1 ( t ) 1 4 e 12 t + c 2 5 = c 1 e − 6 t = 4 c 1 e 12 t − c 2 5 e − 6 t x 2 ( t ) 1 − 5 " # " # 1 4 A’s eigenvalues A’s eigenvectors λ 1 = 12 , λ 2 = − 6 and r 1 = , r 2 = 1 − 5 In the general case of a system with n state variables (equations) x ( t ) = c 1 r 1 e λ 1 t + c 2 r 2 e λ 2 t + . . . c n r n e λ n t 7

LINEAR DYNAMIC SYSTEMS • Where are the equilibrium points? Answering means to first find the fixed points (the attractors , in general) that correspond to setting to zero the rate of variability of the state variables. In the example, the fixed points are the solutions of: " # " # " # 0 4 8 x 1 ( t ) = 0 10 2 x 2 ( t ) • What will the system do in correspondence of the fixed points? Is the system (asymptotically) stable ? If we place the system close to a fixed point, or, similarly, we disturb a system at a fixed point, will the system go back to the fixed point, or will it diverge from it? What about the behavior at any other point? For a linear system , a stability analysis for the fixed points can be performed through the calculation of the eigenvalues of the matrix of the coe ffi cients. The eigenvalues are the solution of the characteristic equation det(A - λ I) = 0, and determine the time evolution of the system along the principal directions of the eigenvectors 8

R E C A P O N E I G E N VA L U E S A N D E I G E N V E C T O R S Symmetric matrix: eigenvectors forms an orthogonal basis 9

(LINEAR) STABILITY BEHAVIOR VS. EIGENVALUES State behavior in the vicinity of a fixed point in relation to its stability based on the eigenvalues (the value of y axis quantifies the distance from the fixed point) 10

NON-LINEAR DYNAMICAL SYSTEMS? A non-linear system can be linearized around a (fixed) point , and studied with the same methods. The e ff ectiveness of the linearization decreases with the distance from the fixed point itself and with the stability characteristics of the point . Hartman-Grobman theorem: In a hyperbolic equilibrium point where all eigenvalues have non- zero real parts, the flows of the linearized and nonlinear system are (topologically) equivalent near the equilibrium. In particular, the stability of the nonlinear equilibrium is the same as the stability of the equilibrium of the linearized system. Hyperbolic point (near the point 11 trajectories resemble hyperbolas) Saddle point

…. OUR LINEAR FEEDBACK CONTROL LAWS? This is what we have derived: v ( t ) = K ρ ρ ( t ) γ ( t ) = K α α ( t ) + K β β ( t ) 2 3 − cos( α ) 0 2 3 ˙ ρ 6 sin( α ) 7 " # v 6 7 − 1 6 7 ˙ 5 = α 6 7 ρ 6 7 6 7 ω 4 6 7 ˙ − sin( α ) β 4 5 0 ρ     − K ρ ρ cos( α ) ˙ ρ ?? Asymptotically stable as long as:     − K ρ sin( α ) − K α α − K β β ˙  = α K ρ > 0 , K β < 0 , K α − K ρ > 0        ˙ β − K ρ sin( α ) It’s NOT linear in the state ⇥ ⇤ ρ ( t ) α ( t ) β ( t ) Linearization around the fixed point [0 0 0] 12

LINEARIZATION OF THE CONTROL LAW     − K ρ ρ cos( α ) ˙ ρ In a small neighborhood of [0 0 0]:     − K ρ sin( α ) − K α α − K β β cos(x) = 1, sin(x) = x ˙  = α        ˙ β − K ρ sin( α )       ˙ 0 0 ρ − K ρ ρ Linearization       ˙  = 0 − ( K α − K ρ ) α − K β α       around the fixed point [0 0 0]      ˙ 0 0 β − K ρ β A The characteristic polynomial of the coe ffi cient (gain) matrix A is λ 2 + λ ( K α − K ρ ) − K ρ K β all roots have negative real part (i.e., stability) if � �� � λ + K ρ K ρ > 0 , K β < 0 , K α − K ρ > 0 For robust pose control , the following strong stability conditions ensures that the robot does not change direction approaching the goal , implying that conditions on 𝛽 ⇣ − π 2 , π i If α (0) ∈ I f = ⇒ α ( t ) ∈ I f ∀ t K α + 5 3 K β − 2 2 K ρ > 0 , K β < 0 , π K ρ > 0 If α (0) ∈ I b =¯ 13 I f ⇒ α ( t ) ∈ I b ∀ t

FUNCTION LINEARIZATION 14