ES2276746T3 - Un dispositivo para la generacion de magnitudes de guia para circuitos reguladores de una maquina con control numerico. - Google Patents
Un dispositivo para la generacion de magnitudes de guia para circuitos reguladores de una maquina con control numerico. Download PDFInfo
- Publication number
- ES2276746T3 ES2276746T3 ES01274420T ES01274420T ES2276746T3 ES 2276746 T3 ES2276746 T3 ES 2276746T3 ES 01274420 T ES01274420 T ES 01274420T ES 01274420 T ES01274420 T ES 01274420T ES 2276746 T3 ES2276746 T3 ES 2276746T3
- Authority
- ES
- Spain
- Prior art keywords
- sampling frequency
- interpolation unit
- feedforward
- fine
- arrangement according
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Lifetime
Links
- 230000001105 regulatory effect Effects 0.000 title claims abstract description 19
- 238000005070 sampling Methods 0.000 claims abstract description 60
- 238000004364 calculation method Methods 0.000 description 8
- 239000000543 intermediate Substances 0.000 description 5
- 238000000034 method Methods 0.000 description 5
- 238000001914 filtration Methods 0.000 description 4
- 230000033001 locomotion Effects 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 3
- 230000006978 adaptation Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000004069 differentiation Effects 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 238000007781 pre-processing Methods 0.000 description 1
- 238000001228 spectrum Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/41—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path
- G05B19/4103—Digital interpolation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/416—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/34—Director, elements to supervisory
- G05B2219/34104—Postprocessor coarse fine
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/34—Director, elements to supervisory
- G05B2219/34119—Function generator, filter after interpolator to control position error
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/34—Director, elements to supervisory
- G05B2219/34167—Coarse fine, macro microinterpolation, preprocessor
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41151—Finite impulse response filter
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computing Systems (AREA)
- Theoretical Computer Science (AREA)
- Numerical Control (AREA)
- Paper (AREA)
- Electrical Discharge Machining, Electrochemical Machining, And Combined Machining (AREA)
- Control Of Metal Rolling (AREA)
Abstract
Disposición para la generación de magnitudes de guía para circuitos reguladores de una máquina con control numérico, compuesta por una unidad de interpolación (10) para la fijación previa de valores teóricos de posición con una determinada frecuencia de muestreo del interpolador y con una unidad de interpolación fina (30) que está posconectada en serie a la unidad de interpolación y genera, a partir de valores teóricos de posición en el lado de la entrada, magnitudes de guía del lado de la salida para uno o varios circuitos reguladores posconectados, donde la unidad de interpolación fina genera las magnitudes de guía en la retícula de tiempo de los circuitos reguladores con la frecuencia de muestreo del circuito regulador, caracterizada porque la unidad de interpolación fina (30) incluye un transductor de frecuencias de muestreo (33.1, 33.2), así como un filtro digital de paso bajo (34.1, 34.2) posconectado, donde el transductor de frecuencias de muestreo (33.1, 33.2) eleva la frecuencia demuestreo del interpolador de las señales del lado de la entrada en una cantidad equivalente a un factor de interpolación determinado, hasta alcanzar la frecuencia de muestreo del circuito regulador.
Description
Un dispositivo para la generación de magnitudes
de guía para circuitos reguladores de una máquina con control
numérico.
La presente invención se refiere a un
dispositivo para la generación de magnitudes de guía para circuitos
reguladores de una máquina con control numérico según el preámbulo
de la reivindicación 1.
En las máquinas herramienta o robots controlados
por ordenador la generación de valores teóricos para la posición,
la velocidad y la aceleración como magnitudes de guía para los
circuitos reguladores de los correspondientes accionamientos tiene
lugar normalmente en unidades de interpolación preasignadas a los
circuitos reguladores. Con esta finalidad se preajustan a las
unidades de interpolación, en el lado de la entrada, las funciones
geométricas de movimiento axial y los perfiles de velocidad
deseados. En el lado de la salida la unidad de interpolación
proporciona series discretas de valores teóricos o valores de
muestreo en una trayectoria. Los valores teóricos se emiten como
magnitudes de guía para los circuitos reguladores posconectados en
línea con un tiempo de muestreo del interpolador T_{IPO}
definido, normalmente fijo. Por otra parte los valores teóricos
generados por la unidad de interpolación antes de la transmisión al
circuito regulador de posición se filtran aún en un filtro de
valores teóricos, por lo general en forma de un filtrado digital de
paso bajo, para conseguir de este modo un aplanamiento de la
trayectoria.
Por la solicitud de patente internacional WO
01/18622 de la solicitante se conoce un dispositivo genérico de
este tipo. En esta solicitud de patente se proponen, en particular,
medidas que afectan al modo de construir, con el menor esfuerzo de
cálculo posible, un filtro apropiado de valores teóricos de posición
en la forma de un filtro FIR [finite impulse response]. Por
otra parte, en esta solicitud se describe además que, para la
generación de magnitudes de guía en la retícula de tiempo de los
circuitos reguladores, se debe disponer una unidad de interpolación
fina entre el filtro de los valores teóricos de posición y los
circuitos reguladores, por ejemplo el circuito regulador de
posición. Con ayuda de la unidad de interpolación fina el tiempo de
muestreo del interpolador T_{IPO}, que se sitúa típicamente en el
entorno de T_{IPO} = [1...6 ms], o la frecuencia de muestreo del
interpolador, se adapta al tiempo de muestreo del circuito regulador
T_{Ctrl}, al circuito regulador posconectado y a la frecuencia de
muestreo del circuito regulador. El tiempo de muestreo del circuito
regulador T_{Ctrl} se encuentra más o menos en el entorno de
T_{Ctrl} = [100...800 \mus], y es, por tanto, claramente menor
que el tiempo de muestreo del interpolador T_{IPO}, o bien la
frecuencia de muestreo del circuito regulador es claramente mayor
que la frecuencia de muestreo del interpolador. No obstante, en
este documento no figuran detalles acerca del diseño concreto de la
unidad de interpolación fina.
Una arquitectura similar de un control numérico
se da a conocer además en la introducción de la descripción de la
patente DE 43 03 090 A1; no obstante, tampoco en este documento se
encuentran referencias sobre el modo de configurar de forma
apropiada la unidad de interpolación fina.
Habitualmente la adaptación del tiempo de
muestreo del interpolador T_{IPO} al tiempo de muestreo del
circuito regulador T_{Ctrl} del circuito regulador posconectado
tiene lugar mediante procedimientos muy costosos. Por ejemplo, por
la patente EP 0 917 033 A2 se conoce aquí la aplicación de una
llamada interpolación polinómica, o bien una interpolación de
splines. No obstante, además del esfuerzo de cálculo enorme, este
tipo de interpolación fina ofrece unas trayectorias resultantes con
unas oscilaciones excesivas no deseadas.
Por lo demás, en este punto se trabaja también
con interpolación fina lineal. Sin embargo, este procedimiento da
lugar a excitaciones no deseadas de los sistemas de accionamiento en
las correspondientes transiciones entre segmentos.
Por tanto, el objetivo de la presente invención
consiste en indicar, para un dispositivo genérico de generación de
magnitudes de guía para circuitos reguladores de una máquina con
control numérico, una aplicación idónea de una unidad de
interpolación fina. Aquí la unidad de interpolación fina deberá
procesar los valores teóricos de posición generados por una unidad
de interpolación con una determinada frecuencia de muestreo del
interpolador, de tal modo que resulten magnitudes de guía para los
circuitos reguladores posconectados en la retícula de tiempo de la
frecuencia de muestreo del circuito regulador. Se exige, además de
un gasto de cálculo lo más reducido posible para la interpolación
fina, la mejor calidad posible de las trayectorias resultantes.
Este objetivo se resuelve mediante una
disposición con las características relevantes de la reivindicación
1.
Las formas de realización ventajosas de la
disposición conforme a la invención se deducen de las medidas
enumeradas en las reivindicaciones dependientes de la
reivindicación 1.
De acuerdo con la invención se prevé a partir de
ahora la realización de la unidad de interpolación fina con ayuda
de un transductor de frecuencias de muestreo y de un filtro digital
posconectado. La medida de configurar el filtro digital como filtro
FIR se muestra aquí como particularmente ventajosa. De este modo
resulta posible unir las operaciones aritméticas en curso del
transductor de frecuencias de muestreo y del filtro FIR. Dado que
el transductor de frecuencias de muestreo introduce valores
intermedios con el valor cero en la retícula de tiempo de la
frecuencia de muestreo del circuito regulador, entre los valores
teóricos del lado de la entrada, el vector de entrada del filtro
FIR contiene muchos valores cero. Todo valor cero contiguo a la
entrada del filtro FIR da lugar, en el lado del filtro FIR, a
operaciones aritméticas cuyo valor de salida es a su vez cero. De
acuerdo con la invención se aprovecha en adelante esta
circunstancia, esto es, no es necesario efectuar las operaciones
aritméticas con el valor de entrada cero. Por el contrario se
calculan, para una serie de valores de entrada con ayuda de varios
conjuntos de coeficientes de filtro, varios valores de salida
interpolados, donde el número de conjuntos de coeficientes de
filtro necesarios para el cálculo corresponde al factor de
interpolación deseado. De este modo se requiere únicamente un
esfuerzo de cálculo escaso por parte de la unidad de interpolación
fina.
También se puede mencionar, como ventaja añadida
de la disposición conforme a la invención, una calidad muy buena de
la trayectoria resultante en último término. La razón de ello es la
posibilidad, debida al tipo de interpolación fina seleccionado, de
reconstruir casi exactamente la señal de salida en la medida en que
durante la interpolación no se haya alterado el teorema de
muestreo.
Otras particularidades de la presente invención
se deducen de la siguiente descripción de un ejemplo de realización
con ayuda de los dibujos anexos.
En ellos puede verse:
Figura 1 un diagrama de bloques esquemático de
una parte del control numérico de una máquina herramienta;
Figura 2 un diagrama de bloques esquemático de
un ejemplo de realización del dispositivo conforme a la
invención;
Figura 3 una representación esquemática del
filtro FIR digital utilizado en la disposición conforme a la
invención de la figura 2.
En la figura 1 se muestra de forma esquemática
una parte del control numérico de una máquina herramienta, en el
que se utiliza una unidad de interpolación fina configurada de
acuerdo con la invención.
En el control numérico de la máquina
herramienta, para la generación de datos de la trayectoria de la
herramienta, los datos del control numérico (CN) los convierte, en
primer lugar, un interpolador 10 en una serie de valores teóricos
de posición X_{Nominal,\ INCR}, con una frecuencia de muestreo del
interpolador definida y un tiempo de muestreo del interpolador
T_{IPO}. Aquí el tiempo de muestreo del interpolador T_{IPO} se
sitúa habitualmente en el orden de magnitudes T_{IPO} = [1
ms....6 ms]. Los valores teóricos de posición X_{nominal} se
envían, después de su procesamiento -que se describe a
continuación-, como magnitudes de guía X_{Nominal},
V_{Feedforward} y A_{Feedforward} a unos circuitos reguladores
50, 60 en la forma de un regulador de posición y un regulador de
velocidad. Aquí los circuitos reguladores 50, 60 presentan tiempos
de muestreo T_{Ctrl} claramente menores en el orden de magnitudes
T_{Ctrl} = [100 \mus....800 \mus]. A través de los circuitos
reguladores 50, 60 se efectúa finalmente en el presente ejemplo, de
forma conocida, el control del movimiento a lo largo de la
trayectoria deseada, sobre la base de las magnitudes de guía
enviadas.
Antes de la entrega de los datos CN al
interpolador 10 tiene lugar, entre otros procesos, un tratamiento
previo de los datos CN en el sentido de calcular un recorrido de
velocidad de la trayectoria teniendo en cuenta diferentes
condiciones marginales. Para evitar en este sentido, en particular,
una sobrecarga dinámica del sistema de propulsión, se garantiza,
durante el procesamiento previo de los datos CN, que las magnitudes
de guía no superen los límites físicos del sistema de propulsión.
De aquí resulta, en último término, una limitación del espectro del
perfil de velocidad por tener lugar, en puntos críticos del
recorrido del movimiento, una extensión temporal del recorrido del
movimiento. En relación con los procedimientos apropiados en este
sentido, remitimos en este punto al Capítulo 7 (págs. 60 - 108) de
la tesis doctoral de M. Fauser, Steuerungstechnische MaBnahmen
für die Hochgeschwindigkeits-Bearbeitung
[Medidas técnicas de control para el procesamiento a alta
velocidad], Editorial Shaker, Aquisgrán, 1997.
En el transcurso de la presente descripción se
tratará en mayor detalle la importancia de esta medida. A
continuación los valores teóricos de posición X_{Nominal,\ INCR},
producidos por el interpolador 10, son filtrados digitalmente por
medio de un filtro 20 de valor teórico de posición, configurado como
filtro FIR, para garantizar que las magnitudes de guía enviadas a
los circuitos reguladores 50, 60 no presentan ya componentes de
frecuencia que en su caso podrían activar resonancias de la
máquina. El filtro digital 20 utilizado en este punto actúa como
filtro de paso bajo, que deja pasar componentes de frecuencia hasta
una frecuencia límite f_{G} y bloquea componentes de frecuencia a
partir de la frecuencia límite f_{G}. La frecuencia límite del
filtro f_{G} se establece por lo general en unos valores menores
que la frecuencia de resonancia f_{Res} de la máquina
herramienta, f_{G} = f_{Res}. En relación con el filtro 20 de
valores teóricos de posición remitimos a la patente WO 01/18622, ya
mencionada.
A continuación los valores teóricos de posición
filtrados X_{Nominal,\ INCR} se procesan con ayuda de la unidad
de interpolación fina 30, para lo cual básicamente se efectúa, a
través de la unidad de interpolación fina 30 y en la retícula de
tiempo de los circuitos reguladores 50, 60, la generación de
magnitudes de guía X_{Nominal}, V_{Feedforward} y
A_{Feedforward} para los circuitos reguladores 50, 60
posconectados, esto es, la generación de magnitudes de guía se
efectúa con la frecuencia de muestreo del circuito regulador. Como
magnitudes de guía se mencionan aquí los valores teóricos
X_{Nominal} para el circuito regulador 50 posconectado, así como
los valores de control previo V_{Feedforward} y A_{Feedforward}
para el circuito regulador de posición 50 y el circuito regulador
de revoluciones 60. En consecuencia, la unidad de interpolación
fina 30 configurada según la invención cumple la función de adaptar
la frecuencia de muestreo baja del interpolador 10 a la frecuencia
de muestreo más elevada de los circuitos reguladores 50, 60; en lo
sucesivo la relación entre frecuencia de muestreo del interpolador
y frecuencia de muestreo del circuito regulador se denomina aquí
factor de interpolación. Habitualmente ocurre aquí que la frecuencia
de muestreo del interpolador se incrementa con el factor de
interpolación IF hasta llegar a la frecuencia de muestreo del
circuito regulador. Los factores de interpolación IF típicos se
sitúan, por ejemplo, en el ámbito de IF = [2...60].
La frecuencia de muestreo del interpolador se
establece en un valor no tan alto como el de la frecuencia de
muestreo del circuito regulador porque, como se conoce por la
patente WO 01/18622 de la solicitante, la elección de la frecuencia
de muestreo del interpolador, teniendo en cuenta la frecuencia de
resonancia f_{Res}, o dependiendo de la misma, permite una
construcción más sencilla del filtro FIR 20. En frecuencias de
resonancia habituales en el ámbito de
f_{Res} = [20 Hz ... 100 Hz] resultan los tiempos de muestreo del interpolador típicos, anteriormente indicados, de T_{IPO} = [1 msec ... 6 msec].
f_{Res} = [20 Hz ... 100 Hz] resultan los tiempos de muestreo del interpolador típicos, anteriormente indicados, de T_{IPO} = [1 msec ... 6 msec].
En relación con la configuración concreta,
conforme a la invención, de la unidad de interpolación fina 30
remitimos a la siguiente descripción de las figuras 2 y 3.
En el ejemplo de la figura 1 se dispone además,
entre la unidad de interpolación fina 30 y los circuitos reguladores
50, 60, otra unidad de sincronización 40. El objetivo de la unidad
de sincronización 40 consiste aquí en la sincronización temporal de
las diferentes magnitudes generadas X_{Nominal},
V_{Feedforward}, A_{Feedforward} para diferentes ejes de la
máquina. Una sincronización de este tipo resulta necesaria en una
máquina herramienta de varios ejes pues las magnitudes de guía
enviadas por la unidad de interpolación fina X_{Nominal},
V_{Feedforward}, A_{Feedforward} se refieren a un momento
diferente del momento en que se las necesita en los circuitos
reguladores 50, 60 posconectados; en particular si, por ejemplo, la
regulación de ejes diferentes tiene lugar de forma secuencial. Por
ello se deberá conseguir, a través de la unidad de sincronización
30, un retardo apropiado de las magnitudes de guía X_{Nominal},
V_{Feedforward}, A_{Feedforward}, enviadas a los circuitos
reguladores, para los diferentes ejes.
La estructura fundamental de un ejemplo de
realización de la unidad de interpolación fina 30 está representada
esquemáticamente en la figura 2. Aquí la unidad de interpolación
fina 30 está construida preferiblemente en un procesador de señal
digital (DSP), cuya arquitectura está optimizada para el cálculo de
filtros digitales. Como alternativa en este sentido cabe también su
construcción en una CPU.
En el ejemplo representado la unidad de
interpolación fina 30 presenta dos canales de procesamiento en los
que se generan las magnitudes de guía X_{Nominal},
V_{Feedforward} en relación con la posición y la velocidad para
los circuitos reguladores de posición y de velocidad posconectados.
Del canal de procesamiento destinado a la generación de la magnitud
de guía V_{Nominal}, referida a la velocidad, se deriva además,
mediante diferenciación a través del elemento diferenciador 32, la
magnitud de guía A_{Feedforward}, referida a la aceleración.
Conviene destacar en este punto que, como alternativa en este punto,
sería posible construir la unidad de interpolación fina 30 sólo en
un canal, y derivar las magnitudes de guía V_{Feedforward},
A_{Feedforward}, en relación con la velocidad y la aceleración,
mediante una diferenciación, una o dos veces, a partir de los
valores teóricos de posición X_{Nominal}.
A excepción del elemento diferenciador 31 los
dos canales de procesamiento de la unidad de interpolación fina 30
presentan una estructura en principio idéntica, que se explica a
continuación. Así, cada uno de los dos canales de procesamiento de
la unidad de interpolación fina 30 presenta un transductor de
frecuencias de muestreo 33.1, 33.2, así como un filtro digital
34.1, 34.2 posconectado. Con ayuda del transductor de frecuencias de
muestreo 33.1, 33.2, así como del filtro digital 34.1, 34.2 se
produce la adaptación, antes mencionada, de la frecuencia de
muestreo baja del interpolador a la frecuencia de muestreo del
circuito regulador, claramente superior.
A través del transductor de frecuencias de
muestreo 33.1, 33.2 la frecuencia de muestreo de los valores
teóricos del lado de la entrada se incrementa en primer lugar desde
la frecuencia de muestreo del interpolador hasta la frecuencia de
muestreo del circuito regulador. Para ello el transductor de
frecuencias de muestreo 33.1, 33.2 introduce en la retícula de
tiempo de los valores teóricos del lado de la entrada valores
intermedios con el valor cero en la retícula de tiempo de la
frecuencia de muestreo del circuito regulador. En consecuencia, en
la salida del transductor de frecuencias de muestreo 33.1, 33.2, en
cada uno de los dos canales de procesamiento, se encuentra una
señal con la frecuencia de muestreo deseada o necesaria del circuito
regulador posconectado, que seguidamente se conduce al filtro
digital respectivo 34.1, 34.2 para el para el aplanamiento o la
eliminación de componentes de frecuencia no deseados.
El filtro digital 34.1, 34.2 está configurado a
su vez como filtro FIR, al que corresponden diferentes conjuntos de
coeficientes de filtro. Por ejemplo, los diferentes conjuntos de
coeficientes de filtro pueden estar guardados en una unidad de
memoria correspondiente al filtro FIR. En el filtro FIR tiene lugar
a partir de ahora un cálculo de varios valores de salida para una
serie determinada de valores de entrada al filtrarse la serie en
cuestión de valores de entrada utilizando los diferentes conjuntos
de coeficientes de filtro.
En la salida del filtro FIR 34.1, 34.2 se
encuentran las diferentes señales deseadas con las frecuencias de
muestreo aumentadas, esto es, con las frecuencias de muestreo del
circuito regulador, que finalmente se envían como valor teórico o
como magnitudes de guía X_{Nominal}, V_{Feedforward},
A_{Feedforward} a los correspondientes circuitos reguladores
posconectados.
Debido a la configuración conforme a la
invención de la unidad de interpolación fina 30 se obtiene, además
de una cualidad excelente de la trayectoria generada, un esfuerzo de
cálculo solamente escaso. Ello está asegurado, en particular, por
la configuración del (de los) filtro(s) digital(es)
34.1, 34.2 como filtro FIR. De este modo resulta posible unir las
operaciones aritméticas del (de los) transductor(es) de
frecuencias de muestreo 33.1, 33.2 y del filtro FIR. Debido a la
introducción, efectuada por el transductor de frecuencias de
muestreo 33.1, 33.2, de valores intermedios con el valor cero en la
retícula de tiempo de la frecuencia de muestreo del circuito
regulador, entre los valores teóricos del lado de la entrada, el
vector de entrada del filtro FIR 34.1, 34.2 incluye muchos valores
cero. Cualquier valor cero contiguo a la entrada del filtro FIR da
lugar, en el lado del filtro FIR 34.1, 34.2, a operaciones
aritméticas cuyo valor de salida es a su vez cero. De acuerdo con
la invención esta circunstancia se aprovecha de aquí en adelante,
esto es, no será necesario efectuar las operaciones aritméticas con
el valor de entrada cero. En cambio, para una determinada serie de
valores de entrada se calculan, con ayuda de varios conjuntos de
coeficientes de filtro, varios valores de salida o valores
intermedios interpolados, donde el número de conjuntos de
coeficientes de filtro necesario para ello corresponde al factor de
interpolación IF deseado. Cada uno de los conjuntos de coeficientes
de filtro utilizados tiene la misma respuesta de amplitud; en
cambio la respuesta de fase, o el tiempo de retardo de grupo como
derivación de la respuesta de fase, varía de conjunto de coeficiente
de filtro a conjunto de coeficiente de filtro en un periodo de
muestreo de la frecuencia de muestreo del circuito regulador.
Resultan en el lado de la salida los valores intermedios en la
retícula de muestreo necesario.
Para poder efectuar este tipo de interpolación
fina en la forma de un filtrado digital se necesita el procesamiento
previo, ya mencionado anteriormente, de los datos CN en forma de
una limitación de banda de las señales que se envían al filtro de
valor teórico de posición 20 y a continuación a la unidad de
interpolación fina 30. Sólo una limitación de banda de este tipo
permite en último término el filtrado digital conforme a la
invención en la unidad de interpolación fina 30; de no ser así los
efectos de solapamiento no deseados provocados por el filtrado
distorsionarían el recorrido de la señal interpolada finamente.
Para el envío de las magnitudes de guía
X_{Nominal}, V_{Feedforward}, A_{Feedforward}, generadas por
la unidad de interpolación fina 30, a los diferentes circuitos
reguladores se deberá garantizar a partir de ahora que cada una de
las diferentes magnitudes de guía X_{Nominal}, V_{Feedforward},
A_{Feedforward} se refieren sin excepción al mismo momento o a la
misma base temporal.
Esto se consigue mediante unos elementos de
compensación 35, 36, 37 del lado de la salida en la unidad de
interpolación fina 30, que provocan un tiempo muerto determinado en
los canales de procesamiento y garantizan en último término la
misma base temporal para las magnitudes de guía X_{Nominal},
V_{Feedforward}, A_{Feedforward}.
Por lo demás los elementos de compensación de
este tipo pueden estar previstos también en una configuración de la
unidad de interpolación fina con un único canal, para garantizar que
las magnitudes de guía generadas se refieran a la misma base
temporal.
Finalmente, en la figura 3 se muestra una
representación esquemática del filtro digital 34.1, 34.2 de la
unidad de interpolación fina 30. Como se puede observar en la
figura 3, el filtro FIR utilizado se corresponde con unas
estructuras de filtro FIR habitualmente conocidas.
Además del ejemplo de realización explicado
existen, evidentemente, posibilidades alternativas de configurar la
disposición conforme a la invención.
Claims (10)
1. Disposición para la generación de magnitudes
de guía para circuitos reguladores de una máquina con control
numérico, compuesta por una unidad de interpolación (10) para la
fijación previa de valores teóricos de posición con una determinada
frecuencia de muestreo del interpolador y con una unidad de
interpolación fina (30) que está posconectada en serie a la unidad
de interpolación y genera, a partir de valores teóricos de posición
en el lado de la entrada, magnitudes de guía del lado de la salida
para uno o varios circuitos reguladores posconectados, donde la
unidad de interpolación fina genera las magnitudes de guía en la
retícula de tiempo de los circuitos reguladores con la frecuencia
de muestreo del circuito regulador, caracterizada porque la
unidad de interpolación fina (30) incluye un transductor de
frecuencias de muestreo (33.1, 33.2), así como un filtro digital de
paso bajo (34.1, 34.2) posconectado, donde el transductor de
frecuencias de muestreo (33.1, 33.2) eleva la frecuencia de
muestreo del interpolador de las señales del lado de la entrada en
una cantidad equivalente a un factor de interpolación determinado,
hasta alcanzar la frecuencia de muestreo del circuito
regulador.
2. Disposición según la reivindicación 1,
caracterizada porque el filtro digital de paso bajo (34.1,
34.2) está configurado como filtro FIR.
3. Disposición según la reivindicación 2,
caracterizada porque el filtro FIR lleva asociados
diferentes conjuntos de coeficientes de filtro.
4. Disposición según la reivindicación 1 y 3,
caracterizada porque el número de conjuntos de coeficientes
de filtro corresponde al factor de interpolación.
5. Disposición según la reivindicación 1,
caracterizada porque la frecuencia de muestreo del
interpolador (T_{IPO}) se elige dependiendo de una frecuencia de
resonancia específica de la máquina.
6. Disposición según la reivindicación 1,
caracterizada porque la señal conducida hacia la unidad de
interpolación (20) tiene una banda limitada.
7. Disposición según la reivindicación 1,
caracterizada porque la unidad de interpolación fina (30)
está configurada en un procesador de señal digital o en una CPU.
8. Disposición según la reivindicación 1,
caracterizada porque la unidad de interpolación fina (30)
incluye al menos dos canales de procesamiento paralelos, en los
cuales se pueden generar magnitudes de guía diferentes
(X_{Nominal}, V_{Feedforward}, A_{Feedforward}) para la
posición y la velocidad, que a su vez pueden ser procesadas por
unos circuitos reguladores de posición y velocidad (50, 60)
posconectados, y donde cada uno de los canales de procesamiento
incluye un transductor de frecuencias de muestreo (33.1, 33.2) así
como un filtro de paso bajo digital (34.1, 34.2) posconectado.
9. Disposición según la reivindicación 1 u 8,
caracterizada porque en la unidad de interpolación fina (30)
se dispone uno o varios elementos de retardo (35, 36, 37), que
garantizan que cada una de las magnitudes de guía para la posición
y la velocidad (X_{Nominal}, V_{Feedforward},
A_{Feedforward}), enviadas al circuito regulador de posición (50)
y al circuito regulador de velocidad (60) está referida a una base
temporal definida.
10. Disposición según la reivindicación 1,
caracterizada porque, entre la unidad de interpolación fina
(30) y los circuitos reguladores (50, 60) posconectados, se dispone
además una unidad de sincronización (40) que efectúa una
sincronización temporal de las magnitudes de guía (X_{Nominal},
V_{Feedforward}, A_{Feedforward}) generadas para diferentes
ejes de la máquina.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE10139638 | 2001-08-11 | ||
DE10139638A DE10139638A1 (de) | 2001-08-11 | 2001-08-11 | Anordnung zur Erzeugung von Führungsgrößen für Regelkreise einer numerisch gesteuerten Maschine |
Publications (1)
Publication Number | Publication Date |
---|---|
ES2276746T3 true ES2276746T3 (es) | 2007-07-01 |
Family
ID=7695244
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
ES01274420T Expired - Lifetime ES2276746T3 (es) | 2001-08-11 | 2001-10-24 | Un dispositivo para la generacion de magnitudes de guia para circuitos reguladores de una maquina con control numerico. |
Country Status (6)
Country | Link |
---|---|
US (1) | US6772020B2 (es) |
EP (1) | EP1421452B1 (es) |
AT (1) | ATE349728T1 (es) |
DE (2) | DE10139638A1 (es) |
ES (1) | ES2276746T3 (es) |
WO (1) | WO2003014848A1 (es) |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7109670B1 (en) * | 2005-05-25 | 2006-09-19 | Rockwell Automation Technologies, Inc. | Motor drive with velocity-second compensation |
WO2010032284A1 (ja) * | 2008-09-16 | 2010-03-25 | 新日本工機株式会社 | 数値制御装置 |
US8060238B2 (en) * | 2009-02-19 | 2011-11-15 | Delta Electronics, Inc. | Method of calculating recovery commands for numerical controlled system |
DE102009010859B4 (de) * | 2009-02-27 | 2017-07-13 | Delta Electronics Inc. | Verfahren zum Berechnen von Aufbereitungsbefehlen für ein numerisch gesteuertes System |
DE112010002245T8 (de) * | 2009-06-03 | 2013-03-14 | Mitsubishi Electric Corp. | Numerische steuerungsvorrichtung und produktionssystem |
TWI405092B (zh) * | 2009-08-18 | 2013-08-11 | Delta Electronics Inc | 數值控制系統之路徑軌跡點計算裝置及其計算方法 |
US8244386B2 (en) * | 2009-10-08 | 2012-08-14 | Hurco Companies, Inc. | Machine tool system control having automatic safe repositioning |
US8121720B2 (en) * | 2009-10-16 | 2012-02-21 | Delta Electronics, Inc. | Tool-path calculation apparatus for numerical controlled system and method for operating the same |
DE102009044348B4 (de) | 2009-10-28 | 2017-03-23 | Delta Electronics, Inc. | Werkzeugbahnberechnungsvorrichtung für numerisch gesteuertes System und Verfahren zum Betreiben desselben |
DE102013202408B4 (de) | 2013-02-14 | 2023-09-14 | Dr. Johannes Heidenhain Gmbh | Verfahren zur Parametrierung einer Dämpfung von Ratterschwingungen im Regelkreis einer Numerischen Steuerung |
JP5642214B2 (ja) * | 2013-02-15 | 2014-12-17 | 株式会社神戸製鋼所 | 多関節ロボットの弾性変形補償制御装置 |
JP5897644B2 (ja) * | 2014-06-02 | 2016-03-30 | 株式会社神戸製鋼所 | ロボットの制御装置 |
DE102016214228A1 (de) * | 2016-08-02 | 2018-02-08 | Dr. Johannes Heidenhain Gmbh | Verfahren und Vorrichtung zum Steuern einer Fräsmaschine |
JP6496340B2 (ja) * | 2017-03-17 | 2019-04-03 | ファナック株式会社 | スキャナ制御装置、ロボット制御装置及びリモートレーザ溶接ロボットシステム |
WO2019119268A1 (zh) * | 2017-12-19 | 2019-06-27 | 深圳配天智能技术研究院有限公司 | 数控***、具有存储功能的装置及nurbs曲线插补方法 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4398228A (en) * | 1981-04-28 | 1983-08-09 | Iomega Corporation | Method of avoiding resonance in servo controlled apparatus |
JPS59168513A (ja) * | 1983-03-16 | 1984-09-22 | Fanuc Ltd | 加減速制御方式 |
US4772831A (en) * | 1986-11-20 | 1988-09-20 | Unimation, Inc. | Multiaxis robot control having improved continuous path operation |
DE3640987C1 (de) | 1986-12-01 | 1993-04-29 | Agie Ag Ind Elektronik | Numerisches Steuersystem fuer hochdynamische Prozesse |
DE3789493D1 (de) * | 1986-12-01 | 1994-05-05 | Agie Ag Ind Elektronik | Numerisches Steuersystem für hochdynamische Prozesse. |
JPH06180606A (ja) * | 1992-12-11 | 1994-06-28 | Mitsubishi Electric Corp | 駆動対象物の制御装置 |
DE4303090B4 (de) * | 1993-02-04 | 2006-11-23 | Robert Bosch Gmbh | Verfahren zur Erzeugung von Führungsgrößen für Lageregelkreise in numerisch gesteuerten Maschinen |
US5434489A (en) * | 1993-07-30 | 1995-07-18 | Fanuc Robotics North America, Inc. | Method and system for path planning in cartesian space |
US5901010A (en) * | 1997-02-07 | 1999-05-04 | Cirrus Logic, Inc. | Magnetic disc recording system employing two stage actuators for simultaneous accesses through multiple recording heads |
DE19710268A1 (de) * | 1997-03-13 | 1998-09-24 | Heidenhain Gmbh Dr Johannes | Verfahren zur Bearbeitung eines Werkstücks mit maximaler Bearbeitungsgeschwindigkeit |
JP3235535B2 (ja) * | 1997-09-26 | 2001-12-04 | 松下電器産業株式会社 | ロボット制御装置とその制御方法 |
JPH11149306A (ja) | 1997-11-14 | 1999-06-02 | Fanuc Ltd | 加工機の制御装置 |
EP1226476B1 (de) * | 1999-09-08 | 2004-04-07 | Dr. Johannes Heidenhain GmbH | Verfahren und schaltungsanordnung zur erzeugung von lagesollwerten für einen lageregelkreis einer numerisch bahngesteuerten maschine |
-
2001
- 2001-08-11 DE DE10139638A patent/DE10139638A1/de not_active Withdrawn
- 2001-10-24 EP EP01274420A patent/EP1421452B1/de not_active Expired - Lifetime
- 2001-10-24 WO PCT/EP2001/012270 patent/WO2003014848A1/de active IP Right Grant
- 2001-10-24 DE DE50111755T patent/DE50111755D1/de not_active Expired - Lifetime
- 2001-10-24 ES ES01274420T patent/ES2276746T3/es not_active Expired - Lifetime
- 2001-10-24 AT AT01274420T patent/ATE349728T1/de not_active IP Right Cessation
-
2002
- 2002-01-04 US US10/038,051 patent/US6772020B2/en not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
EP1421452B1 (de) | 2006-12-27 |
DE50111755D1 (de) | 2007-02-08 |
DE10139638A1 (de) | 2003-02-20 |
WO2003014848A1 (de) | 2003-02-20 |
ATE349728T1 (de) | 2007-01-15 |
EP1421452A1 (de) | 2004-05-26 |
US6772020B2 (en) | 2004-08-03 |
US20030033029A1 (en) | 2003-02-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
ES2276746T3 (es) | Un dispositivo para la generacion de magnitudes de guia para circuitos reguladores de una maquina con control numerico. | |
US6774598B1 (en) | Method and circuitry for producing nominal position values for a closed loop position control of a numerically continuous-path controlled machine | |
US9525378B2 (en) | Motor control device | |
US7106537B1 (en) | Disk drive using a timer to arbitrate periodic serial communication with a power driver | |
US9231562B2 (en) | Decimation filter | |
Mohamed et al. | Vibration control of a single-link flexible manipulator using command shaping techniques | |
US7911172B2 (en) | Machine position control device | |
ES2347500T3 (es) | Procedimiento de regulacion y dispositivo de regulacion con retroalimentacion multicanal. | |
JP2011501293A (ja) | 運動制御システムにおいて終了条件を満たす方法およびシステム | |
SE447608B (sv) | Forfarande och anordning for instellning av en digital regulator | |
US9798295B2 (en) | Motor controller having a function of suppressing vibrations | |
ES2662537T3 (es) | Estructura de controlador para amortiguar vibraciones de baja frecuencia | |
Park et al. | Design and sensitivity analysis of an input shaping filter in the z-plane | |
AU613401B2 (en) | Advanced pid controller | |
WO2003079532A2 (en) | Shaping and smooth baseline function command generator | |
JP2014155982A (ja) | 多関節ロボットの弾性変形補償制御装置 | |
US20050200327A1 (en) | Motor control device | |
JP2007185014A (ja) | モータ制御装置の制御パラメータ算出方法、算出プログラムおよびモータ制御装置 | |
JP2002325473A (ja) | 振動抑制装置 | |
JP2017146973A (ja) | マイクロマシニング技術によるアクチュエータを、特にマイクロミラーのマイクロマシニング技術によるアクチュエータを、制御するコントローラ、制御システム、マイクロミラーシステム、及び、マイクロマシニング技術によるアクチュエータの制御方法 | |
JP3586110B2 (ja) | 軌跡制御装置 | |
KR100505050B1 (ko) | 위치결정 모듈의 직선보간 장치 | |
JP5839022B2 (ja) | デジタルフィルタ | |
CN110380661B (zh) | 马达控制***及其方法 | |
TWI656417B (zh) | 馬達控制系統及其方法 |