Matemáticas de Sistemas Dinámicos en Robótica
Matemáticas de Sistemas Dinámicos en Robótica
7
2. Descripción Matemática de Sistemas Notas de CAUT2 - 8
El estado x(t0 ) resume toda la historia del sistema desde −∞ hasta t0 : conociendo el
valor de ángulo θ y velocidad angular θ̇ en t0 , podemos predecir la respuesta del brazo de
robot a valores de torque u para todo t ≥ t0 .
Podemos pensar que la entrada para t ≥ t0 y las condiciones iniciales x(t0 ) determinan la
evolución del sistema para t ≥ t0
(
x(t0 )
x(t), t ≥ t0 W
u(t), t ≥ t0
El ejemplo del brazo de robot es finito-dimensional, puesto que el estado x(t) en un ins-
tante cualquiera de tiempo t puede ser caracterizado completamente por un número finito
de parámetros (en este caso, dos: ángulo y velocidad angular).
Un ejemplo de sistema infinito-dimensional aparece en el problema de regulación de la
temperatura del aula por medio de acondicionadores de aire. La temperatura aparece como
una distribución en todo el volumen del aula, y su caracterización completa requiere un
número infinito de datos (la temperatura en todos los puntos del aula).
El término en tiempo continuo se refiere al hecho de que la variable t es continua, en
contraste al caso de un sistema definido por una ecuación diferencia
tenemos que
(
x1 (t0 ) + x2 (t0 )
x1 (t) + x2 (t), t ≥ t0 W (2.3)
u1 (t) + u2 (t), t ≥ t0
(
αxi (t0 )
αxi (t), t ≥ t0 W α ∈ R. (2.4)
αui (t), t ≥ t0
de donde siguen
Las ecuaciones algebraicas (2.9) permiten computar x̂(s) y ŷ(s) de x(0) y û(s). Las trans-
formadas inversas dan x(t) e y(t). Asignando x(0) = 0 vemos que la matriz transferencia
del sistema es
Ĝ (s) = C (sI − A)−1 B + D
En M ATLAB las funciones tf2ss y ss2tf permiten pasar de una representación a otra.
Ejemplo 2.1. Supongamos que el brazo de robot trabaja tomando objetos de distinta masa.
Entonces m varı́a con cada objeto y tenemos que escribir
Ejemplo 2.2. Consideremos un cohete a reacción que asciende en forma vertical de la su-
perficie de la tierra. La fuerza de propulsión es el producto ve u0 , donde ve < 0 es la veloci-
dad relativa de escape de gases, y u0 < 0 la velocidad de variación de masa ṁ(t), supuestas
constantes. Asumiendo la aceleración de la gravedad g constante,
m(t)ḧ(t) = −m(t) g + ve u0 .
2. Descripción Matemática de Sistemas Notas de CAUT2 - 11
mt
ḣ t
ht
2.5. Linealización
La gran mayorı́a de los sistemas fı́sicos son no lineales. Una clase importante de ellos se
puede describir por las ecuaciones de estado
ẋi (t) = f i ( x1 (t), . . . , xn (t); u1 (t), . . . , um (t); x1 (t0 ), . . . , xn (t0 ); t) xi (t0 ) = xi0 .
5
2
ut
ẋ1 t
x1 t
yt
2
2
03
ẋ2 t
x2 t
3
Una ecuación de estado lineal es una herramienta útil para describir sistemas como
(2.11) en forma aproximada. El proceso de obtención de un modelo lineal a partir de uno no
lineal se llama linealización.
La linealización se realiza alrededor de un punto o trayectoria de operación, definida por
valores nominales x̃(t), x̃0 y ũ(t) que satisfacen (2.11),
(
x̃(t0 )
x̃(t), t ≥ t0 W
ũ(t), t ≥ t0
Nos interesa el comportamiento de la ecuación no lineal (2.11) para una entrada y estado
inicial “cercanos” a los valores nominales, es decir u(t) = ũ(t) + uδ (t) y x0 = x̃0 + x0δ para
uδ (t) y x0δ suficientemente pequeños para t ≥ t0 .
x0 xt
x̃0 xδ t
x̃ t
x̃˙ (t) + x̃˙ δ (t) = f ( x̃(t) + xδ (t), ũ(t) + uδ (t), t), x̃(t0 ) + xδ (t0 ) = x̃0 + x0δ
∂ fi ∂ fi
f i ( x̃ + xδ , ũ + uδ , t) ≈ f i ( x̃, ũ, t) + ( x̃, ũ, t) xδ1 + · · · + ( x̃, ũ, t) xδn
∂x1 ∂xn
∂ fi ∂ fi
+ ( x̃, ũ, t)uδ1 + · · · + ( x̃, ũ, t)uδm (2.12)
∂u1 ∂um
Repitiendo la operación para cada i = 1, . . . , n, y volviendo a la notación vectorial,
obtenemos
∂f ∂f
x̃˙ (t) + x̃˙ δ (t) ≈ f ( x̃(t), ũ(t)) + ( x̃, ũ, t) xδ + ( x̃, ũ, t)uδ
∂x ∂u
∂f
donde la notación ∂x
representa el Jacobiano, o Matriz Jacobiana, del campo vectorial f con
respecto a x,
∂ f1 ∂ f1 ∂ f1
∂x ∂x2
... ∂xn
∂ f1 ∂ f ∂ f2
∂f
2 2
. . .
, ∂x1 ∂x2 ∂xn
∂x
. . . . . . . . . . . .
∂ fn ∂ fn ∂ fn
∂x1 ∂x2
. . . ∂x n
Dado que x̃˙ (t) = f ( x̃(t), ũ(t), t) , x̃(t0 ) = x̃0 , la relación entre xδ (t) y uδ (t) (el modelo
incremental) queda aproximadamente descripto por una EE lineal inestacionaria de la forma
donde
∂f ∂f
( x̃(t), ũ(t), t) , B(t) =
A(t) = ( x̃(t), ũ(t), t) .
∂x ∂u
De igual manera se expande la ecuación de salida y(t) = h( x(t), u(t), t), de donde obtene-
mos la aproximación lineal
∂h ∂h
C (t) = ( x̃(t), ũ(t), t) , D (t) = ( x̃(t), ũ(t), t) .
∂x ∂u
Notar que las EE obtenidas por linealización van a ser en general inestacionarias, aún
cuando las funciones originales f y h sean estacionarias, debido a que las matrices Jacobia-
nas se evalúan a lo largo de trayectorias y no puntos estacionarios.
Ejemplo 2.4. Consideremos el péndulo invertido sobre un carro móvil de la Figura 2.6. Las
ecuaciones de movimiento son
m
q
mg
u
M
Ml + m sin2 x3
Como trayectoria de operación tomamos θ̃ (t) ≡ 0, ũ(t) ≡ 0 ∀t, que es fácil ver que sa-
tisface f ( x̃(t), ũ(t)) ≡ 0 (es un equilibrio). Las matrices A y B de los respectivos Jacobianos
de f evaluados sobre esta trayectoria son
0 1 0 0 0
∂f 0 0 − mg M
0 ∂f 1
M .
A= (0, 0) = B = ( 0, 0 ) =
∂x ∂u
0 0 0 1 0
( M+m) g 1
0 0 Ml
0 − Ml
Ejemplo 2.5 ((Rugh 1995)). Volvemos al cohete del Ejemplo 2.2. Las ecuaciones de movi-
miento eran
m(t)ḧ(t) = −m(t) g + ve u(t) ,
donde ahora tomamos la velocidad de cambio de masa libre u(t) = ṁ(t) (Ejercicio 2.2).
Definiendo m(t) como una variable de estado más, y denotando x1 (t) = h(t), x2 (t) = ḣ(t),
x3 (t) = m(t), y tomando u(t) como una entrada independiente llegamos al modelo no
lineal
x2 (t)
ẋ1 (t)
ẋ2 (t) = − g + ve u(t) .
ẋ3 (t)
x3 (t)
u(t)
Consideramos ahora su linealización alrededor una trayectoria nominal correspondien-
te a un valor constante de la entrada u = u0 < 0. No es difı́cil calcular la trayectoria nomi-
nal explı́citamente mediante integración directa, primero de x3 (t), luego x2 (t) y finalmente
1
Por simplicidad no escribimos la dependencia temporal de x y u.
2. Descripción Matemática de Sistemas Notas de CAUT2 - 15
donde k y m son números enteros. Notar que en el caso discreto los impulsos son fácilmente
realizables fı́sicamente.
En un sistema lineal discreto toda secuencia de entrada u[k] puede representarse me-
diante la serie ∞
u[k] = ∑ u[m]δ [k − m] .
m=−∞
Si g[k, m] denota la salida de una sistema discreto a una secuencia de impulsos aplicada
en el instante m, entonces tenemos que
δ [k − m] → g[k, m]
δ [k, m]u[m] → g[k, m]u[m] (por homogeneidad)
∑ δ[k, m]u[m] → ∑ g[k, m]u[m] (por aditividad) .
m m
Ası́ la salida y[k] excitada por la entrada u[k] puede representarse mediante la serie
∞
y[k] = ∑ g[k, m]u[m] . (2.13)
m=−∞
Si el sistema es causal no habrá salida antes de que la entrada se aplique, por lo que
causalidad ⇔ g[k, m] = 0 para k < m.
Para sistemas discretos causales la representación (2.13) se reduce a
k
y[k] = ∑ g[k, m]u[m] ,
m=k0
y en el caso estacionario
2.7. Resumen
La matriz transferencia es racional sii el sistema es lineal, estacionario y de dimensión
finita.
A diferencia del caso continuo, los retardos puros no necesariamente dan lugar a un
sistema discreto distribuido.
ŷ(s) = Ĝ (s)û(s)
R∞
dim. fin., lineal, est. ẋ = Ax + Bu y(t) = t0 G (t, τ )u(τ )dτ
y = Cx + Du ŷ(s) = Ĝ (s)û(s)
2.8. Ejercicios
Ejercicio 2.1. A partir de la definición de transformada de Laplace de y(t)
Z ∞
ŷ(s) = y(t)e−st dt
0
Ejercicio 2.2. ¿Cómo se modifica el sistema del cohete si la velocidad de cambio de masa
u0 es u(t) = ṁ(t)? Escribir las EE y clasificarlo.
2. Descripción Matemática de Sistemas Notas de CAUT2 - 18
y(t) = u(t − T ) .
probar que para un sistema lineal estacionario discreto ŷ( z) = ĝ( z)û( z).
Bibliografı́a
Chen, C.-T. (1999), Linear System Theory and Design, 3rd edn, Oxford University Press.
Doyle, J. C., Francis, B. A. & Tannenbaum, A. (1992), Feedback control theory, Macmillan Pub.
Co.
Goodwin, G., Graebe, S. & Salgado, M. (2000), Control System Design, Prentice Hall.
Goodwin, G. & Sin, K. (1984), Adaptive Filtering Prediction and Control, Prentice-Hall, New
Jersey.
Van Loan, C. (1978), ‘Computing integrals involving the matrix exponential’, IEEE Trans.
Automat. Contr. AC-23(3), 395–404.
193