Diseño de Servos de Fuerza en Rexroth
Diseño de Servos de Fuerza en Rexroth
Director
MSc. Ing. ABEL PARADA CORRALES
7
DEDICATORIA
8
AGRADECIMIENTOS
9
CONTENIDO
INTRODUCCIÓN.................................................................................................... 24
10
2.2.3 Montaje hidráulico con perturbación ............................................................. 48
5.1.1 Sintonización del control PID usando PID tuner de Matlab ........................... 71
5.2.1 Diseño del control PID con adelanto de señal (feedforward) en LabView .... 90
5.2.2 Sintonización del control PID con adelanto de señal (feedforward) .............. 93
11
6.3 PRUEBA DEL CONTROL PID CON ADELANTO DE SEÑAL
(FEEDFORWARD) ............................................................................................... 104
ANEXOS 132
12
LISTA DE FIGURAS
13
Figura 27. Diagrama de polos y ceros del sistema. ............................................... 63
Figura 28. Lugar geométrico de las raíces del sistema. ......................................... 63
Figura 29. Diagrama de Bode del sistema. ............................................................ 64
Figura 30. Esquema del montaje de caracterización de la celda de carga. ........... 65
Figura 31. Montaje de caracterización de la celda de carga. ................................. 66
Figura 32. Interfaz HMI de caracterización de la celda de carga. .......................... 67
Figura 33. Diagrama de bloques de caracterización de la celda de carga. ........... 67
Figura 34. Gráfica F vs. V de la celda de carga. .................................................... 69
Figura 35. Diagrama de bloques del control PID. .................................................. 71
Figura 36. Características para la sintonización del controlador PID. .................... 71
Figura 37. Respuesta al escalón del sistema con el controlador PID sintonizado. 72
Figura 38. Constantes del controlador y comportamiento del sistema. ................. 73
Figura 39. Bloques del Setpoint. ............................................................................ 74
Figura 40. Bloques de la caracterización de la celda de carga. ............................. 75
Figura 41. Bloques de los indicadores visuales LED. ............................................ 75
Figura 42. Función de transferencia del sistema en LabView. ............................... 76
Figura 43. Bloques de la función de transferencia del sistema. ............................. 76
Figura 44. Simulation loop Labview 2015. ............................................................. 77
Figura 45. Parámetros de ajuste del simulation loop. ............................................ 78
Figura 46. Bloques del controlador PID. ................................................................ 78
Figura 47. Bloques del cálculo de los errores. ....................................................... 79
Figura 48. Bloques de la señal de control de salida y sus condiciones. ................ 79
Figura 49. Bloques para guardar datos en tiempo real. ......................................... 80
Figura 50. Interfaz gráfica HMI. .............................................................................. 80
Figura 51. Encabezado de la interfaz gráfica. ........................................................ 81
Figura 52. Sección de la lectura de la celda de carga. .......................................... 82
Figura 53. Indicadores visuales del estado del actuador. ...................................... 82
Figura 54. Función de transferencia del sistema. .................................................. 83
Figura 55. Botón de detener el programa. ............................................................. 83
Figura 56. Indicadores de error. ............................................................................. 83
14
Figura 57. Botones para aplicar la fuerza o rampa. ............................................... 84
Figura 58. Sección de selección de entrada escalón o rampa. .............................. 84
Figura 59. Sección de ajuste del setpoint. ............................................................. 85
Figura 60. Sección de sintonización del controlador PID. ...................................... 85
Figura 61. Gráficas del comportamiento del sistema. ............................................ 86
Figura 62. Sección de almacenamiento de datos. ................................................. 87
Figura 63. Diagrama de bloques del control PID con adelanto de señal
(feedforward). ......................................................................................................... 88
Figura 64. Diagrama de bloques del controlador feedforward. .............................. 91
Figura 65. Diagrama de bloques del controlador PID con feedforward. ................ 92
Figura 66. Sección del controlador feedforward. .................................................... 93
Figura 67. Esquema del montaje de la prueba en lazo abierto. ............................. 95
Figura 68. Montaje de control de la prueba en lazo abierto. .................................. 96
Figura 69. Montaje de la prueba en lazo abierto .................................................... 96
Figura 71. Montaje para las pruebas de los controladores. ................................... 98
Figura 70. Montaje para las pruebas de los controladores. ................................... 98
Figura 72. Respuesta en estado transitorio del control PID para una entrada
escalón de 210 [kg] ................................................................................................ 99
Figura 73. Respuesta en estado estacionario del control PID para una entrada al
escalón de 210 [kg]. ............................................................................................... 99
Figura 74. Respuesta del controlador PID para una variación en el setpoint de 210
[kg] a 150 [kg]. ...................................................................................................... 100
Figura 75. Respuesta del controlador PID para una variación en el setpoint de 150
[kg] a 250 [kg]. ...................................................................................................... 101
Figura 76. Respuesta para un setpoint de 200 [kg] con un valor de rampa de
25[kg/s]. ................................................................................................................ 102
Figura 77. Respuesta para un setpoint de 200 [kg] con un valor de rampa de
50[kg/s]. ................................................................................................................ 102
Figura 78. Respuesta del controlador PID ante una perturbación de 25 [kg]. ..... 104
15
Figura 79. Respuesta del control PID con feedforward para setpoint de 180 [kg] y
perturbación de 25 [kg]. ........................................................................................ 105
Figura 80. Respuesta del control PID feedforward para setpoint de 120 [kg] y
perturbación de 25 [kg]. ........................................................................................ 105
Figura 81. Respuesta del control PID con feedforward para setpoint de 220 [kg] y
perturbación de 25 [kg]. ........................................................................................ 106
Figura 82. Respuesta del control PID con feedforward para setpoint de 270 [kg] y
perturbación de 25 [kg]. ........................................................................................ 106
Figura 83. Servoválvula MOOG 62. ..................................................................... 109
Figura 84. Función de transferencia en LabView. ................................................ 116
Figura 85. Bloques función de transferencia. ....................................................... 116
Figura 86. Función de transferencia en la interfaz HMI. ...................................... 116
Figura 87. Esquema del montaje para determinar la ganancia en caudal. .......... 119
Figura 88. Montaje de control. .............................................................................. 120
Figura 89. Gráfica de ganancia en presión para los diferentes tipos de carrete. . 121
Figura 90.Esquema del montaje para terminar la ganancia en presión. .............. 122
Figura 91. Gráfica de P vs. V. .............................................................................. 123
Figura 92.Gráfica de ganancia en presión. .......................................................... 123
Figura 93. Gráfica de histéresis. .......................................................................... 124
Figura 94. Válvula direccional proporcional de prestaciones elevadas. ............... 134
Figura 95. Válvula proporcional con realimentación y tarjeta controladora. ......... 134
Figura 96. Gráfica de la ganancia en caudal para carrete centro cerrado. .......... 135
Figura 97. Carrete centro cerrado. ....................................................................... 136
Figura 98. Carrete centro abierto. ........................................................................ 136
Figura 99. Gráfica de la ganancia en caudal para carrete centro abierto. ........... 136
Figura 100. Carrete centro crítico. ........................................................................ 137
Figura 101. Gráfica de la ganancia en caudal para carrete centro crítico. ........... 137
Figura 102. Gráfica de ganancia en caudal para los diferentes tipos de carrete. 138
Figura 103. Gráfica de ganancia en presión para los diferentes tipos de carrete.
.............................................................................................................................. 139
16
Figura 104. Gráfica de histéresis. ........................................................................ 139
Figura 105. Gráfica de error de linealidad. ........................................................... 140
Figura 106. Control de fuerza en lazo abierto. ..................................................... 141
Figura 107. Control de fuerza en lazo cerrado utilizando una válvula de seguridad
proporcional. ......................................................................................................... 142
Figura 108. Control de fuerza en lazo cerrado utilizando una válvula proporcional
de prestaciones elevadas. .................................................................................... 143
Figura 109. Amplificador PI usado para el control de fuerza. .............................. 144
Figura 110. Unidad de alimentación del banco. ................................................... 160
Figura 111. Unidad de alimentación del banco Rexroth. ..................................... 161
Figura 112. Unidad de setpoint. ........................................................................... 161
Figura 113. Unidad de displays. ........................................................................... 162
17
LISTA DE TABLAS
18
LISTA DE ANEXOS
ANEXO H otros elementos del banco rexroth usados para el servo de fuerza y
las pruebas 160
ANEXO I Diagrama electrónico de los componentes del módulo aaa ........... 163
19
RESUMEN
DESCRIPCIÓN
∗
Tesis de grado.
∗∗
Facultad de Ingenierías Fisicomécanicas. Escuela de Ingeniería Mecánica. Director: Ing. Abel
Parada Corrales.
20
proporcional Rexroth en términos de ganancia en caudal, ganancia en presión,
histéresis y linealidad. Finalmente se realizó una prueba de repetibilidad con el fin
de evaluar la capacidad del servo para repetir el valor de fuerza de comando, y se
comparó el desempeñó del servo de fuerza utilizando la válvula direccional
proporcional de altas prestaciones Rexroth y una servoválvula Moog 62.
21
ABSTRACT
DESCRIPCIÓN
∗
Undergraduate thesis.
∗∗
Physical-mechanical Engineering Facultuy. Mechanical Engineering School. Director: Eng. Abel
Parada Corrales.
22
characterized in terms of flow gain, pressure gain, hysteresis and linearity. Finally,
a repeatability test was performed in order to evaluate the ability of the force
controller to repeat the commanded force value, and it was compared the
performance of the servo using the Rexroth high performance directional
proportional valve and a Moog 62 servovalve.
23
INTRODUCCIÓN
24
caracterización del sensor utilizado, es decir, de la celda de carga. En la quinta
sección se plasma el diseño del algoritmo de control y de la interfaz gráfica HMI en
LabView para el control PID y para el control PID con adelanto de señal
(feedforward). La sexta sección se dedica a la prueba del servo de fuerza en lazo
abierto, con control PID y con control PID con adelanto de señal, además se
realiza una prueba de repetibilidad comparando la válvula direccional proporcional
Rexroth con una servoválvula MOOG 62 para el control de fuerza. La
caracterización de la válvula direccional proporcional de altas prestaciones
Rexroth 4WRPEH6 C3 B04L – 20/G24K0/A1M en términos de ganancia en
caudal, ganancia en presión, histéresis y linealidad se evidencia en la séptima
sección. Se adjuntan las conclusiones obtenidas durante el desarrollo del proyecto
y las recomendaciones para el uso futuro de esta práctica por parte del laboratorio
de Servosistemas de Potencia Fluida. Por último se anexa un breve marco teórico
junto con las fichas técnicas de los elementos utilizados y las tablas de datos de
las diversas pruebas realizadas.
25
1. DESCRIPCIÓN DEL PROYECTO
La asignatura cuenta con una parte teórica y una parte experimental. La parte
experimental se desarrolla por medio de prácticas semanales en el laboratorio de
Servosistemas de Potencia Fluida, y es de suprema importancia para afianzar los
conocimientos adquiridos en las clases teóricas. Estas prácticas se realizan en
bancos de aprendizaje dónde es posible profundizar y aclarar el tema, además de
poder observar lo estudiado en clase. La parte central del laboratorio busca
estudiar el control de posición, velocidad y fuerza por medio de servos. En cada
uno de estos laboratorios se muestra el control análogo y digital de la respectiva
variable, de manera que los estudiantes puedan comparar los resultados
obtenidos con ambos tipos de control y puedan elaborar sus respectivas
conclusiones. Las prácticas que incluyen control computarizado, cuentan con una
interfaz virtual por medio de la cual los estudiantes pueden manipular las
diferentes variables del sistema y analizar los efectos físicos que esto causa en el
mismo.
26
La escuela de Ingeniería Mecánica adquirió en el año 2015 un banco hidráulico
didáctico Rexroth para fomentar el aprendizaje en las asignaturas Potencia Fluida
y Servosistemas de Potencia Fluida. Sin embargo, este banco no cuenta con un
control computarizado de fuerza, por lo tanto se propone diseñar la práctica de
servos de fuerza en el banco Rexroth.
27
Tomando la fuente de potencia hidráulica de este banco, y usando un actuador
hidráulico y una válvula direccional proporcional Rexroth de altas prestaciones del
mismo, se propone realizar un sistema de control de fuerza mediante técnicas de
control PID y de adelanto de señal (feedforward), implementando una interfaz
gráfica HMI en LabView que permita controlar y manipular el banco realizándolo
mediante la intervención electrónica no invasiva del banco en los puertos de
entradas de la tarjeta de amplificación o servoamplificador.
La interfaz gráfica debe permitir que los estudiantes ingresen el valor de consigna
de la fuerza (setpoint) y los valores de las constantes del controlador PID, así
mismo, debe permitir visualizar el comportamiento del sistema y los diferentes
valores involucrados.
1.4 OBJETIVOS
28
• Diseñar y programar el algoritmo de control para la práctica de control de
fuerza basado en técnicas de control estándar (control PID) y técnicas de
control adicionales como adelanto de señal (feedforward).
29
2. PRÁCTICA DE SERVOS DE FUERZA EN EL BANCO REXROTH
Cuenta con dos caras de trabajo que poseen de forma independiente puertos de
presión, puertos de retorno a tanque, módulos de control y rejilla para montaje de
los componentes hidráulicos.
30
De forma general, el banco se compone de dos módulos, el módulo hidráulico de
potencia y el módulo de control. Ambos módulos se usaron para la ejecución del
proyecto junto con los elementos que se explicarán a continuación, y todo esto fue
montado sobre una de las caras de trabajo del banco.
31
2.1.2.2 Tanque
El tanque que suministra de aceite al banco está fabricado en chapa de acero con
pintura electrostática. Tiene una capacidad de 40 [L] y está dotado con un
indicador de temperatura.
32
2.1.3 Módulo de control
El módulo de control del servo de fuerza emplea el módulo de alimentación,
amplificación y almacenamiento (módulo AAA) del laboratorio de Servosistemas
de Potencia Fluida, y los siguiente elementos del banco Rexroth: La unidad de
alimentación del banco, la unidad de alimentación de 24 [V], la unidad de setpoint,
la unidad de displays y el servoamplificador.
2.1.3.1 Servoamplificador
El servoamplificador posee un par de puertos de alimentación a 24 [V], un par de
puertos para voltaje de control a ± 10 [V] (valor setpoint), un par de puertos para
voltaje a ± 10 [V] (valor actual), y un puerto de 7 polos para el envío de la señal
amplificada a la válvula proporcional.
Figura 5. Servoamplificador.
33
Esta unidad recibe la señal de control que envía el módulo AAA, específicamente
la tarjeta de adquisición de datos, y la convierte en una señal de potencia
(corriente) para comandar el solenoide proporcional de la válvula.
En la parte frontal del módulo se encuentran los selectores de las tarjetas y los
testigos (leds). El selector 1 permite al usuario activar el control de fuerza o el
control de posición. El selector 2 únicamente se usa para el control de posición y
permite seleccionar la salida hacia la servoválvula o la salida hacia la válvula
proporcional.
34
En la parte izquierda del módulo se encuentra el puerto de conexión de la celda de
carga con su respectivo testigo (para el control de fuerza), el puerto de conexión
del LVDT con su testigo (para el control de posición), y el puerto de conexión USB
de la tarjeta de adquisición de datos.
En la parte derecha del módulo se encuentran los puertos de salida hacia las
válvulas de los distintos tipos de control (fuerza y posición). Los puertos indicados
con el número 1 envían la señal de salida del control de fuerza. Los puertos con el
número 2 y 3 envían la señal de salida del control de posición hacia la
servoválvula o hacia la válvula proporcional respectivamente. Todos estos puertos
van conectados a las salidas PWM de la tarjeta de adquisición de datos.
35
Figura 8. Vista lateral derecha del módulo AAA.
36
adquisición de datos, distintos puertos y selectores) se encuentran conectados
como lo indica el diagrama de conexiones que se muestra a continuación:
Este módulo recibe las lecturas de fuerza de la celda de carga y las envía a la
tarjeta de adquisición de datos, envía las señales de control hacia el
servoamplificador de la válvula y se conecta vía USB con el software de control.
37
ANSI, C/C++, C#, Visual Basic .NET y Visual Basic 6.0. Incorpora tecnología NI
Signal Streaming para transferencia de datos sostenida a alta velocidad vía USB.
En el anexo C se encuentran especificaciones técnicas más detalladas de la
tarjeta de adquisición de datos NI DAQ USB 6212.
La tarjeta NI DAQ USB 6212 se usó para recibir las señales provenientes de la
celda de carga (previo paso por el preamplificador de la misma), y para enviar las
señales hacia la válvula direccional proporcional (previo paso por el
servoamplificador). Sirvió como puente entre el programa desarrollado en LabView
y las dos señales comentadas anteriormente.
38
diámetro de pistón, 14 [mm] de diámetro de vástago y 50 [mm] de carrera. La
unidad de carga Rexroth puede operar a una presión máxima de 120 [Bar].
39
Fuente: BOSCH REXROTH AG. 4/4-way servo solenoid directional control valves,
directly operated, with electrical position feedback and on-board electronics (OBE).
Type 4WRPEH6. Lohr am Main, 12 p.
40
Esta válvula se tara manual mediante el giro de la perilla de ajuste. Posee pilotaje
interno, drenaje externo y una válvula antirretorno conectada en paralelo. Tiene un
flujo máximo de 15 [L/min] y puede operar a una presión máxima de 120 [Bar].
41
Figura 16. Válvula direccional Rexroth 4WMM 6 E5X/F.
42
La celda de carga tipo S posee en su interior un grupo de cuatro resistencias
variables, conocidas como galgas extensiométricas, conectadas en forma de
puente de Wheatstone.
Cuando se aplica una fuerza sobre la celda de carga, las galgas extensiómetricas
sufren una deformación que altera los valores de sus resistencias. Como
consecuencia de esto, la diferencia de potencial entre los dos puntos del puente
de Wheastone cambia. De este modo, la diferencia de potencial es la señal de
salida del transductor ante la fuerza ejercida.
1
BOSCH REXROTH AG. Training Systems for Hydraulics. Würzburg, 2015, p. 126.
43
máxima de 120 [bar]. Por lo tanto, la máxima fuerza que puede ejercer este
cilindro es de 608.413 [kgf].
πD 2 π (25 / 1000) 2
F = P ⋅ AP = P ⋅ = (120 ⋅ 101325) ⋅ = 5968.535[ N ] = 608.413[kgf ]
4 4
Con estos valores para la fuerza máxima, el sensor que más se ajusta es una
celda de carga de 500 [kgf]. La celda de carga usada para la ejecución del
proyecto fue una Lexus modelo SA de 500 [kgf]. Sus especificaciones técnicas se
encuentran en el anexo C.
2.2 SERVO DE FUERZA
El sistema de control planteado para el servo de fuerza cuenta con los siguientes
elementos: Computador con interfaz gráfica HMI en LabView, tarjeta de
adquisición de datos DAQ NI USB 6212, servoamplificador, válvula direccional
proporcional de altas prestaciones Rexroth tipo 4WRPEH6, unidad de carga
Rexroth, fuente de potencia del banco y celda de carga tipo S.
44
• Entrada y comparador: Computador con interfaz gráfica HMI en LabView
• Transductor o sensor: Celda de carga tipo “S”
45
Figura 20. Montaje del sistema de control del servo de fuerza.
46
Figura 21. Esquema del servo de fuerza sin perturbación.
47
Figura 22. Montaje del servo de fuerza sin perturbación.
48
Figura 23. Esquema del servo de fuerza con perturbación.
49
Figura 24. Montaje del servo de fuerza con perturbación.
50
3. MODELADO DINÁMICO DEL SISTEMA
F − b ⋅ x! − k ⋅ x = m ⋅ !x! (3-1)
51
Donde F es la fuerza que ejerce el cilindro, b y k son la rigidez y
amortiguamiento de la celda de carga respectivamente.
La fuerza que ejerce el actuador se relaciona con las presiones en la cámara del
pistón y en la cámara anular de la siguiente manera:
F = P1 ⋅ AP − P2 ⋅ AV (3-2)
3.1.2 Continuidad
Aplicando las ecuaciones de continuidad para el flujo de aceite en el actuador se
tiene:
V1 !
Q1 = AP ⋅ x! + ⋅ P1 + ktm ⋅ ( P1 − P2 ) + kcm1 ⋅ ( P1 − PR ) (3-3)
β
V2 !
Q2 = AV ⋅ x! − ⋅ P2 + ktm ⋅ ( P1 − P2 ) − k cm 2 ⋅ ( P2 − PR ) (3-4)
β
tanque.
52
V1 !
Q1 = AP ⋅ x! + ⋅ P1 (3-5)
β
V2 !
Q2 = AV ⋅ x! − ⋅ P2 (3-6)
β
Donde:
V1 = V1 + AP ⋅ x (3-7)
V2 = V2 − AV ⋅ x (3-8)
V1 ≈ V1
V 2 ≈ V2
De este modo:
V1 V2 1 (V1 + V2 )
= = ⋅ =C
β β β 2
53
Q1 = AP ⋅ x! + C ⋅ P!1 (3-9)
Q2 = AV ⋅ x! − C ⋅ P!2 (3-10)
3.2.1 Flujo
Las ecuaciones no lineales que describen el flujo de aceite a través de la válvula
son las siguientes:
2
Q1 = C d ⋅ α ⋅ xV ⋅ ( PS − P 1 ) (3-11)
ρ
2
Q2 = C d ⋅ α ⋅ xV ⋅ ( P2 − P R ) (3-12)
ρ
el gradiente del área que relaciona el desplazamiento del spool con el área del
orificio, y ρ es la densidad del fluido.
⎛ ∂Q ⎞ ⎛ ∂Q ⎞
Q1 = ⎜⎜ 1 ⎟⎟ ⋅ xV + ⎜⎜ 1 ⎟⎟ ⋅ P1
⎝ ∂xV ⎠ xVo , P1o ⎝ ∂P1 ⎠ xVo , P1o
54
2 Cd ⋅ kV ⋅ xVo −2
Q1 = Cd ⋅ kV ⋅ ( PS − P1o ) ⋅ xV + ⋅ ⋅P
ρ 2 ρ 1
2 ⋅ ( PS − P1o )
ρ
2 C d ⋅ kV ⋅ xVo
Q1 = C d ⋅ kV ⋅ ( PS − P1o ) ⋅ xV − ⋅ P1 (3-13)
ρ 2 ⋅ ρ ⋅ ( PS − P1o )
2
k s ,1 = C d ⋅ kV ⋅ ( P2 − P 1o )
ρ
Cd ⋅ kV
k p ,1 =
2 ⋅ ρ ⋅ ( P2 − P1o )
Q1 = k s ,1 ⋅ xV − k p ,1 ⋅ P1 (3-14)
⎛ ∂Q ⎞ ⎛ ∂Q ⎞
Q2 = ⎜⎜ 2 ⎟⎟ ⋅ xV + ⎜⎜ 2 ⎟⎟ ⋅ P2
⎝ ∂xV ⎠ xVo ,P2 o ⎝ ∂P2 ⎠ xVo ,P2 o
55
2 Cd ⋅ kV ⋅ xVo 2
Q2 = Cd ⋅ kV ⋅ ( P2 o − P R ) ⋅ xV + ⋅ ⋅ P2 (3-15)
ρ 2 ρ
2 ⋅ ( P2 o − P R )
ρ
2
k s , 2 = C d ⋅ kV ⋅ ( P2 o − P R )
ρ
Cd ⋅ kV
k p,2 =
2 ⋅ ρ ⋅ ( P2o − P R )
Q2 = k s , 2 ⋅ xV − k p , 2 ⋅ P2 (3-16)
τ 1
u= ⋅ x!V + ⋅ xV
k sp k sp
es el voltaje de control.
56
La válvula direccional proporcional de altas prestaciones Rexroth 4WRPEH6 C3
B04L – 20/G24K0/A1M posee una respuesta dinámica muy elevada, con un
tiempo de respuesta menor o igual a 10 [ms], por lo tanto, se puede aproximar el
comportamiento de la válvula a la siguiente ecuación:
1
u= ⋅ xV (3-17)
k sp
AV ⋅ x! − C ⋅ P!2 = k s, 2 ⋅ xV + k p, 2 ⋅ P2 (3-19)
Ap ⋅ x ⋅ s + C ⋅ P1 ⋅ s = k s ,1 ⋅ xV − k P1 ⋅ P1
C ⋅ P1 ⋅ s + k P1 ⋅ P1 = k s ,1 ⋅ xV − Ap ⋅ x ⋅ s
k s ,1 ⋅ xV − Ap ⋅ x ⋅ s
P1 = (3-20)
C ⋅ s + k P1
AV ⋅ x ⋅ s − C ⋅ P2 ⋅ s = k s , 2 ⋅ xV + k P 2 ⋅ P2
57
AV ⋅ x ⋅ s − k s , 2 ⋅ xV = k p , 2 ⋅ P2 + C ⋅ P2 ⋅ s
AV ⋅ x ⋅ s − k s , 2 ⋅ xV
P2 = (3-21)
C ⋅ s + k p,2
2 2
AP ⋅ xV ⋅ k s ,1 − ⋅ AP ⋅ x ⋅ s AV ⋅ x ⋅ s − k s , 2 ⋅ AV ⋅ xV
F= −
C ⋅ s + k p,2 C ⋅ s + k p,2
Se factoriza x y xV :
2 2
⎡ AP ⋅ s AV ⋅ s ⎤ ⎡ k s , 2 ⋅ AV k s ,1 ⋅ AP ⎤
F = x ⋅ ⎢− − ⎥ + xV ⋅⎢ + ⎥ (3-22)
⎢⎣ C ⋅ s + k p ,1 C ⋅ s + k p , 2 ⎥⎦ ⎢⎣ C ⋅ s + k p , 2 C ⋅ s + k p ,1 ⎥⎦
F − b ⋅ s ⋅ x − k ⋅ x = m ⋅ s2 ⋅ x
F = x ⋅ (m ⋅ s 2 + b ⋅ s + k )
F
x= 2
(3-23)
(m ⋅ s + b ⋅ s + k )
2 2
⎡ F ⎤ ⎡ AP ⋅ s AV ⋅ s ⎤ ⎡ k ⋅A k ⋅A ⎤
F =⎢ 2
⋅
⎥ ⎢ − − ⎥ + xV ⋅ ⎢ s , 2 V + s ,1 P ⎥
⎣ (m ⋅ s + b ⋅ s + k ) ⎦ ⎢⎣ C ⋅ s + k p ,1 C ⋅ s + k p, 2 ⎥⎦ ⎢⎣ C ⋅ s + k p , 2 C ⋅ s + k p ,1 ⎥⎦
58
2
⎡ F ⎤ ⎡ AP 2 ⋅ s AV ⋅ s ⎤ ⎡ k s , 2 ⋅ AV k s ,1 ⋅ AP ⎤
F +⎢ 2 ⎥ ⋅ ⎢ + ⎥ = xV ⋅ ⎢ + ⎥
⎣ (m ⋅ s + b ⋅ s + k ) ⎦ ⎣⎢ C ⋅ s + k p ,1 C ⋅ s + k p , 2 ⎦⎥ ⎢⎣ C ⋅ s + k p , 2 C ⋅ s + k p ,1 ⎦⎥
2
⎡ ⎡ 1 ⎤ ⎡ AP 2 ⋅ s AV ⋅ s ⎤ ⎤ ⎡ k ⋅A k ⋅A ⎤
F ⋅ ⎢1 + ⎢ 2
⋅
⎥ ⎢ + ⎥ ⎥ = xV ⋅ ⎢ s , 2 V + s ,1 P ⎥
⎢⎣ ⎣ (m ⋅ s + b ⋅ s + k ) ⎦ ⎢⎣ C ⋅ s + k p ,1 C ⋅ s + k p , 2 ⎥⎦ ⎥⎦ ⎢⎣ C ⋅ s + k p , 2 C ⋅ s + k p ,1 ⎥⎦
⎡ k s , 2 ⋅ AV k s ,1 ⋅ AP ⎤
⎢ + ⎥
F ⎢⎣ C ⋅ s + k p , 2 C ⋅ s + k p ,1 ⎥⎦
=
xV ⎡ ⎡ 1 ⎤ ⎡ AP ⋅ s ⋅ (C ⋅ s + k p , 2 ) + AV ⋅ s ⋅ (C ⋅ s + k p ,1 )⎤ ⎤
2 2
⎢1 + ⎢ ⎥⋅⎢ ⎥⎥
2
⎢⎣ ⎣ (m ⋅ s + b ⋅ s + k ) ⎦ ⎣⎢ (C ⋅ s + k p,1 )⋅ (C ⋅ s + k p,2 ) ⎦⎥ ⎥⎦
⎡ k s , 2 ⋅ AV ⋅ (C ⋅ s + k p ,1 ) + k s ,1 ⋅ AP ⋅ (C ⋅ s + k p , 2 )⎤
⎢ ⎥
F ⎣⎢ (C ⋅ s + k p,2 ) ⋅ (C ⋅ s + k p,1 ) ⎦⎥
=
[
xV ⎡ (m ⋅ s 2 + b ⋅ s + k ) ⋅ (C ⋅ s + k p ,1 ) ⋅ (C ⋅ s + k p , 2 ) + AP 2 ⋅ s ⋅ (C ⋅ s + k p , 2 ) + AV 2 ⋅ s ⋅ (C ⋅ s + k p ,1 ) ⎤
⎢ ⎥
]
⎢⎣ (C ⋅ s + k p,1 ) ⋅ (C ⋅ s + k p,2 ) ⋅ (m ⋅ s 2 + b ⋅ s + k ) ⎥⎦
F ⎡
=⎢
[ ]
ks , 2 ⋅ AV ⋅ (C ⋅ s + k p ,1 ) + ks ,1 ⋅ AP ⋅ (C ⋅ s + k p , 2 ) ⋅ (C ⋅ s + k p ,1 )⋅ (C ⋅ s + k p , 2 )⋅ (m ⋅ s 2 + b ⋅ s + k ) ⎤
⎥
[ ( )]
xV ⎢⎣ (C ⋅ s + k p , 2 )⋅ (C ⋅ s + k p ,1 )⋅ (m ⋅ s 2 + b ⋅ s + k ) ⋅ (C ⋅ s + k p ,1 )⋅ (C ⋅ s + k p , 2 ) + AP 2 ⋅ s ⋅ (C ⋅ s + k p , 2 ) + AV 2 ⋅ s ⋅ (C ⋅ s + k p ,1 ) ⎥⎦
reemplazadas por k p .
F (m ⋅ s 2 + b ⋅ s + k ) ⋅ (C ⋅ s + k p ) ⋅ (k S ) ⋅ ( AP + AV )
=
xV (C ⋅ s + k p ) ⋅ [(m ⋅ s 2 + b ⋅ s + k ) ⋅ (C ⋅ s + k p ) + AP 2 ⋅ s + AV 2 ⋅ s]
F (m ⋅ s 2 + b ⋅ s + k ) ⋅ (k S ) ⋅ ( AP + AV )
= (3-24)
xV [(m ⋅ s 2 + b ⋅ s + k ) ⋅ (C ⋅ s + k p ) + AP 2 ⋅ s + AV 2 ⋅ s]
59
Despejando xV de la ecuación (3-17):
xV = k sp ⋅ xV (3-25)
F (m ⋅ s 2 + b ⋅ s + k ) ⋅ (k S ) ⋅ ( AP + AV )
=
k sp ⋅ xV [(m ⋅ s 2 + b ⋅ s + k ) ⋅ (C ⋅ s + k p ) + AP 2 ⋅ s + AV 2 ⋅ s]
F k sp ⋅ (m ⋅ s 2 + b ⋅ s + k ) ⋅ (k S ) ⋅ ( AP + AV )
=
u [(m ⋅ s 2 + b ⋅ s + k ) ⋅ (C ⋅ s + k p ) + AP 2 ⋅ s + AV 2 ⋅ s]
2
F s ⋅ [k sp ⋅ k S ⋅ m ⋅ ( AP + AV )] + s ⋅ [k sp ⋅ k S ⋅ b ⋅ ( AP + AV )] + [k sp ⋅ k S ⋅ k ⋅ ( AP + AV )]
= 2 2
u s 3 ⋅ (m ⋅ C ) + s 2 ⋅ (b ⋅ C + m ⋅ k p ) + s ⋅ (k ⋅ C + b ⋅ k p + AP + AV ) + k ⋅ k p
60
π ⋅ DP 2
AP =
4
π ⋅ DV 2
AV = AP −
4
La masa del cilindro m fue estimada en 0,1 [kg] ya que solo involucra la masa del
vástago del cilindro y la masa de la celda de carga.
k s = 0,375[m 3 / Pa ⋅ s ]
k p = 2,5 ⋅ 10 −12 [m 2 / s]
k sp = 0,0012[m / V ]
2
NIKSEFAT, Navid y SEPEHRI, Nariman. Designing robust force control of hydraulic actuators
despite system and environmental uncertainties. En: IEEE Control Systems Magazine. Abril de
2001. 0272-1708/01, p. 71.
3
Ibid. p 71.
61
Reemplazando los distintos parámetros se obtiene la siguiente función de
transferencia en términos numéricos:
62
Figura 27. Diagrama de polos y ceros del sistema.
63
Figura 29. Diagrama de Bode del sistema.
Por lo general, los servos de fuerza poseen controladores PI, donde la constante
proporcional modifica el tiempo de respuesta del sistema y la constante integral
permite que el controlador mantenga la señal de salida (fuerza) aun cuando el
error es cero, además de que corrige el error en estado estacionario.
64
4. CARACTERIZACIÓN DE LA CELDA DE CARGA
65
• Dos manómetros
• Cilindro diferencial
• Celda de carga
• Módulo AAA (preamplificador de la celda de carga y tarjeta de adquisición
de datos DAQ USB 6212)
• Computador con interfaz gráfica en LabView para caracterización
• Módulo de control del banco Rexroth
66
Se realizó una interfaz gráfica en LabView destinada a la caracterización de la
celda de carga. Esta interfaz recibe, gráfica y almacena los datos de voltaje
enviados por la celda de carga para la fuerza sensada. Los datos son
almacenados en tiempo real en un vector para su posterior exportación a un bloc
de notas.
A continuación se muestra tanto la interfaz como el diagrama de bloques en
LabView diseñados para la caracterización de la celda de carga.
67
La válvula de seguridad proporcional fue controlada de forma analógica usando la
unidad de setpoint Rexroth. El potenciómetro de esta unidad permite variar el
voltaje de control que se envía al servoamplificador de la válvula, y por lo tanto,
permite variar la corriente que se envía al solenoide de la misma.
Proporcionalmente a la corriente enviada, el resorte de la válvula de seguridad es
comprimido con una mayor o menor fuerza y de esta manera se logran diferentes
tarajes de la válvula, es decir, diferentes niveles de presión.
Se tomaron datos desde la presión mínima hasta la presión máxima del sistema,
en intervalos de 5 [bar]; la presión mínima fue de 15 [bar] y la presión máxima de
60 [bar]. Para cada dato de presión se registró la salida en voltaje sensada por la
celda de carga. Cabe aclarar que la presión registrada es la presión en la cámara
del pistón (presión del manómetro 1) ya que la presión en el manómetro 2
permanecía en cero durante la aplicación de la fuerza.
Teniendo los datos de presión y el área del pistón se calculó la fuerza ejercida por
el cilindro en unidades de Newton [N] y kilogramos fuerza [kgf].
68
Tabla 2. Voltaje y fuerza de caracterización de la celda de carga.
Voltaje promedio [V] Fuerza[N] Fuerza[kgf]
0,008 0 0
0,705 746,067 76,052
0,980 994,756 101,402
1,221 1243,445 126,753
1,447 1492,134 152,103
1,707 1740,823 177,454
1,973 1989,512 202,804
2,196 2238,201 228,155
2,413 2486,890 253,506
2,652 2735,579 278,856
2,871 2984,268 304,207
69
F [kg ] = 104,76 ⋅ V [V ] − 1,076
F [ N ] = 1032,7 ⋅ V [V ] − 10,558
70
5. DISEÑO DE LOS CONTROLADORES
71
Seleccionando robustez como condición del estado transitorio y la mayor rapidez
de respuesta como las características deseadas del sistema se realiza la
sintonización del controlador.
72
Figura 38. Constantes del controlador y comportamiento del sistema.
73
• Control Design and Simulation: Ofrece los componentes propios de la
ingeniería de control, como bloques de funciones de transferencia,
representación en espacio de estados, entre otros.
• DAQ mx: Proporciona el vínculo entre el software y la tarjeta de adquisición
de datos DAQ USB 6212 para enviar y recibir señales análogas y digitales.
74
Para la lectura del voltaje que envía la celda de carga se agregó el bloque de la
librería DAQ mx. Con la ecuación característica obtenida de la celda de carga la
lectura de voltaje es convertida a fuerza. Se agregaron comparadores y selectores
con el fin de eliminar los valores negativos, y se agregaron dos filtros para reducir
el ruido electrónico en la lectura del sensor.
75
La siguiente sección incluye la función de transferencia de la plata. Esta se creó
usando el bloque Construct Transfer Function Model en el cuál se especifica que
el sistema es de única entrada y única salida (SISO-Single Input Single Output).
Figura 42. Función de transferencia del sistema en LabView.
Al determinar que el controlador a usar es un PID cabe resaltar que hay varias
maneras de implementarlo. Esto se puede lograr mediante los PID
predeterminados de LabView, usando VI’s existentes creados por usuarios, o
crear el propio controlador PID.
76
LabView no cumplan con los requerimientos, además de que es posible que no
sea característico de la presente aplicación.
77
Figura 45. Parámetros de ajuste del simulation loop.
78
Se realizó el cálculo de los errores entre el setpoint y la lectura de la celda de
carga porcentualmente y en magnitud, y se añadieron los respectivos
visualizadores.
Finalmente se realizaron los bloques para guardar datos en tiempo real. Este
permite guardar todos los datos del sistema deseados y basta con expandir la caja
“Array” y agregar todas las constantes y los valores a guardar deseados.
79
Figura 49. Bloques para guardar datos en tiempo real.
80
Esta interfaz cuenta con las siguientes 11 secciones que serán explicadas en este
numeral:
81
Figura 52. Sección de la lectura de la celda de carga.
El recuadro 2 presenta los testigos del estado del servo de fuerza. El LED
encenderá según corresponda a la aplicación de la fuerza, al avance del cilindro
hasta el punto de contacto, o el retroceso del mismo.
82
Figura 54. Función de transferencia del sistema.
83
En el recuadro 6 se encuentran los botones “Aplicar fuerza” y “Aplicar rampa”. El
primero de ellos se usa siempre que se desee ejercer el servo de fuerza, y el
segundo, cuando se desee aplicar la fuerza con una entrada en rampa.
84
En el recuadro 8 se encuentra la perilla para ajuste del setpoint del servo de fuerza
en [kg]. En la parte inferior se encuentra un recuadro donde se puede visualizar de
forma más precisa el valor seleccionado con la perilla para el setpoint, este
recuadro también permite introducir el valor.
En la sección 9 se tienen 3 perillas para ajustar las ganancias del controlador PID.
La primera perilla permite ajustar la constante proporcional, la segunda la
constante integral y la tercera la constante derivativa. Los recuadros en la parte
inferior permiten visualizar el valor de la constante, o introducir el valor deseado.
85
En el recuadro 10 se encuentran dos gráficas. La gráfica principal muestra tres
señales del servo: La señal de la celda de carga en color verde, el setpoint en
color rojo y la respuesta esperada del sistema en color blanco. En la gráfica
secundaria se muestra el comportamiento del voltaje enviado a la válvula
direccional proporcional. Las unidades se encuentra en los ejes coordenados de
las gráficas, y la gráfica principal posee su respectiva leyenda para las distintas
señales.
86
Figura 62. Sección de almacenamiento de datos.
K P = 1,5 ⋅ 10 −4
K I = 7,6 ⋅ 10 −2
KD = 0
87
5.2 CONTROL PID CON ADELANTO DE SEÑAL (FEEDFORWARD)
Tomando como referencia el diagrama de bloques de Seborg4 para un controlador
por realimentación (feedback) y por adelanto de señal (feedforward) se construyó
el diagrama de bloques del control PID con adelanto de señal para el servo de
fuerza.
Figura 63. Diagrama de bloques del control PID con adelanto de señal
(feedforward).
88
La función de transferencia en lazo cerrado que relaciona la salida del sistema con
la perturbación es:
Y ( s ) G d + Gt G f G p
= (5-1)
D( s) 1 + Gc G p G m
Gd
Gf = − (5-2)
Gt G p
1 + Gc G p G m = 0
89
Teniendo en cuenta que la función de transferencia del servo de fuerza tiene un
numerador de grado 2 y un denominador de grado 3, y que las funciones de
transferencia del sensor de la perturbación y del sensor de la señal de salida son
idénticas por ser la misma celda de carga y son una ganancia, entonces, el
controlador feedforward ideal no es físicamente realizable.
K f (τ 1 s + 1)
G f ( s) = (5-3)
τ 2s +1
5.2.1 Diseño del control PID con adelanto de señal (feedforward) en LabView
90
Figura 64. Diagrama de bloques del controlador feedforward.
91
Figura 65. Diagrama de bloques del controlador PID con feedforward.
92
Figura 66. Sección del controlador feedforward.
5
SEBORG, Dale E, et al. Process dynamics and control. Tercera Edición. Estados Unidos de
América, Wiley, 2001, p. 284-285. ISBN 978-0-470-12867-1.
93
τ1
Se inició con un valor de 0,001 para τ 1 , y el valor de τ 2 seguía la relación = 2,
τ2
por lo tanto era igual a 0,005. Con estos valores se observaba que la acción
correctiva era muy lenta. Se redujo el valor de τ 2 manteniendo constante τ 1 hasta
observar que la respuesta del sistema fuera rápida. El valor de τ 2 con el que se
obtuvo un tiempo de respuesta adecuado fue de 0,0001.
94
6. PRUEBAS DEL SERVO DE FUERZA
95
Figura 68. Montaje de control de la prueba en lazo abierto.
96
El voltaje de control mínimo para producir la mínima fuerza del sistema es 0,13 [V],
y el voltaje con el que se obtiene la fuerza máxima es de 0,45 [V]. Por debajo del
voltaje mínimo el cilindro comienza su retracción debido a la diferencia de áreas
entre la cámara del pistón y la cámara anular, y por encima del voltaje máximo no
se aprecia una diferencia en fuerza sino una diferencia en el caudal que
únicamente resultaría útil para un control de velocidad. En conclusión el rango de
voltaje para el control de fuerza es entre 0,13 [V] y 0,45 [V].
97
Figura 70. Montaje para las pruebas de los controladores.
98
6.2.1 Prueba sin perturbación
Figura 72. Respuesta en estado transitorio del control PID para una entrada
escalón de 210 [kg]
Figura 73. Respuesta en estado estacionario del control PID para una
entrada al escalón de 210 [kg].
99
Se observa un comportamiento ligeramente sub amortiguado con un sobre pico de
0,1% en el estado transitorio. El tiempo de asentamiento es de aproximadamente
1,5 [s] lo cual es aproximadamente 1/8 del tiempo de respuesta obtenido para el
lazo abierto. El control presenta un error de 0,01% en el estado estacionario lo
cual puede considerarse como despreciable.
Figura 74. Respuesta del controlador PID para una variación en el setpoint
de 210 [kg] a 150 [kg].
100
Figura 75. Respuesta del controlador PID para una variación en el setpoint
de 150 [kg] a 250 [kg].
En ambos casos se observa que antes las variaciones del setpoint, el control PID
logra establecerse en un tiempo de alrededor de 1,5 [s], y el error en estado
estacionario es despreciable con un comportamiento críticamente amortiguado.
101
Figura 76. Respuesta para un setpoint de 200 [kg] con un valor de rampa de
25[kg/s].
Figura 77. Respuesta para un setpoint de 200 [kg] con un valor de rampa de
50[kg/s].
102
El tiempo de asentamiento hasta alcanzar el valor de fuerza deseado se ve
modificado por la tasa de crecimiento de la fuerza con respecto al tiempo (valor de
rampa). El comportamiento obtenido es críticamente amortiguado donde no se
obtiene ningún sobre pico, y el error en estado estacionario es de
aproximadamente 0,01% lo que se puede considerar despreciable.
103
Figura 78. Respuesta del controlador PID ante una perturbación de 25 [kg].
104
Figura 79. Respuesta del control PID con feedforward para setpoint de 180
[kg] y perturbación de 25 [kg].
Figura 80. Respuesta del control PID feedforward para setpoint de 120 [kg] y
perturbación de 25 [kg].
105
Figura 81. Respuesta del control PID con feedforward para setpoint de 220
[kg] y perturbación de 25 [kg].
Figura 82. Respuesta del control PID con feedforward para setpoint de 270
[kg] y perturbación de 25 [kg].
En todas las pruebas del servo de fuerza con feedforward se observa una gran
mejora en el error en estado estacionario, pasando de un error de
aproximadamente 2,5 a 0,01%, así como una señal de salida de la válvula más
homogénea haciendo el sistema más estable cuando se presenta la perturbación.
106
6.4 REPETIBILIDAD
El fin de la prueba de repetibilidad es observar la capacidad de la válvula en el
servo de fuerza para repetir el valor deseado de setpoint. Se realizó una prueba de
repetibilidad del servo de fuerza utilizando en primer lugar la válvula direccional
proporcional Rexroth y en segundo lugar se realizó con una servoválvula MOOG
62.
repetibilidad =
∑S W
⋅100
p
107
En donde SW corresponde a la desviación estándar de cada medición con
Tabla 5. Repetibilidad.
Setpoint [kg] Repetibilidad
150 1,10281785
160 1,369021211
170 1,626818949
180 1,188993537
190 0,788027452
200 0,509935948
210 0,560603012
220 0,675949835
230 0,94847713
240 0,980866518
250 0,7861979
108
6.4.2 Repetibilidad utilizando la Servoválvula MOOG 62.
Fuente: MOOG INC. Transfer Function for Moog Servovalves. Nueva York. 1965.
11 p.
F − b ⋅ x! − k ⋅ x = m ⋅ !x! (6-1)
La fuerza que ejerce el actuador se relaciona con las presiones en sus dos
cámaras de la siguiente manera:
109
F = A ⋅ ( P1 − P2 ) (6-2)
PL = P1 − P2
F = PL ⋅ A (6-3)
V !
QL = Q1 − Q2 = 2 ⋅ A ⋅ x! + ⋅ PL (6-4)
β
V
C=
β
QL = Cv ⋅ xV ⋅ 2 ⋅ ( PS − P R − P1 ) (6-5)
110
Donde C v es el coeficiente de descarga y xV es el desplazamiento del carrete.
Esta ecuación debe ser linealizada alrededor de un punto de operación para así
obtener una función de transferencia lineal.
⎛ ∂Q ⎞ ⎛ ∂Q ⎞
QL = ⎜⎜ L ⎟⎟ ⋅ xV + ⎜⎜ L ⎟⎟ ⋅ PL
⎝ ∂xV ⎠ xVo , PLo ⎝ ∂PL ⎠ xVo , PLo
CV ⋅ xVo ⋅ 2
QL = (CV ⋅ 2 ⋅ ( PS − PR − P Lo ) ) ⋅ xV − ⋅ PL
2 ( PS − PR − P 1o )
CV ⋅ xVo
Q L = (CV ⋅ 2 ⋅ ( PS − PR − P Lo ) ) ⋅ xV − ⋅ PL (6-6)
2 ⋅ ( PS − PR − P 1o )
k s = CV ⋅ 2 ⋅ ( PS − PR − P Lo )
CV ⋅ xVo
kp =
2 ⋅ ( PS − PR − P 1o )
QL = k s ⋅ xV − k p ⋅ PL (6-7)
111
La función de transferencia que relaciona el desplazamiento del carrete de la
servoválvula con el voltaje de entrada es la siguiente:
xV kV
=
u 1 2 ⋅ξv
⋅ s2 + ⋅ s +1
ωv 2 ωv
2 ⋅ A ⋅ x! + C ⋅ P!L = k s ⋅ xV − k p ⋅ PL (6-8)
k s ⋅ xV − 2 ⋅ A ⋅ x ⋅ s
PL = (6-9)
C ⋅s + kp
k s ⋅ xV ⋅ A − 2 ⋅ A 2 ⋅ x ⋅ s
F=
C ⋅s + kp
Despejando x :
112
k s ⋅ xV ⋅ A − F ⋅ (C ⋅ s + k p )
x= (6-10)
2 ⋅ A2 ⋅ s
F = (m ⋅ s 2 + b ⋅ s + k ) ⋅ x (6-11)
F s 2 ⋅ [k S ⋅ m ⋅ A] + s ⋅ [⋅k S ⋅ b ⋅ A] + [k S ⋅ k ⋅ A]
=
xv s 3 ⋅ (m ⋅ C ) + s 2 ⋅ (b ⋅ C + m ⋅ k p ) + s ⋅ (k ⋅ C + b ⋅ k p + 2 ⋅ A 2 ) + k ⋅ k p
⎛ ⎞
⎜ ⎟
F ⎛⎜ s 2 ⋅ [k S ⋅ m ⋅ A] + s ⋅ [⋅k S ⋅ b ⋅ A] + [k S ⋅ k ⋅ A] ⎞ ⎜
⎟⋅ k V ⎟
= 3
xv ⎜⎝ s ⋅ (m ⋅ C ) + s 2 ⋅ (b ⋅ C + m ⋅ k p ) + s ⋅ (k ⋅ C + b ⋅ k p + 2 ⋅ A 2 ) + k ⋅ k p ⎟ ⎜ 1 2 2 ⋅ξv ⎟
⎠ ⎜ ⋅ s + ⋅ s + 1 ⎟⎟
⎜ω 2 ωv
⎝ v ⎠
π ⋅ DP 2 π ⋅ DV 2
A= −
4 4
113
Donde DP es el diámetro del pistón y DV es el diámetro del vástago. El área es de
[ ]
0,0009387 m 3 .
La masa del cilindro m fue estimada en 1 [kg] ya que involucra la masa del
vástago del cilindro y la masa de la celda de carga.
k s = 0,375[m 3 / Pa ⋅ s ]
k p = 2,5 ⋅ 10 −12 [m 2 / s]
k v = 0.0012[m / V ]
⎡ rad ⎤
ω v = 1160⎢ ⎥
⎣ s ⎦
6
NIKSEFAT, Op. cit., p. 71.
7
Ibid., p. 71.
8
MOOG INC. Transfer Function for Moog Servovalves. Nueva York. 1965, p. 9.
114
ξ v = 0,4
115
Figura 84. Función de transferencia en LabView.
116
6.4.2.4 Prueba de repetibilidad.
repetibili dad =
∑S W
⋅ 100
p
mediciones p
117
200 0,070711 0,021213 0,028284 0,007071 200,025
250 0,113137 0,049497 0,077782 0,028284 249,985
300 0,049497 0 0,077782 0,226274 299,91
350 0,212132 0,077782 0,056569 0,042426 350,0975
400 0,091924 0,035355 0,091924 0,247487 399,9
450 0,070711 0,042426 0,148492 0,106066 449,92
500 0,070711 0,106066 0,240416 0,042426 500,0825
550 0,06364 0,643467 0,13435 0,007071 549,84
600 0,070711 0,219203 0,289914 0,007071 599,7975
650 0,141421 0,169706 0,233345 0,084853 650,2225
repetibilidad = 1,4108852%
118
7. DETERMINACIÓN DE LAS CARACTERÍSTICAS DE LA RESPUESTA
DINÁMICA DE LA VÁLVULA DIRECCIONAL PROPORCIONAL DE
ALTAS PRESTACIONES REXROTH 4WRPEH6 C3 B04L –
20/G24K0/A1M
119
Figura 88. Montaje de control.
Se tomaron valores de voltaje desde -10 [V] hasta +10 [V] en incrementos de 0,5
[V] y se midió el caudal que enviaba la válvula para tal señal de entrada. El caudal
se obtuvo al medir el tiempo que se demoraba en llenar determinado volumen en
el tanque cilíndrico. El tiempo fue medido tres veces por cada valor de voltaje.
120
En el anexo E se encuentran los datos de tiempo promedio, caudal y ganancia en
caudal calculados para realizarla respectiva gráfica de caudal vs. Voltaje:
121
Figura 90.Esquema del montaje para terminar la ganancia en presión.
Se tomaron voltajes de 0 [V] a 0,6[V] en intervalos de 0,05 [V] debido a que como
se dijo anteriormente, el voltaje en el cual la presión es regulada y varía, va hasta
0,45 [V] aproximadamente.
Se realizaron cinco tomas de datos con el fin de lograr una disminución de errores
las cuales se encuentran en el anexo J.
122
Figura 91. Gráfica de P vs. V.
Graficando estos puntos de nuevo Presión vs Voltaje para estos valores se tiene
123
7.3 HISTÉRESIS
El montaje hidráulico realizado para medir la histéresis en términos de caudal fue
idéntico al usado para medir la ganancia en caudal (figura 87), y se realizó el
mismo montaje de control de la figura 88.
Se tomaron valores de voltaje desde -10 [V] hasta +10 [V] en incrementos de 0,5
[V] y se midió el caudal que enviaba la válvula para tal señal de entrada, primero
en forma ascendente y luego en forma descendente. El caudal se obtuvo al medir
el tiempo que se demoraba en llenar determinado volumen en el tanque cilíndrico.
124
La histéresis se cálculó en el punto donde se obtiene la mayor diferencia de
caudal, entre el sentido ascendente y el sentido descedente, para igual valor en la
señal de entrada. Se utilizó la siguiente fórmula que permite obtener el error de
histéresis en porcentaje:
⎛Q − Qdescendente ⎞
histéresis = ⎜⎜ ascedente ⎟⎟ ⋅ 100
⎝ Qmax − Qmin ⎠
⎛ 0,0332 − 0,0315 ⎞
histéresis = ⎜ ⎟ ⋅ 100 = 0,238%
⎝ 0,714 − 0 ⎠
7.4 LINEALIDAD
Para calcular la linealidad de la válvula se utilizaron los datos obtenidos en la
prueba de ganancia en caudal (tabla 6).
Se realizó la tabla para el cálculo de linealidad con los datos obtenidos de voltaje,
caudal experimental, caudal teórico y la diferencia de los mismos (ver anexo G)
⎛ QTeórico − QExperimental ⎞
Linealidad = ⎜⎜ ⎟⎟ ⋅ 100
⎝ QTeórico ⎠
125
⎛ 0,06995 − 0,0686 ⎞
Linealidad = ⎜ ⎟ ⋅ 100
⎝ 0,06995 ⎠
Linealidad = 1,948%
126
8. CONCLUSIONES
Se realizó el modelado dinámico del sistema partiendo del análisis matemático del
actuador (segunda ley de Newton y continuidad) y de la válvula (flujo,
desplazamiento del carrete-voltaje).
127
Se corroboró, tal como dice la teoría, que los servos de fuerza se controlan
usando únicamente una acción proporcional y una acción integral, es decir, un
control PI. Al realizar la sintonización del controlador con la aplicación PID tuner
de Matlab la constante integral era igual a cero, y posteriormente, cuando se
realizó la resintonización, se obtuvo un buen desempeño usando únicamente
constantes proporcional e integral.
128
RECOMENDACIONES
129
BIBLIOGRAFÍA
BOSCH REXROTH AG. 4/4-way servo solenoid directional control valves, directly
operated, with electrical position feedback and on-board electronics (OBE). Type
4WRPEH6. Lohr am Main, 12 p.
BOSCH REXROTH AG. Training Systems for Hydraulics. Würzburg, 2015. 186 p.
MOOG INC. Transfer Function for Moog Servovalves. Nueva York. 1965. 11 p.
130
SEBORG, Dale E, et al. Process dynamics and control. Tercera Edición. Estados
Unidos de América, Wiley, 2001. 973 p. ISBN 978-0-470-12867-1.
131
ANEXOS
HIDRÁULICA PROPORCIONAL
132
• Control en el comportamiento de las conmutaciones, lo cual elimina picos
de presión y tiene por efecto una mayor vida útil de los elementos
mecánicos e hidráulicos
VÁLVULAS PROPORCIONALES
133
Figura 94. Válvula direccional proporcional de prestaciones elevadas.
134
GANANCIA EN CAUDAL
La imagen anterior presenta una zona en la cual no hay variación de caudal aun
cuando la señal de entrada aumenta, esta zona es conocida como banda muerta.
La banda muerta, dentro de la gráfica de ganancia en caudal, se debe al tipo de
carrete que presenta la válvula, un carrete centro cerrado. Las salientes de este
carrete cubren los puertos P y T cuando la válvula está en su posición central, por
lo tanto, se necesita de una carrera del carrete antes que estos empiecen a abrirse
y envíe caudal.
135
Figura 97. Carrete centro cerrado.
Cuando la válvula tiene un carrete centro abierto hay caudal aun cuando la señal
de entrada es cero. Esto se debe a que las salientes del carrete permiten que en
la posición central de la válvula los puertos P y T estén abiertos.
136
El centro crítico se caracteriza porque las salientes coinciden exactamente con los
puertos de la válvula, por lo tanto, cuando el carrete está en su posición central no
hay flujo, pero inmediatamente se envía una señal de entrada, el carrete se mueve
permitiendo el flujo.
137
Figura 102. Gráfica de ganancia en caudal para los diferentes tipos de
carrete.
El carrete centro abierto tiene una ganancia en caudal más elevada alrededor de
su posición central, el centro crítico presenta una ganancia de caudal constante, y
el centro cerrado posee una zona donde no hay ganancia en caudal (banda
muerta).
GANANCIA EN PRESIÓN
138
Figura 103. Gráfica de ganancia en presión para los diferentes tipos de
carrete.
HISTÉRESIS
139
Fuente: MANNESMANN, REXROTH. Técnica de válvulas proporcionales y
servoválvulas. Training hidráulico, compendio 2. Lohr am Main, 1996. 286 p.
REPETIBILIDAD
LINEALIDAD
140
Fuente: VICKERS SYSTEMS S. A. Manual para servoválvulas y válvulas
proporcionales en cadena cerrada. Barcelona, 1990. 69 p.
SERVO DE FUERZA
141
Fuente: VICKERS SYSTEMS S. A. Manual para servoválvulas y válvulas
proporcionales en cadena cerrada. Barcelona, 1990. 69 p.
Los sistemas de control de fuerza en lazo cerrado surgen como alternativa para
brindar mayor precisión en el control de esta variable. En estos sistemas se usan
válvulas de control de presión proporcionales, como por ejemplo una válvula de
seguridad proporcional o una válvula direccional proporcional, y es necesario
incluir un transductor de presión para generar la realimentación de la señal de
presión en el sistema.
142
También se pueden usar servoválvulas o válvulas proporcionales de prestaciones
elevadas con centro crítico o con centro abierto para el control de fuerza:
143
Figura 109. Amplificador PI usado para el control de fuerza.
CONTROL PID
Debido a este inconveniente que presentan los controladores por feedback surge
un modelo denominado control por adelanto de señal o feedforward. El control
feedforward tiene como fin realizar una corrección apropiada sobre la variable
manipulada para mantener a la variable controlada cerca del setpoint antes de que
la perturbación entre al sistema. Para ello, el feedforward mide la perturbación y
utiliza esta información para advertir al sitema de que la variable controlada va a
ser modificada. Esta advertencia le permite al controlador ajustar la variable
manipulada antes de que se desvie de su setpoint.
144
Comúnmente el control feedforward es usado junto con el control por feedback ya
que el sistema de control resultante aprovecha las ventajas de ambos y permite
obtener un mejor desempeño. El resultado es un control efectivo a cambios en el
setpoint y a las perturbaciones.
145
ANEXO B ESPECIFICACIONES DE LA TARJETA DE ADQUISICIÓN DE
DATOS NATIONAL INSTRUMENTS DAQ USB 6212
146
Rango de Voltaje Mínimo
Rango -10 V a 10 V
Precisión 3.512 mV
Razón de Actualización 250 kS / s
Capacidad de Corriente Simple 2 mA
E / S Digital
Canales Bidireccionales 32
Canales de Entrada Únicamente 0
Temporización Software
Niveles Lógicos TTL
Filtros de Entrada Programables No
Sí
¿Soporta Estados de Encendido Programables?
Entrada Digital
Sinking
Tipo de Entrada
Sourcing
Rango de Voltaje Máximo 0 V - 5.25 V
Salida Digital
Sinking
Tipo de Salida
Sourcing
Capacidad de Corriente Simple 16 mA
Contadores / Temporizadores
Temporizador Watchdog No
147
Contadores 2
Operaciones a Búfer Sí
Debouncing / Glitch Removal Sí
Generación de Pulso Sí
Tamaño 32 bits
Estabilidad de Tiempo 50 ppm
148
ANEXO C ESPECIFICACIONES DE LA CELDA DE CARTA TIPO “S”
149
Fuente: Catálogo de Celdas de Carga marca LEXUS. Via Industrual. Disponible
en:
http://www.viaindustrial.com/catalogos_pdf/Celdas_de_carga_Tipo_S_Baja_Capac
idad_SA-500_LEXUS_Catalogo_Espa%C3%B1ol.pdf
150
ANEXO D Tabla de datos para la determinación de ganancia en caudal
151
2 0,2 13,62 13,75 13,69
2,5 0,2 11,16 11,01 11
3 0,2 9,22 9,25 9,28
3,5 0,2 8 7,82 7,91
4 0,2 7,09 6,97 6,97
4,5 0,5 15,66 15,35 15,59
5 0,5 14,06 13,94 13,94
5,5 0,5 12,56 12,53 12,44
6 0,5 11,56 11,56 11,4
6,5 0,5 10,63 10,62 10,78
7 0,5 9,84 9,87 9,97
7,5 0,5 9,25 9,21 9,31
8 0,5 8,68 8,5 8,81
8,5 0,5 8,29 8,16 8,19
9 0,5 7,72 7,78 7,63
9,5 0,5 7,34 7,38 7,32
10 0,5 6,9 6,91 6,94
152
ANEXO E TABLA DE DATOS DE TIMPO PROMEDIO, CAUDAL Y
GANANCIA EN CAUDAL
153
13,69 0,0146 0,0073
11,06 0,0181 0,0072
9,25 0,0216 0,0072
7,91 0,0253 0,0072
7,01 0,0285 0,0071
15,53 0,0322 0,0072
13,98 0,0358 0,0072
12,51 0,0400 0,0073
11,51 0,0435 0,0072
10,68 0,0468 0,0072
9,89 0,0505 0,0072
9,26 0,0540 0,0072
8,66 0,0577 0,0072
8,21 0,0609 0,0072
7,71 0,0649 0,0072
7,35 0,0681 0,0072
6,92 0,0723 0,0072
154
ANEXO F TABLA DE DATOS DE VOLTAJE, VOLUMEN, TIEMPO Y
CAUDAL PARA LA DETERMINACIÓN DE LA HISTÉRESIS
155
1,5 0,1 9,25 0,0108
2 0,1 7,22 0,0139
2,5 0,1 5,68 0,0176
3 0,1 4,82 0,0207
3,5 0,1 4,12 0,0243
4 0,2 7,07 0,0283
4,5 0,2 6,15 0,0325
5 0,2 5,62 0,0356
5,5 0,2 5,26 0,0380
6 0,2 4,53 0,0442
6,5 0,2 4,4 0,0455
7 0,2 4,1 0,0488
7,5 0,2 3,78 0,0529
8 0,2 3,4 0,0588
8,5 0,5 8,23 0,0608
9 0,5 7,82 0,0639
9,5 0,5 7,22 0,0693
10 0,5 7,05 0,0709
9,5 0,5 7,28 0,0687
9 0,5 7,65 0,0654
8,5 0,5 8,25 0,0606
8 0,2 3,32 0,0602
7,5 0,2 3,76 0,0532
7 0,2 4 0,0500
6,5 0,2 4,3 0,0465
6 0,2 4,45 0,0449
5,5 0,2 5,26 0,0380
5 0,2 5,77 0,0347
4,5 0,2 6,08 0,0329
156
4 0,2 6,8 0,0294
3,5 0,1 3,89 0,0257
3 0,1 4,76 0,0210
2,5 0,1 5,4 0,0185
2 0,1 6,92 0,0145
1,5 0,1 9,32 0,0107
1 0,1 13,4 0,0075
0,5 0,1 25,17 0,0040
0 0,1 0 0,0000
-0,5 0,1 19,84 -0,0050
-1 0,1 12,02 -0,0083
-1,5 0,1 7,97 -0,0125
-2 0,1 6,75 -0,0148
-2,5 0,1 5,3 -0,0189
-3 0,1 4,55 -0,0220
-3,5 0,1 3,93 -0,0254
-4 0,2 6,78 -0,0295
-4,5 0,2 6,03 -0,0332
-5 0,2 5,53 -0,0362
-5,5 0,2 4,96 -0,0403
-6 0,2 4,5 -0,0444
-6,5 0,2 4,26 -0,0469
-7 0,2 4,13 -0,0484
-7,5 0,2 3,66 -0,0546
-8 0,2 3,42 -0,0585
-8,5 0,5 8,05 -0,0621
-9 0,5 7,55 -0,0662
-9,5 0,5 7,17 -0,0697
-10 0,5 7 -0,0714
157
ANEXO G DATOS DE VOLTAJE, CAUDAL TEÓRICO, CAUDAL
EXPERIMENTAL Y DIFERENCIA PARA EL CÁLCULO DE LINEALIDAD
158
1 0,0072 0,0067 0,000458
1,5 0,0109 0,01035 0,000539
2 0,0146 0,014 0,000613
2,5 0,0181 0,01765 0,000439
3 0,0216 0,0213 0,000322
3,5 0,0253 0,02495 0,000334
4 0,0285 0,0286 6,93E-05
4,5 0,0322 0,03225 6,12E-05
5 0,0358 0,0359 0,000135
5,5 0,0400 0,03955 0,000418
6 0,0435 0,0432 0,000253
6,5 0,0468 0,04685 1,89E-05
7 0,0505 0,0505 3,91E-05
7,5 0,0540 0,05415 0,000135
8 0,0577 0,0578 8,55E-05
8,5 0,0609 0,06145 0,000573
9 0,0649 0,0651 0,000249
9,5 0,0681 0,06875 0,000692
10 0,0723 0,0724 0,000111
159
ANEXO H OTROS ELEMENTOS DEL BANCO REXROTH USADOS PARA EL
SERVO DE FUERZA Y LAS PRUEBAS
160
Figura 111. Unidad de alimentación del banco Rexroth.
Unidad de setpoint
La unidad de setpoint posee un par de puertos de 4 [mm] para alimentación a 24
[V], un par de puertos de 2 [mm] para envío de la señal del setpoint a ± 10 [V], un
potenciómetro para ajustar el setpoint, y un potenciómetro para seleccionar la
polaridad.
161
Fuente: BOSCH REXROTH AG. Training Systems for Hydraulics. Würzburg,
2015. 186 p.
Unidad de displays
La unidad de displays posee dos voltímetros digitales de 3 ½ dígitos. Tiene dos
puertos de 4 [mm] para la alimentación a 24 [V], y dos pares de puertos de 2[mm]
para le medición de voltaje. El rango de medición está en ± 20 [V].
Esta unidad permite visualizar el voltaje de control que se envía desde el módulo
AAA, específicamente desde la tarjeta de adquisición de datos, al
servoamplificador de la válvula direccional proporcional.
162
ANEXO I DIAGRAMA ELECTRÓNICO DE LOS COMPONENTES DEL
MÓDULO AAA
Sección DAQ-Válvula
163
164
ANEXO J TABLA DE DATOS DE VOLTAJE Y PRESIÓN PARA
DETERMINAR LA GANANCIA EN PRESIÓN
Tabla 14. Datos de voltaje y presión para determinar la ganancia en presión.
Voltaje Presión 1 Presión 2 Presión 3 Presión 4 Presión 5
[V] [Bar] [Bar] [Bar] [Bar] [Bar]
0 0 0 0 0 0
0,05 9,5 10 11,5 11 11
0,1 19 20,5 18 17,5 20
0,15 26 27,5 30,5 28 30
0,2 37 37 40 38 39
0,25 44 42,5 43 42,5 44,5
0,3 50 48 49 48 47,5
0,35 50,5 50 50 49,5 50
0,4 51 50,5 50,5 50 50,5
0,45 51 51 51 50,5 51
0,5 51 51 51 51 51
0,55 51 51 51 51 51
0,6 51 51 51 51 51
165
ANEXO K TABLA DE DATOS DE VOLTAJE Y PRESIÓN PROMEDIO PARA
DETERMINAR LA GANANCIA EN PRESIÓN
Tabla 15. Datos de voltaje y presión promedio para determinar la ganancia en
presión.
Voltaje [V] Presión promedio [Bar]
0 0
0,05 10,6
0,1 19
0,15 28,4
0,2 38,2
0,25 43,3
0,3 48,5
0,35 50
0,4 50,5
0,45 50,9
0,5 51
0,55 51
0,6 51
166