Академический Документы
Профессиональный Документы
Культура Документы
CONTROL DE FUERZA
Dr. José C. Pineda Castillo (Ph.D.)
CIATEQ AC
Calzada del Retablo No. 150
76150, Querétaro, Qro.
Tel: +442 211 2610 • Fax: +442 211 2609
jpineda@ciateq.mx
March 16, 2004
RESUMEN
1
Dr. José C. Pineda Castillo, (Ph.D.) • jpineda@ciateq.mx • Tel. +442 211 2610 2
El valor de las masas suspendidas, tiene una influencia sobre el valor de ∆e (i),
comprendida en este intervalo de realizaciones de ∆e (i). Con la ayuda del gato,
la descarga se realiza lentamente y no instantáneamente, por lo que el valor
total o efecto total de este tipo de perturbación P T C, sobre la fuerza que actúa
sobre la celda de prueba, se dosifica temporalmente con la dinámica del gato.
Cuando el sistema regula la fuerza en la descarga, compensa la influencia de
la perturbación descrita, posicionando el marco móvil con movimientos positivos
progresivos hasta que:
∆e (i) ≈ 0
Una buena dinámica del gato facilitará esta tarea. Bajo estas condiciones de
regulación de la fuerza en la descarga, cuando el autómata termina la descarga
va al estado 3 − 4 − 8 [1], al terminar este estado se detiene el gato y selecciona
sus nuevas masas, para iniciar después el estado 2 − 4 y llegar al estado 2-4-7
[1]. En éste posa las nuevas masas sobre la balanza; si el valor de la fuerza que
será cargada es inferior a la que pesaba y si el lazo de regulación de la fuerza se
abre en este momento, entonces ahora por efectos de la histéresis, si la carga se
efectuara instantáneamente se producirá un efecto interpretable a que el marco
móvil se desplazó positivamente (virtualmente) una distancia función del valor
de las masas que se cargaron, produciendo una sobrecarga gradual por la nueva
posición Pre (i) > Pe (i), acompañado de un aumento gradual del desplazamiento
de carga, hasta que éste alcance el valor de ∆e (i). La variable ∆e (i) tendrı́a
entonces una nueva realización, ahora dentro del intervalo:
∆e (i) ≈ 0
También una buena dinámica del gato facilitará esta tarea. De la misma forma
que para la descarga, con la ayuda del gato la carga se realiza lentamente y no
instantáneamente, por lo que el valor total o efecto total de esta perturbación
P T C sobre la fuerza que actúa sobre la celda de prueba, se dosifica temporal-
mente con la dinámica del gato.
La dinámica del sistema se caracteriza por una dinámica de un sistema con
tres modelos de segundo orden, es decir con tres modos diferentes de oscilación,
dependiendo de la magnitud de la fuerza.
La variable i denota los valores de las variables en el ciclo de carga
presente (i ) o los valores de las variables en el ciclo de carga anterior (i − 1) .
Un ciclo de trabajo o de calibración, se realiza por medio i ciclos de carga, con
i = 1, 2, ..., n, donde normalmente n = 10.
Dr. José C. Pineda Castillo, (Ph.D.) • jpineda@ciateq.mx • Tel. +442 211 2610 4
(a) Las primeras perturbaciones que llamaremos PTC (Fig. 1) o fp1 (i),
son producidas por la incertidumbre de la distancia en la que se pro-
duce el contacto de la esfera, con respecto a Pe , §1.1. Estas pertur-
baciones actúan sobre la dinámica de la transferencia del desplaza-
miento de carga en desplazamiento de deformación, en la descarga
y en la carga en los estados 3 − 4 − 7 y 2 − 4 − 7 respectivamente
[1]. Esta transferencia es posible únicamente cuando la posición del
marco móvil esté en la vecindad de Pe (i), con la balanza en contacto
de esfera. Esta transferencia al no ser instantánea se produce con una
dinámica de segundo orden y se dosifica con la dinámica del gato (ve-
locidad, aceleración, inercia), entonces con esta misma dinámica se
dosifica la acción de las perturbaciones sobre la fuerza que deberı́a
ser constante sobre la celda de prueba [1]. Estas perturbaciones son
compensables con la acción del CAF, teniendo en el lazo interno al
CAP, Figura 1.
(b) Las segundas perturbaciones que llamaremos PIM (Fig. 1), son
producidas por la inercia del desplazamiento del marco móvil en el
estado 3-4 y 2-4-8, con un efecto de alijeramiento o de sobrepeso
respectivamente, sobre la fuerza que está aplicada sobre la celda de
prueba. Estas perturbaciones se compensan con el CAP, teniendo el
Dr. José C. Pineda Castillo, (Ph.D.) • jpineda@ciateq.mx • Tel. +442 211 2610 7
Sin embargo esta transferencia tiene una dinámica que modifica las apreciaciones
del modelo estático [Ref 1, Capı́tulo 5] ya que se perturba con el efecto de la
inercia y especialmente por la perturbación PTC de la incertidumbre sobre la
posición exacta del marco móvil y balanza en la posición de equilibrio Pe (i).
Considerando el mismo valor de la consigna de fuerza (65KN con un de-
splazamiento equivalente de 2mm) que el de la figura 2 (pero convirtiendo los
valores de desplazamiento a su equivalente exacto en fuerza [1], para apreciar
mejor el efecto de la perturbación), pero considerando ahora que el marco móvil
con la balanza se encuentra (caso real) en la vecindad de Pe (i) con contacto de
esfera y no exactamente en Pe (i). Tendremos entonces un valor de ∆e (i) (ver
la §1.1) dentro del intervalo 0mm < ∆e (i) < 0.17mm. El valor de la fuerza
una vez levantadas las masas instantáneamente, evolucionarı́a reduciendo grad-
ualmente su valor hasta alcanzar su valor final fe (equivalente en fuerza al
desplazamiento de carga de ); en este caso real el valor final está muy lejos del
valor de la consigna, Figura 3 (Consigna Cf = 65KN t con un equivalente en
desplazamiento de carga de 2mm, Fig 2).
Este valor final fe (de ) que se produce por el efecto de la perturbación total
en la gráfica de la figura 3, serı́a muy difı́cil de compensar si se realiza la descarga
en forma instantánea: es por ello que se debe dosificar la descarga por medio
de una dinámica lenta del gato y de esta forma dosificar en el tiempo el efecto
de la perturbación total, compensando sus efectos por medio del CAF.
La figura 4, nos presenta una parte de la evolución de la dinámica de la
transferencia de carga similar a la de la figura 3, pero con una dinámica lenta
del gato en la descarga en el estado 3-4-7. El intervalo de muestreo del eje
temporal de la figura 4, es de 0.05 s y el valor de la fuerzan inicial es de 150
KNt. De la misma forma la evolución de la transferencia de carga en el estado 2-
4-7, en donde se cargan las masas para dar la nueva fuerza, se realiza dosificando
con la dinámica lenta del gato la carga de las masas y el efecto de la perturbación
PTC debida al valor de ∆e (i), dentro del intervalo −0.345mm < ∆e (i) < 0mm.
La figura 5 nos presenta una parte de esta evolución para una fuerza inicial de
140 KNt con un intervalo de muestreo de 0.05 s.
Donde fg (i) es la fuerza sobre la celda de prueba y δfg (i) es la variación sobre
fg (i) producida por la transferencia de carga a desplazamiento [1] y por las
perturbaciones, tal que:
Z dePorlalocarga
tanto para mantener la fuerza f (d ) constante o regulada al valor
e e
(consigna) que se está descargando (cargando) en el estado
3 − 4 − 7 (2 − 4 − 7), se requiere controlar la posición del marco móvil,
de tal forma que la balanza en el referncial de dicho marco, se posicione
y mantenga en la posición de equilibrio Pe . Estando entonces el marco
móvil en Pe , esta posición debe mantenerse a un valor casi constante, es
decir a un valor :
Pe (i) + δPe (i) (4)
Donde δPe (i) será el incremento de posición o variaciones producidas por el reg-
ulador, de tal forma que compense las variaciones δf (i) para dar como resultado
una fe (i) constante ± el error especificado. En teorı́a δfg (i) (δdg (i)) es muy
pequeño [1], puesto que en la transferencia de carga en la posición exacta Pe :
Alrededor de este valor pequeño actúa la perturbación dp2 (i), cuando el regulador
ya ha compensado los efectos de la perturbación fp1 (i) (dp1 (i)) y entonces la
balanza se encuentra prácticamente en la posición de equilibrio.
La influencia temporal (en cada instante de muestreo) de la perturbación
fp1 (i) dependerá de las caracterı́sticas del desplazamiento del gato en el estado
3 − 4 − 7 y en el estado 2 − 4 − 7, ver la §1.1.
La perturbación es entonces crı́tica exactamente en el momento de la descarga
(carga) por la incertidumbre de la balanza con respecto a la posición de equi-
librio: perturbación fp1 (i) (dp1 (i)). Se debe por lo tanto reducir el efecto de las
perturbaciones mencionadas, moviendo el gato lentamente en el estado 3 − 4 − 7
y en el estado 2 − 4 − 7, ver §1.1 y referencia [1].
Dr. José C. Pineda Castillo, (Ph.D.) • jpineda@ciateq.mx • Tel. +442 211 2610 12
La magnitud de las variaciones δPe (i) dependerá del error entre la fuerza
de consigna Cf y la fuerza fe medida por medio de la celda de referencia. Si
el error es pequeño entonces la magnitud de las variaciones es muy pequeña;
dependerá entonces de la estrategia de control del regulador y del error entre la
fuerza de consigna Cf (i) y la fuerza real fe (figura 1) sobre la celda de prueba
en la descarga (carga). Dicha estrategia expresada en los términos más sencillos
para entender la idea, podrı́a ser la de una ganancia Gv cuyo valor dependerá
del modo de oscilación en el que se encuentre el sistema, dado el valor de la
consigna. En otras palabras el valor ajustado de Gv (tuning del regulador)
pertenecerá a un conjunto de tres elementos, seleccionables dependiendo del
valor de la consigna dentro del modelo lineal por segmentos, de tal forma que:
δPe (i) = G1 (Cf (i) − fe (i)), ..., δPe (i) = G3 (Cf (i) − fe (i)) (7)
Pc1 (i, k) = Pe (i) + y1 (i, k), ..., Pc3 (i, k) = Pe (i) + y3 (i, k) (9)
w(z −1 ) 1.7404z −1
= (6)
V (z −1 ) 1.0 − 0.6519z −1
θ(z −1 ) 0.63662
= (7)
ω(z )
−1 1.0 − z −1
Donde 0.63662 = 636.62Tm y el intervalo de muestreo Tm = 0.001. Es decir que
a una velocidad constante de 1rad/seg, tendrı́amos en la salida del integrador
637 puntos cada segundo, es decir un radian cada segundo como se ve en la
figura 6.a. Si desearamos ver la evolución dinámica de la flecha en radianes, el
numerador de la relación 6 serı́a 0.001. Para fines de modelación y simulación
por el método de los Tableros Dinámicos, el integrador es un TD y se conecta
en cascada con el motor servoamplificador de la relación 6 de esta misma §.
Tendrı́amos ası́ tres TD’s: El CDA, el motor servoamplificador y el encoder.
Sin embargo es posible tener dos TD’s: El CDA y el motor servoamplificador
encoder. El modelo del motor servoamplificador encoder es el siguiente:
Es importante notar que en la flecha del motor está conectado un reductor 1/75
y un sistema de bandas y tornillos de tal forma que cada radian después del
reductor (75 radianes de la flecha del motor), se convierte en desplazamiento
lineal del marco móvil con una ganancia de:
mm rad
1.591549431 = 0.628318531 (9)
rad mm
Si deseamos conocer la evolución dinámica de la posición angular después del
reductor, habrı́a que considerar el motor servoamplificador de la relación 6, un
integrador como el de la relación 7 pero con 0.001 en el numerador: lo que nos
darı́a la relación 8 sin el factor 636.62 o ganancia del encoder, es decir la salida
en radianes en la flecha del motor. Esta relación en cascada con el reductor nos
darı́a la relación 10, que no es otra que la evolución dinámica en la flecha del
reductor.
θ(z −1 ) 1 0.9321 × 10−3 z −1 + 0.8083 × 10−3 z −2
= (10)
V (z −1 ) 75 1.0 − 1.6519z −1 + 0.6519z −2
R(1) = 17.763065
g = −0.05842163954
u(k) = 0.2[0.05842164u(k−1)+17.763065sp(k)+56.246θ(k)−74.00906882θ(k−1)]
(15)
La relación 15 es la del algoritmo implementado en el control al punto. Antes
de llegar a cerrar el lazo de este control, se programa la trayectoria trapezoidal
del contorno de velocidad. Esta trayectoria debe tener las siguientes limitantes:
mm
• Aceleración máxima (entrada en puntos), 0.6 10msec
min
, que equivale a dar en
pts
la entrada 100 10msec (0,100,200, hasta obtener la velocidad requerida).
mm
• Velocidad máxima, 10 min , igual a 1600 puntos en la entrada.
3.1 Experimentación.
En la figura 7.a, observamos la evolución de la velocidad y en la figura 7.b de
la posición del marco móvil, como reespuesta del control de posición, a una
consigna de posición de 0.12 mm (3600 Puntos).
mm
Observamos en la figura 7.a, una aceleración y desaceleración de 0.0382 10mseg
min
,
perfectamente dentro del rango de aceleración. La velocidad máxima alcanzada
mm
es de 5.0 min en la parte horizontal del perfil de velocidad, también perfecta-
mente dentro del rango de velocidad. Esta aceleración y velocidad, son las que
corresponden a las condiciones de movimiento de la balanza, desplazada por el
marco móvil, para detectar el contacto de esfera.
El tiempo total del recorrido para la consigna de posición de 3600 puntos
es de 2.748 segundos, de los cuales 317 milisegundos, corresponden a la parte
del control al punto, en los últimos 100 puntos antes de terminar el movimiento
(serı́a más rápido si FA = 1, pero con el riesgo de producir una discontinuidad
en el acoplamiento). El muestreo para las figuras 7 no es regular, y la escala
temporal no es exacta en estas figuras.
Observamos en la figura 7.a, una discontinuidad exactamente cuando el sis-
tema llega a los 3500 puntos y se cierra el CAP (se acoplan las trayectorias),
es decir exactamente al llegar al principio de los 100 últimos puntos. Esta dis-
continuidad se puede hacer menos abrupta o inclusive desaparecer, si se cierra
el CAP a un número de puntos inferior a 100. De hecho, cerrando el CAP en
los últimos 50 puntos con el mismo valor de FA , tendrı́amos a 3550 puntos, el
punto de acoplamiento exacto sin discontinuidad).
También se puede lograr un acoplamiento exacto en los últimos 100 pun-
tos(mejor que el de la figura 7.a), si se disminuye el valor del factor FA (en
detrimiento de la velocidad de respuesta), de allı́ el nombre de factor de acoplamiento.
Es muy importante que el acoplamiento sea bueno, debido a que la discon-
tinuidad de las trayectorias de velocidad, producen ”sacudidas” indeseables en
los elementos mecánicos. Es importante mantener una relación correcta entre
rapidez de la respuesta y trayectorias ”lisas”. Este principio se aplica exac-
tamente de la misma forma, en las trayectorias de los brazos de los robots
industriales.
La modelación por medio de los T DH ′ s, permite un estudio detallado de
estas trallectorias, antes de la implementación de los algoritmos de control, de
los sistemas mecánicos o mecatrónicos reales.
fe (z −1 ) 0, 0047152473z −1 + 0, 0044465506z −2
= (16)
fg (z )
−1 1.0 − 1.829456185z −1 + 0.8386179833z −2
fe (z −1 ) 0, 0103823373z −1 + 0, 0095838576z −2
= (17)
fg (z )
−1 1.0 − 1.766661666z −1 + 0.7866278610z −2
fe (z −1 ) 0, 0179003923z −1 + 0, 0160241793z −2
= (18)
fg (z )
−1 1.0 − 1.683562751z −1 + 0.71744873229z −2
f = 3.1229df + 0.06451
Donde df en mm y f en KNt.
• Gdf 2 = 51.8879, correspondiente al S2 :
f = 51.8879df − 41.9707
Donde df en mm y f en KNt.
• Gdf 3 = 60.1603 correspondiente al S3 :
f = 60.1603df − 55.4579
Donde df en mm y f en KNt.
Dr. José C. Pineda Castillo, (Ph.D.) • jpineda@ciateq.mx • Tel. +442 211 2610 23
Donde dm en mm y Cf en KNt.
• Gf d2 = 0.019272316, correspondiente al S2 :
Donde dm en mm y Cf en KNt.
• Gf d3 = 0.016622258 correspondiente al S3 :
Donde dm en mm y Cf en KNt.
En la figura 1, observamos los blocs P IG y P IM , que son los blocs que
representan las perturbaciones inerciales del gato hidráulico y de las masas en
movimiento, cuando el marco de carga se desplaza junto con las masas. Estas
perturbaciones no afectan el control de fuerza en la posición de equlibrio §2.3,
por lo tanto no las consideraremos en esta sección. Estas perturbaciones se
Dr. José C. Pineda Castillo, (Ph.D.) • jpineda@ciateq.mx • Tel. +442 211 2610 24
toman en cuenta para limitar las aceleraciones del sistema hidráulico y del marco
móvil.
El bloc M representa la fuerza producida por las masas que se cargan en
el marco de carga, dado que éstas se encuentran bajo la acción del campo de
gravedad, al cargarse en el poste central de forma que quedan suspendidas. Por
lo tanto hablaremos de masas o fuerzas indistintamente de 0 a 150 KNt, por la
fuerza dentro de esta campo. El valor Cf o consigna de fuerza, es el valor de la
fuerza de las masas que pesan en la balanza al iniciar un nuevo ciclo de carga §2.4
y ref. [1]. La fuerza total fg para el proceso en la posición de control o posición
de equilibrio, es la suma algebraica de la fuerza equivalente de desplazamiento
del marco móvil f , más la fuerza producida por las masas suspendidas.
Cuando se descargan las masas desde el estado 3 − 4 − 7 y hasta antes de
cargarse las nuevas masas en el estado 2 − 4 − 7, la fuerza producida por las
masas es nula (se encuentran levantadas por el sistema hidráulico, sin tocar
sus apoyos en el poste central); en estas condiciones, el sistema de control de
fuerza, mantiene regulada la fuerza a la consigna Cf , únicamente por medio del
desplazamiento del marco móvil, cuya fuerza equivalente será f = fg .
El sistema de medición de la fuerza, mide la fuerza por medio de un transduc-
tor que observa dicha magnitud, por medio del desplazamiento total de fuerza
o deformación del sistema elástico, producido por las fuerzas que actúan sobre
dicho sistema fg .
Cuando las masas están suspendidas sin ninguna otra fuerza actuando sobre
el sistema elástico de fuerza (después del estado 2 − 4 − 8 y cuando el marco
móvil se encuantra en la posicón PCL ), su valor de fuerza en KNt es Cf (el
sistema discreto seleccionó las masas cuya fuerza en el campo de gravedad sea
exactamente el valor de la consigna Cf para el siguiente ciclo de carga). El
desplazamiento de fuerza equivalente en este caso es dm y se obtiene también
por medio de las ecuaciones 21, 22 y 23.
Cualquier otro desplazamiento de fuerza equivalente producido por una fuerza
sobre el proceso, se obtiene por medio de las mismas ecuaciones 21, 22, y 23,
reemplazando Cf por la fuerza que actúa sobre el proceso (la fuerza total fg
por ejemplo).
La ganancia Gf d es la ganancia estática que multiplica al modelo del proceso
(bloc proceso de la figura 1), para transformar la fuerza en distancia para el
cálculo del algoritmo RST de control de fuerza (de acuerdo con la forma canónica
de dicho algoritmo, dado que la salida del regulador debe darse en unidades de
distancia), de tal forma que las mediciones de la variable regulada a la salida
del proceso y la consigna, se lean directamente en unidades de fuerza, es decir
en KNt, como se verá más adelante. Por lo tanto a partir de las relaciones 21,
22 y 23, tendremos que:
fe (z −1 ) 0, 0047152473z −1 + 0, 0044465506z −2
= (24)
fg (z )
−1 1.0 − 1.829456185z −1 + 0.8386179833z −2
Observando la figura 1, vemos que se requiere que el algoritmo de control CAF ,
genere la estrategia de control al mismo tiempo que transforme el error ǫ. El
error antes del CAF , se tiene en términos de magnitiud de fuerza y debe trans-
formarse a magnitud de distancia en mm, para luego llevar esta distancia en su
equivalente en puntos.
Por otro lado, observando las figuras 6, 6b, 7a, 7b, y 9, vemos que respetando
la dinámica del proceso al generar la estrategia de control de fuerza, la rapidez
de respuesta del CAP , nos permite tener poca influencia de sus polos sobre los
polos del proceso de fuerza controlado.
Esta pequeña influencia de los polos del CAP sobre el CAF ,nos permitirá
entonce simplificar el control de fuerza, considerando en todos los cálculos
únicamente el modelo a controlar de segundo orden de la ecuación 24. Esto nos
permite cumplir con las especificaciones impuestas, utilizando en una primera
instancia un control de tipo PI y luego con mejores resultados, un control de
tipo PID.
1. El control de tipo PI. Este control se tomó analógico, se ajustó de acuerdo
con el método tradicional de Ziegler y Nichols y se determinó después su
equivalente RST digital. La ganancia estática utilizada para cada seg-
mento es Gdf , dado que partimos del PI analógico, cuya posición en el
diagrama de bloques es exactamente la presentada en la figura 1.
2. El control de tipo PID. Este control se calculó desde el principio como
un algoritmo digital en su forma canónica o RST. Se utiliza la estrategia
de posicionamiento de polos, imponiendo un amortiguamiento que per-
mita satisfacer las especificaciones y una frecuencia natural que respete
la dinámica del sistema. Este algoritmo está distribuido en tres bloques:
uno en el lazo de retorno, otro en la consigna y el otro después del error.
Por lo que la ganancia estática utilizada para cada segmento es Gf d
r0 = K + Ki Tm
r1 = −K
R(1) = r0 + r1 (27)
A partir de los valores de Ta y Tr de la gráfica 10, se obtuvieron los valores de
K y de Ki [2], del modelo m1 con ganancia unitaria, es decir con ∆u∆y = 1. Estos
valores son: K = 8.0 y Ki = 0.495.
Dr. José C. Pineda Castillo, (Ph.D.) • jpineda@ciateq.mx • Tel. +442 211 2610 27
4.2 Experimentación.
Las figuras 12, 12.a, 13 y 13.a, nos presenta el resultado del PI en la descarga y
en la carga con perturbaciones.
Para todas las figuras, el eje x representa el tiempo, con un perı́odo de muestreo
de 0, 05 seg.
son más lentas que las variaciones de la fuerza en la carga, especialmente para
valores grandes como se vió en ¶2.2, figuras 4 y 5 respectivamente.
5 Referencias
1. José C. Pineda Castillo, Análisis e identificación del proceso controlado de
la máquina patrón de fuerza de 150 KN. Reporte Técnico, MECAPROM
SA de CV, Enero 25, 2002.
2. José C. Pineda Castillo, La Regulación Automática de los Procesos Indus-
triales, Usando el Algoritmo Digital PID, partiendo de la estrategia RST.
Querétaro, Febrero 15, 2002. Documento en español, con certificado de
derechos de autor, 300 pgs.
3. José C. Pineda Castillo, Modelo Simplificado para el análisis de los sis-
temas de control hı́bridos. Aplicación al análisis de los sistemas complejos
de control industrial. Querétaro, Qro., Septiembre de 1999. Documento
en espaol, con certificado de derechos de autor, 80 pgs.