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 PDF

Info

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
Application number
ES01274420T
Other languages
English (en)
Inventor
Frieder Kohler
Matthias Fauser
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Dr Johannes Heidenhain GmbH
Original Assignee
Dr Johannes Heidenhain GmbH
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Dr Johannes Heidenhain GmbH filed Critical Dr Johannes Heidenhain GmbH
Application granted granted Critical
Publication of ES2276746T3 publication Critical patent/ES2276746T3/es
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/41Numerical 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/4103Digital interpolation
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/416Numerical 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/34Director, elements to supervisory
    • G05B2219/34104Postprocessor coarse fine
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/34Director, elements to supervisory
    • G05B2219/34119Function generator, filter after interpolator to control position error
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/34Director, elements to supervisory
    • G05B2219/34167Coarse fine, macro microinterpolation, preprocessor
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41151Finite 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].
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.
ES01274420T 2001-08-11 2001-10-24 Un dispositivo para la generacion de magnitudes de guia para circuitos reguladores de una maquina con control numerico. Expired - Lifetime ES2276746T3 (es)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

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) 馬達控制系統及其方法