Professional Documents
Culture Documents
Para una entrada en salto de posicin dL ( s )=A / s , el error de posicin del estado
estacionario del sistema est dado por:
Para el error de posicin en estado estacionario, la contribucin de las perturbaciones
debidas al efecto centrfugo es cero cuando el tiempo se aproxima a infinito. La razn
para esto es que el efecto centrifugo es una funcin de 2L (t) y, cuando el tiempo
tiende a infinito, L () tiende a cero. De aqu que su contribucin al error de
posicin en estado estacionario es nula. Si el par calculado comp ( t ) es equivalente a
la carga gravitatoria del elemento, entonces el error de posicin en estado estacionario
se reduce a:
Que tiene un error en estado estacionario finito. El clculo comp ( t ) depende del
modelo dinmico del manipulador. En general, tal como se estudi en el capitulo3, las
ecuaciones de movimiento de Lagrange-Eules de un manipulador de seis
articulaciones, excluyendo las dinmicas del dispositivo de control electrnico, el
rozamiento de los engranajes y el huelgo se puede escribir como ecuacin (3.2-24)
Donde
( t )=Da ( q ) { qd ( t ) + Kv [ q d ( t )q
(t) ] + K [ q d ( t )q (t) ] }+h ( q , q ) +c ( q )
v a a
(5.3-65)
Donde Kv y Kp son las matrices de ganancia de realimentacin de posicin y de
velocidad 6 x 6, respectivamente, y el manipulador tiene 6 grados de libertad.
Sustituyendo (t ) de la ecuacin (5.3-65) en la ecuacin (5.2-26 tenemos
{
}
D ( q ) q ( t )+ h ( q , q )+ c ( q )=Da ( q ) qd ( t ) + Kv [ q d ( t )q ( t ) ] + K v [ q d ( t ) q ( t ) ] +ha ( q , q ) +c a ( q )
(5.3-66)
Si Da (q), ha (q, q), ca (q) son iguales de D (q), h (q, q), c (q), respectivamente,
entonces la ecuacin (5.3-66) se reduce a
D ( q ) [ e ( t ) + K v e ( t ) + K p e ( t ) ]=0 (5.3-67)
Donde e ( t ) q d ( t ) q ( t ) y e ( t ) qd ( t ) q( t) .
Una ley de control anloga en el espacio de las variables de articulacin se puede deducir de
las ecuaciones de movimiento N-E para controlar el brazo del robot. La ley de control recursiva
se puede obtener sustituyendo qi ( t) en las ecuaciones de N-E para obtener el par de
articulacin necesario para cada actuador
n n
qi ( t )=qdi ( t )+ K ijv [ q d ( t )q ( t ) ] + K ijp [ qd ( t )q ( t ) ] (5.3-69)
j=1 j=1
ij ij
Donde Kv y Kp son las ganancias de realimentacin de la posicin y de la derivada
d
para la articulacin i respectivamente y e i ( t )=q ( t )q ( t )
es el error de posicin para la
articulacin J. La interpretacin fsica de poner la ecuacin (5.3-69) en la forma de ecuacin recursiva de
N-E se puede ver como siguen:
1. El primer trmino genera el par deseado para cada articulacin si no hay error
de modelizacin y se conoce los parmetros fsicos de sistema.
Sin embargo, existen errores debido al huelgo, al rozamiento de los engranajes,
a la incertidumbre respecto a los parmetros de inercia y a los retardos en el
lazo de control de manera que sern inevitables desviaciones en la trayectoria
de la articulacin deseada
2. Los trminos restantes en las ecuaciones de movimiento de N-E generan el par
de correccin para compensar pequeas desviaciones de la trayectoria de la
articulacin deseada
La ley de control recursiva anterior es un control proporcional ms derivativo y
tiene el efecto de compensar cargas inerciales, efectos de acople y cargas de
gravedad de los elementos. Para conseguir un sistema amortiguado crticamente
para cada uno de los subsistemas de las articulaciones (lo que una vez cierta forma
implica que el sistema global se comporta como un sistema amortiguado
crticamente), las matrices de ganancia de realimentacin Kp y Kv (matrices
diagonales) se puede escoger tal como se plante en la seccin 5.33, o como Paul
(1981) o Luh (1983b).
En resumen, la tcnica del par calculando es un control de compensacin
anticipativa. Basado en las ecuaciones de movimiento completas de L-E, se pueden
calcular los pares de las articulaciones en tiempo O ( n4 ). La ley de control
analgico derivada de las ecuaciones de movimiento de N-E se puede calcular en
tiempo O(n). Una de las desventajas principales de esta tcnica de control es que la
convergencia del vector de error de posicin depende de los coeficientes dinmicos
D (q), h (q, q) y c (q) en las ecuaciones de movimiento.
5.3.5 Compensacin de Sistema controlados digitalmente
En un sistema de control muestreado, el tiempo se normaliza al periodo de
muestreo t ; es decir, la velocidad se expresa en radianes por t en lugar
de en radianes por segundos. Esto tiene el efecto de hacer un cambio de escala en
la inercia equivalente del elemento mediante un factor f 2s donde f s es la
frecuencia de muestreo ( f s=1/ t ).
uT =[ 1 ( t ) , 2 ( t ) , n(t) ] (5.4-2)
x 1(t)=x 2 (t)
tf
J = dt=t f t 0 (5.4-7)
t0
Las condiciones necesarias para que v*(t) sea un control optimo son
x, p,u
H para todo t [ t 0 ,t f ] (5.4-9)
x ( t )=
x, p,u
H para todo t [ t 0 ,t f ] (5.4-
p ( t )=
10)
x, p,u H (x, p,u)
para todo t [ t 0 ,t f ] (5.4-11)
H
Y para todos los controles admisibles. Obteniendo y*(t) de las ecuaciones (5.4-8) a (5.4-
11), el problema de optimizacin se reduce a un problema de valores fronteras con
condiciones sobre el estado x(t) en los instantes de tiempo inicial y final.
Debido a la no linealidad de las ecuaciones de movimiento, una solucin numrica es
normalmente el nico enfoque de este problema. Sin embargo, la solucin numrica
solamente calcula la funcin de control (control enlazo abierto) y no considera ninguna
perturbacin sobre el sistema. Adems, la solucin es ptima para las condiciones
iniciales y final especificadas. Por tanto, se tienen que efectuar los clculos de control
ptimo para cada movimiento del manipulador. Ms aun, en la prctica, los
procedimientos numricos no proporcionan una solucin aceptable para el control de
manipuladores mecnicos. Por tanto, como una alternativa a la solucin numrica,
Kahn y Roth (1971) propusieron una aproximacin al control ptimo que resulta en un
control sub ptimo en tiempo mnimo
El control de realimentacin sub ptimo se obtiene aproximando el sistema no lineal
(ecuacin (54.-4)) mediante un sistema lineal y determinando analticamente un
control ptimo para el sistema lineal. El sistema lineal se obtiene mediante un cambio
de variables seguido por una linealizacin de las ecuaciones de movimiento. Se utiliza
una transformacin para desacoplar los controles en el sistema linealizado. Definiendo
un nuevo conjunto de variables dependientes, i ( t )=1, 2,3, 4, .2 n se pueden
trasformar las ecuaciones de movimiento, utilizando las nuevas variables de estado, a
i ( t )=x i ( t ) xi ( t f ) i=1, 2,3, 4, . n
( t )= A ( t )+ B v ( t ) (5.4-14)
2i1 ( t )=v i
v +
i
Donde v
i v i y
+
v i =( ui ) max +c i
v i =( ui )max + c i
(5.4-16)
Donde Ci es el elemento i-esimo del vector C.
Desde este punto se pueden obtener por el procedimiento usuales una solucin al
problema del control en tiempo optimo y de las superficies de conmutacin*. El
control sub optimo linealizacion y desacoplado (ecuaciones (5.4-15) y (5.4-16)
generalmente resulta en tiempos de respuestas y trayectoria que estn
razonablemente prximos a las soluciones de tiempo ptimo. No obstante, ese mtodo
de control es normalmente demasiado complejo para poderse utilizar con
manipuladores con cuatro o ms grados de libertad y desprecia los efectos de las
cargas externas desconocidas.
5.5 CONTROL DE ESTRUCTURA VARIABLE
En 1978, Young (1978) propuso utilizar la teora de los sistemas de estructura variable
para el control de manipuladores. Loa sistemas de estructura variable (VSS) son una
clase de sistemas con control por realimentacin descontinuo.
Durante los ltimos veinte aos, la teora de sistemas de estructura variable ha
encontrado numerosas aplicaciones en el control de diversos procesos en la industria
aeroespacial, qumica y siderrgica. La caracterstica principal del VSS es que tiene el
denominado modo deslizante sobre la superficie a variaciones en los parmetros y a las
perturbaciones y sus trayectorias yacen en la superficie de conmutacin. Es esta
propiedad de insensibilidad del VSS lo que nos permite eliminar las interacciones entre
las articulaciones de un manipulador. El fenmeno deslizante no depende de los
parmetros del sistema y tiene una prioridad estable. Por tanto, se puede utilizar la
teora de los VSS para disear un controlador de estructura variable VSC que induce el
modo deslizante y en el cual permanecen las trayectorias del brazo del robot. Tal
diseo de un controlador de estructura variable no requiere una modelizacin
dinmica precisa del manipulador; las acotaciones de los parmetros del modelo son
suficientes para construir el controlador. El control de estructura variable difiere del
control en tiempo ptimo en el sentido de que el controlador de estructura variable
induce el modo deslizante en el cual permanecen las trayectorias del sistema. Ms aun,
el sistema es insensible a variaciones en sus parmetros cuando est en el modo
deslizante.
Consideremos el control con estructura variable para un manipulador con seis
elementos. De la ecuacin (5.4-1), definiendo el vector de estado X T (t) como
6
q1 , q6 , q 1 q
x T =
6
p1 , p6 , v 1 v =
T T
( p , v ) (5.5-1)
v 1 ( t ) =f 2 ( e1 + pd , v ) + b( e1 + pd , v )u (t) (5.5-2)
EJERCICIOS