ES2347899T3 - Optimizacion de la respuesta frecuencial de un simulador de movimiento mediante seguimiento adaptativo de consignas sinusoidales. - Google Patents
Optimizacion de la respuesta frecuencial de un simulador de movimiento mediante seguimiento adaptativo de consignas sinusoidales. Download PDFInfo
- Publication number
- ES2347899T3 ES2347899T3 ES08300040T ES08300040T ES2347899T3 ES 2347899 T3 ES2347899 T3 ES 2347899T3 ES 08300040 T ES08300040 T ES 08300040T ES 08300040 T ES08300040 T ES 08300040T ES 2347899 T3 ES2347899 T3 ES 2347899T3
- Authority
- ES
- Spain
- Prior art keywords
- setpoint
- corrector
- input
- transfer function
- signal
- 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.)
- Active
Links
- 230000033001 locomotion Effects 0.000 title claims abstract description 63
- 230000003044 adaptive effect Effects 0.000 title claims description 11
- 238000005457 optimization Methods 0.000 title 1
- 238000012546 transfer Methods 0.000 claims abstract description 44
- 238000000034 method Methods 0.000 claims abstract description 21
- 230000010349 pulsation Effects 0.000 claims abstract description 7
- 230000003750 conditioning effect Effects 0.000 claims description 36
- 230000001133 acceleration Effects 0.000 claims description 13
- 238000001914 filtration Methods 0.000 claims description 7
- 238000004590 computer program Methods 0.000 claims description 2
- 238000004088 simulation Methods 0.000 claims description 2
- 230000001143 conditioned effect Effects 0.000 description 6
- 238000005259 measurement Methods 0.000 description 5
- 239000011159 matrix material Substances 0.000 description 4
- 238000012544 monitoring process Methods 0.000 description 4
- 230000003068 static effect Effects 0.000 description 3
- 238000012360 testing method Methods 0.000 description 3
- 230000015572 biosynthetic process Effects 0.000 description 2
- 238000003786 synthesis reaction Methods 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 230000003042 antagnostic effect Effects 0.000 description 1
- 230000002238 attenuated effect Effects 0.000 description 1
- 230000033228 biological regulation Effects 0.000 description 1
- 238000012512 characterization method Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000010363 phase shift Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
- 238000011144 upstream manufacturing Methods 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
- G05B17/00—Systems involving the use of models or simulators of said systems
- G05B17/02—Systems involving the use of models or simulators of said systems electric
-
- 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Artificial Intelligence (AREA)
- Health & Medical Sciences (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Feedback Control In General (AREA)
- Control Of Electric Motors In General (AREA)
- Measurement Of Mechanical Vibrations Or Ultrasonic Waves (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
Dispositivo de condicionado con retroacción de un simulador de movimiento (10) que permite un seguimiento efectivo por el simulador de una consigna, estando modelizado dicho simulador de movimiento, entre su entrada constituida por una señal de mando u(t) y su salida constituida por una magnitud medida y(t) entre su velocidad, su posición o su aceleración, por una función de transferencia B(z -1)/A(z -1), comprendiendo dicho dispositivo de condicionado un corrector (20) sintetizado a partir de dicha modelización del simulador de movimiento y que equivale a un corrector RST, comprendiendo dicho corrector una entrada de consigna, una entrada de retroacción a la que se aplica dicha magnitud medida y(t) y una salida que produce dicha señal de mando u(t), siendo entonces la función de transferencia entre la entrada de consigna del corrector y la magnitud medida H(z -1)/W(z -1), caracterizado porque comprende además un filtro de consigna (30) que toma en la entrada la consigna que es una señal de consigna sinusoidal c(t) que presenta una pulsación wc y que aplica en la salida una señal de consigna filtrada c'(t) a la entrada de consigna de dicho corrector (20); presentando dicho filtro de consigna una función de transferencia Rr(z -1)/Fr(z -1), y siendo adaptativo, y porque dicho numerador Rr(z -1) de la función de transferencia es tal que la - 1-1-1-1 expresión Fr(z )W(z)-Rr(z )H(z ) se factoriza en la forma: **(Ver fórmula)** y porque dicho numerador Rr(z -1) de la función de transferencia es la solución de una ecuación denominada de Bezout: **(Ver fórmula)** para la pulsación wc de la señal de consigna, y porque comprende un medio para determinar Rr(z -1) adecuado para resolver en línea la ecuación de Bezout en función del parámetro que constituye la pulsación wc de dicha señal de consigna.
Description
La invención pertenece al campo de los simuladores de movimiento condicionados en posición, en velocidad o en aceleración.
Los simuladores de movimiento se utilizan, entre otras cosas, para someter a prueba las características en función de la frecuencia de un componente colocado sobre la plataforma de un simulador de movimiento adecuado para generar movimientos tales como movimientos de rotación instantánea alrededor de un eje. Una categoría de movimientos particularmente interesante para llevar a cabo pruebas está constituida por movimientos tales que la posición, la velocidad o la aceleración angular del eje sea una función sinusoidal caracterizada por una amplitud y una pulsación. Se aplica por tanto una
j·w·t
señal de consigna con la forma Ae(adoptando una notación compleja) y se procede a las mediciones características en el sensor que va a someterse a prueba. Sin embargo, esta prueba sólo tiene valor si el simulador de movimiento presenta efectivamente un movimiento que sigue la señal de consigna. Se intenta por tanto que el movimiento real del simulador de movimiento sea lo más fiel posible con respecto a la consigna. Por cierto, la palabra componente define en este caso cualquier componente inercial o cualquier tipo de sensor que mida una posición, una velocidad o una aceleración.
Unos sistemas de condicionado para simulador de movimiento son conocidos por la solicitud de patente WO2006/161664A o el artículo “Implementation of RST controllers for a flexible servo considering practical limitations” de CHAMPENOIS G. y AP. en Industrial Automation and Control, 1995, pág. 209-213 ISBN 0-7803-2081-6.
La estructura del bucle de condicionado en posición (en velocidad o en aceleración) de un simulador de movimiento es generalmente conforme al esquema representado en la figura 1. El sistema físico que se debe condicionar 10 está constituido por un amplificador de corriente 11, por un motor 12 de corriente continua o de corriente alterna (por ejemplo, motor de corriente alterna sin escobillas: “AC brushless”), por el eje 13 de la máquina y por un sensor 14. El amplificador de corriente 11 recibe, por ejemplo, una orden en forma de una tensión u(t) y aplica en consecuencia la intensidad i(t) correspondiente a los bornes del motor eléctrico 12. Al estar el eje 13 del simulador de movimiento acoplado al rotor del motor eléctrico 12, la circulación de una corriente i(t) adaptada en el estator pone en rotación el eje 13 alrededor de su eje de simetría. El sensor 14 mide una magnitud cinemática instantánea y(t) relativa al movimiento del eje 13 del simulador de movimiento. Esta magnitud medida y(t) puede ser o bien la posición del eje o bien la velocidad de éste, o bien incluso la aceleración de éste (magnitud medida angular o lineal).
El bucle de condicionado consiste en una ley de mando 20 que, a partir de las entradas constituidas a la vez por la señal de consigna c(t) y la magnitud medida y(t), determina el valor del de la orden u(t) que va a aplicarse al sistema condicionado 10. Esta ley de mando se establece mediante un algoritmo de síntesis a partir de una modelización física del comportamiento del sistema que se debe condicionar.
El bucle de condicionado cerrado presentado en la figura 1 presenta la particularidad de presentar un comportamiento “de paso bajo” entre la consigna c(t) y la medición y(t). Lo que significa que la calidad del seguimiento de una consigna sinusoidal depende de la frecuencia de esta consigna. Para las bajas frecuencias (por ejemplo, del orden del hercio), no existe ninguna dificultad particular para garantizar un seguimiento de la consigna sin que aparezca un error significativo, denominado de “arrastre”, entre la consigna c(t) y la magnitud medida y(t), por ejemplo la posición. En cambio, cuanto más aumenta la frecuencia de la consigna sinusoidal, más importante se vuelve el error de arrastre. Para estas frecuencias elevadas, la posición del eje sigue también un movimiento sinusoidal pero con una cierta atenuación de la amplitud que es cada vez más marcada a medida que la frecuencia aumenta. Se define la frecuencia de corte del condicionado como la frecuencia para la que la amplitud de la consigna experimenta una atenuación de ± 3 dB.
Es deseable que la frecuencia de corte, que es un indicador de las prestaciones del condicionado, sea la más alta posible. No obstante, el valor máximo de la frecuencia de corte se limita a causa de las dinámicas de alta frecuencia que no pueden tenerse en cuenta en la modelización de la máquina condicionada, modelización base de la síntesis del condicionado. Estas dinámicas de altas frecuencias sobre la modelización se deben, por ejemplo, a la dinámica eléctrica del motor o, incluso, a las resonancias de la estructura mecánica.
Por otro lado, para que el bucle de condicionado sea estable sea cual sea el movimiento que se desee dar al simulador de movimiento, es necesario concebir un condicionado denominado robusto con respecto a estas dinámicas de alta frecuencia. A título indicativo, la propiedad de robustez de un condicionado garantiza la estabilidad del bucle de condicionado cuando el sistema que se va a controlar se aleja del modelo nominal. Ahora bien, desde un punto de vista teórico, se muestra que la robustez y las prestaciones son dos nociones antagonistas. Es decir, la robustez necesaria en el bucle de condicionado genera unas limitaciones en las prestaciones de este condicionado, y en particular disminuye la frecuencia de corte de este condicionado. Todos los condicionados conocidos utilizados en los simuladores de movimiento actuales experimentan esta restricción.
Además, es necesario añadir que el movimiento sinusoidal del eje no solamente se atenúa con respecto a la señal de consigna sino que también se desfasa con respecto a ésta. Este desfase aumenta notablemente a medida que aumenta la frecuencia. El desfase comienza a ser significativo a frecuencias muy inferiores a la frecuencia de corte del condicionado.
Al ser los simuladores de movimientos unas máquinas con vocación metrológica, esta atenuación y este desfase generan grandes dificultades para una caracterización precisa de los componentes que van a someterse a prueba.
La invención tiene por tanto como objetivo responder a los inconvenientes mencionados anteriormente eliminando o por lo menos reduciendo en gran medida cualquier atenuación y cualquier desfase de la magnitud medida (posición, velocidad o aceleración) con respecto a la consigna sinusoidal.
Para ello, la invención se refiere a un dispositivo de condicionado de un simulador de movimiento, estando modelizado dicho simulador de movimiento, entre su entrada constituida por una señal de mando u(t) y su salida constituida por una magnitud medida y(t) (posición, velocidad o aceleración del eje), por una función de transferencia B(z -1)/A(z -1), comprendiendo dicho dispositivo de condicionado un corrector sintetizado a partir de dicha modelización del simulador de movimiento y equivalente a un corrector RST, comprendiendo el corrector una entrada de consigna, una entrada de retroacción a la que se aplica dicha magnitud medida y(t) y una salida que produce dicha señal de mando u(t), siendo entonces la función de transferencia entre la entrada de consigna del corrector y la magnitud medida H(z -1)/W(z -1). Según la invención, el dispositivo de retroacción se caracteriza porque comprende un filtro de consigna que toma en la entrada una señal de consigna sinusoidal c(t) que presenta una pulsación wc y que aplica en la salida una señal de consigna filtrada c’(t) a la entrada de consigna de dicho corrector (20); presentando dicho filtro de consigna una función de transferencia Rr(z -1)/Fr(z -1) cuyo denominador Fr(z -1) y numerador Rr(z -1) se determinan con objeto de garantizar, a la pulsación wc, un seguimiento efectivo por el simulador de movimiento de la consigna sinusoidal.
En un modo de realización, el numerador Rr(z -1) de la función de transferencia es
-1-1-1 -1
tal que la expresión Fr(z ) W(z )-Rr(z )H(z ) se factoriza en la forma:
y porque dicho numerador Rr(z -1) de la función de transferencia es la solución de una ecuación denominada de Bezout:
para la pulsación wc de la señal de consigna.
10 Preferentemente, el dispositivo comprende un medio para determinar Rr(z -1) adecuado para resolver en línea la ecuación de Bezout en función del parámetro que constituye la pulsación wc de dicha señal de consigna, de modo que dicho dispositivo de condicionado permite un seguimiento adaptativo de dicha consigna sinusoidal. Según otro modo de realización, el dispositivo comprende:
15 -un medio de simulación del conjunto formado por el corrector y por el sistema físico, que produce una magnitud medida ideal ym(t) y que presenta como función de transferencia H(z -1)/W(z -1);
-un medio de estimación de la atenuación y del desfase residuales adecuado para determinar, a partir de la magnitud medida real y(t) y de la magnitud medida ideal 20 ym(t), los valores de la atenuación residual At y del desfase residual ϕ, entre el
movimiento real del simulador de movimiento y la magnitud medida ideal ym(t);
-un medio de determinación de Rr(z -1) adecuado para calcular, a la pulsación wc de la señal de consigna, dicho numerador Rr (z -1) de la función de transferencia del filtro de consigna, en función de la atenuación y del desfase residuales
25 determinados por dicho medio de estimación, por resolución en línea del sistema de ecuación:
Preferentemente, el medio de estimación de la atenuación y del desfase residuales se basa en un algoritmo de identificación recursivo, por ejemplo un algoritmo de los mínimos cuadrados.
Preferentemente también, el medio de determinación de Rr(z -1) toma asimismo como parámetro de entrada el valor de la pulsación de dicha señal de consigna, de modo que dicho dispositivo de condicionado presenta la función de seguimiento adaptativo de la consigna sinusoidal.
Ventajosamente, el dispositivo comprende un medio de estimación de la pulsación adecuado para determinar el valor de la pulsación de la consigna aplicado en la entrada de dicho filtro de consigna.
Preferentemente, el medio de estimación de la pulsación se basa en un algoritmo de identificación recursivo, por ejemplo un algoritmo de los mínimos cuadrados generalizados.
La invención tiene asimismo como objeto un procedimiento de condicionado de un simulador de movimiento, estando modelizado el simulador de movimiento, entre su entrada constituida por una señal de mando u(t) y su salida constituida por una magnitud medida y(t) entre su posición, su velocidad y su aceleración, por una función de transferencia B(z -1)/A(z -1), comprendiendo dicho dispositivo de condicionado un corrector sintetizado a partir de dicha modelización del simulador de movimiento y equivalente a un corrector RST, comprendiendo dicho corrector una entrada de consigna, una entrada de retroacción a la que se aplica dicha magnitud medida y(t) y una salida que produce dicha señal de mando u(t), siendo entonces la función de transferencia entre la entrada de consigna del corrector y la magnitud medida H(z -1)/W(z -1); caracterizado porque se filtra una señal de consigna sinusoidal que presenta una pulsación wc para aplicar una señal de consigna filtrada c’(t) a la entrada de consigna de dicho corrector; realizándose la etapa de filtrado de la señal de consigna con objeto de garantizar un seguimiento efectivo por el simulador de movimiento de la consigna sinusoidal.
Según un modo de realización, el filtrado se realiza según una función de
-1-1-1
transferencia Rr(z )/Fr(z ) cuyo numerador Rr(z ) se determina para que la expresión
-1-1-1-1
Fr(z )W(z )-Rr(z )H(z ) se factorice en la forma:
El numerador Rr(z -1) se determina como la solución de una ecuación denominada
de Bezout:
a la pulsación wc de la señal de consigna. Preferentemente, se determina Rr(z -1) en línea resolviendo dicha ecuación de
5 Bezout en función del parámetro que constituye la pulsación wc de dicha señal de consigna, de modo que dicho procedimiento de condicionado permite un seguimiento adaptativo de dicha consigna sinusoidal.
Según otro modo de realización:
10 -se simula el comportamiento del conjunto formado por el corrector y por el simulador de movimiento por medio de una función de transferencia H(z -1)/W(z -1) con objeto de producir una magnitud medida ideal ym(t);
-se estima la atenuación y el desfase residuales entre el movimiento real del simulador de movimiento y la magnitud medida ideal ym(t) a partir de la magnitud 15 medida real y(t) y de la magnitud medida ideal ym(t);
-se determina dicho numerador Rr(z -1) en función de la pulsación wc, de la atenuación y del desfase residuales determinados en la etapa de estimación, por resolución en línea del sistema de ecuación:
20 -se adapta el filtrado de la consigna con el valor determinado de Rr(z -1).
Preferentemente la etapa de estimación de la atenuación y del desfase residuales se basa en un algoritmo de identificación recursivo, por ejemplo un algoritmo de los 25 mínimos cuadrados.
Preferentemente también, en la etapa de determinación del numerador Rr(z -1) se
tiene en cuenta asimismo como parámetro de entrada el valor de la pulsación de dicha
señal de consigna, de modo que el procedimiento de condicionado garantiza un
seguimiento adaptativo al valor instantáneo de la consigna sinusoidal.
Ventajosamente, el procedimiento comprende una etapa inicial de estimación de la pulsación de dicha señal de consigna.
Preferentemente, la etapa de estimación de la pulsación se basa en un algoritmo de identificación recursivo, por ejemplo un algoritmo de los mínimos cuadrados generalizados.
La invención tiene asimismo como objeto un programa informático que comprende una serie de instrucciones adecuadas para ser cargadas en la memoria de un ordenador y para ser ejecutadas por el calculador de dicho ordenador. El programa según la invención permite poner en práctica el procedimiento de condicionado según la invención.
La invención se comprenderá mejor y otros objetivos, detalles, características y ventajas de la misma se pondrán de manifiesto más claramente en el transcurso de la descripción de un modo de realización particular de la invención dado únicamente a título ilustrativo y no limitativo en consigna a los dibujos adjuntos. En estos dibujos:
la figura 1 representa desde un punto de vista general un bucle cerrado de condicionado del estado de la técnica;
la figura 2 es una representación esquemática en forma de bloques funcionales del bucle de condicionado de la figura 1;
la figura 3 es una representación esquemática de puesta en práctica de un filtro de consigna para una señal de consigna dada;
la figura 4 es una representación esquemática según un modo de realización de la invención que permite seguir las evoluciones de la señal de consigna y que recoge esencialmente la figura 3 añadiéndole bloques de resolución en línea de la ecuación de Bezout; y,
la figura 5 es una representación esquemática en forma de bloques funcionales de un segundo modo de realización de la invención que permite la supresión de atenuaciones y de desfases residuales.
El esquema de bloques de un sistema en bucle se proporciona de una manera muy general mediante la figura 2. El sistema 10 que se debe condicionar se modeliza mediante una función de transferencia G discreta, muestreada en el periodo Te:
j·w·Te
En la ecuación (1), z = erepresenta el operador “avance de un periodo de muestreo”. El corrector o ley de mando 20 se representa en forma RST (corrector con dos
5 grados de libertad), que es la representación más general de un corrector monovariable. Se muestra que cualquier corrector monovariable lineal puede ponerse en forma RST. En particular los correctores de tipo PID, LQG-LTR monovariable, Hinfini, Crone, etc. pueden escribirse en forma RST. La presente invención no se limita por tanto a los correctores RST. La estructura del corrector RST se representa esquemáticamente en detalle en la
10 figura 2 mediante los bloques 21 a 23. La función de transferencia entre la consigna c(t) y la medición y(t) se escribe entonces:
Esta función de transferencia es de tipo “de paso bajo” como se ha indicado en la 15 introducción, es decir que la atenuación y el desfase de la medición con respecto a la consigna aumentan a medida que aumenta la frecuencia de esta consigna.
La puesta en práctica de un filtro de consigna se describirá a continuación con
mayor detalle con respecto a la figura 3, para el que se conoce la pulsación de la consigna
sinusoidal.
20 En un primer momento, se supone que la modelización del sistema que va a controlarse se realiza perfectamente por la función de transferencia de la ecuación (1). Es decir, que la medición y(t) del sistema real que va a controlarse se comporta, para una misma entrada, exactamente como el valor de salida de la función de transferencia de la ecuación (1).
25 Según la invención, para garantizar un seguimiento de la consigna sinusoidal c(t) sin ningún error de arrastre, conociéndose la pulsación wc de esta consigna, se añade, aguas arriba del corrector 20, un filtro de consigna 30 como se representa en la figura 3. El filtro 30 toma en la entrada la consigna c(t) y produce en la salida una consigna filtrada c’(t) que se aplica como consigna en la entrada del corrector 20. El filtro de consigna 30
30 presenta una función de transferencia que se escribe: El conjunto del bucle cerrado presenta por tanto como función de transferencia la ecuación:
5 Se trata entonces de adaptar la función de transferencia del filtro 30 para garantizar un seguimiento de la consigna. Una manera de actuar consiste en definir el error de seguimiento de consigna por e(t)=c(t)-y(t). A partir de la ecuación (4) se obtiene:
Se muestra que el seguimiento de consigna se efectúa sin error de arrastre cuando
-1-1-1-1
el numerador Fr(z )W(z )-Rr (z )H(z ) de la ecuación (5) se factoriza en la forma:
Siendo Fr(z -1) el denominador del filtro de consigna 30, puede elegirse arbitrariamente siempre que se trate de un polinomio estable de grado 2. Por tanto, las dos incógnitas del problema no son sino los polinomios Rr(z -1) y Lo (z -1) que pueden obtenerse por la resolución de la ecuación:
La ecuación (6) es una ecuación polinómica denominada de Bézout, cuya
resolución es clásica en matemáticas.
En general, también es deseable que el seguimiento de consignas estáticas esté
garantizado. Asimismo se toma como polinomio D:
En este caso Fr(z -1) debe ser un polinomio estable de orden 3.
Se debe observar que lo que acaba de desarrollarse sólo es válido para consignas
sinusoidales que presentan una pulsación wc dada.
El modo de realización de la invención que se describe ahora permite el seguimiento de consigna sea cual sea la pulsación wc de la consigna sinusoidal aplicada. Para ello, el filtro de consigna se modifica para que presente un carácter adaptativo en función de la pulsación de la consigna sinusoidal efectivamente aplicada. Para ello, la ecuación (6) de Bézout se resuelve en línea mediante el algoritmo representado esquemáticamente por el bloque 31 (véase la figura 4). La resolución de la ecuación (6) se realiza en función del parámetro que constituye la pulsación wc de la consigna.
Por otro lado, la consigna c(t) de posición, de velocidad o de aceleración puede ser
o bien una consigna externa generada por el usuario del simulador de movimiento, por medio, por ejemplo, de un generador de frecuencias, o bien una consigna interna. En este último caso, se trata por tanto de una consigna interna al calculador del simulador de movimiento que se genera mediante un algoritmo específico. Aunque en el segundo caso la pulsación se conoce y puede aplicarse fácilmente en la entrada del medio de determinación de Rr(z -1), en el primer caso la pulsación de consigna no se conoce.
Para el caso de una pulsación desconocida, entonces es necesario determinar esta frecuencia estimándola por medio de un algoritmo específico. Este algoritmo, representado esquemáticamente por el bloque funcional 50 en la figura 4, es el que se describirá a continuación.
Sea s(t) una señal de consigna sinusoidal centrada en 0, muestreada en el periodo Te y de pulsación wc (en rad/s). Para dicha señal, existe una ecuación recursiva que permite relacionar s(t+1) con s(t) y s(t-1). Se muestra que esta ecuación recursiva es de la forma:
Ahora, planteando:
Puede escribirse:
O bien:
En el caso general, s(t) puede ser una consigna analógica viciada con un ruido eb(t) que se supone en este caso que es un ruido blanco. Por tanto, se obtiene:
Teniendo en cuenta (20), puede escribirse:
Con el fin de identificar sin desviaciones Θs se puede utilizarse por ejemplo, entre otros algoritmos posibles, el algoritmo de los mínimos cuadrados generalizados recursivos con:
El algoritmo de adaptación paramétrico se escribe:
en la que F es una matriz 3x3 inicializada con la matriz 3x3 siguiente:
Para más detalles con respecto a este algoritmo, es posible consultar la obra de
loan Doré Landau “Identification des systèmes” (Ed Hermes 2001).
En el sistema de ecuaciones (16), las variables λ1,λ2 son escalares y se denominan
factores de omisión. Es necesario que se presenten las condiciones 0 < λ1 ≤1y0 ≤ λ2 < 2.
Puede elegirse, por ejemplo λ1 comprendido entre 0,95 y 0,99, y λ2 que valga la unidad.
El procedimiento de condicionado según el modo de realización de la invención descrito anteriormente permite mejorar significativamente el seguimiento de las consignas sinusoidales con respecto a los procedimientos de condicionado conocidos. Sin embargo, este procedimiento es imperfecto puesto que la función de transferencia del sistema que va a controlarse B(z -1)/A(z -1) sólo es una modelización y, por tanto, una aproximación del sistema físico real que se debe condicionar. Las diferencias de comportamiento entre el modelo y el sistema real son cada vez más elevadas cuando se consideran las frecuencias crecientes. Un último modo de realización de la invención que permite un seguimiento perfecto de la consigna se describirá a continuación con mayor detalle haciendo consigna a la figura 5.
Si se limita a una aproximación lineal, la verdadera función de transferencia del
~ -1~ -1
sistema real se indica como B (z )/ A (z ) y sus coeficientes son desconocidos. Esta función de transferencia es de todas maneras de un orden más elevado que la función de transferencia de la modelización: B(z -1)/A(z -1).
En consecuencia, la función de transferencia H(z -1)/W(z -1) utilizada más arriba sólo
~ -1~ -1
es una aproximación de la función de transferencia real correspondiente H (z )/ W (z ), que también es desconocida. Las divergencias entre estas dos funciones de transferencia crecen con la frecuencia.
Al resolver la ecuación (6) de Bézout descrita anteriormente a partir de H(z -1) y de W(z -1), la expresión calculada de Rr(z -1) no permite el seguimiento perfecto de una consigna sinusoidal, y esto esencialmente a las frecuencias en las que existe divergencia
-1-1~ -1~ -1
entre H(z )/W(z )y H (z )/ W (z ), es decir a las altas frecuencias en las que aparecen de nuevo una atenuación y un desfase que se calificarán como atenuación y desfase residuales.
El procedimiento según el tercer modo de realización de la invención consiste, en
~ -1~
paralelo al bucle de condicionado del sistema real caracterizado por la función H (z )/ W (z -1), en simular el bucle de regulación ideal basado en la modelización del sistema físico y caracterizado por la función H(z -1)/W(z -1). La magnitud medida real es y(t) mientras que la magnitud medida simulada es ym(t).
Por medio de un algoritmo recursivo representado de manera esquemática por el bloque 40 de la figura 5, se identifica en línea la atenuación y el desfase entre el bucle real y el bucle simulado. At y ϕ son respectivamente la atenuación y el desfase residuales entre el modelo del bucle cerrado ideal y el bucle cerrado real.
El algoritmo de identificación recursivo se basa en el principio de que, para señales 5 sinusoidales centradas en 0, puede expresarse y(t) en función de ym(t) a partir de la relación siguiente :
Se debe obsrevar que si la señal sinusoidal no está centrada en 0, se elimina la componente continua por medio de un filtro de paso alto.
-1 -j.w.Te
10 Teniendo en cuenta el hecho de que z = ey que la frecuencia de las señales sinusoidales se conoce y vale wc, puede escribirse:
Es decir, que se obtiene:
Así, para estimar At y ϕ, basta con identificar en línea de manera recursiva α y β.
Los métodos de identificación recursivos son numerosos y puede tomarse por ejemplo el
método de los mínimos cuadrados recursivos.
Este método se expondrá a continuación, aunque, para más detalles, podrá consultarse la obra de loan Doré Landau “Identification des systèmes” (Ed Hermes 2001). Adoptando una notación matricial, se plantea ΘT =[αβ] los parámetros del modelo T ˆ T
que se deben identificar, Φ(t)=[ym(t) ym(t-1)] el vector de las observaciones, y Θ(t)= [αˆ (t) βˆ (t)] la estimación de ΘT en el instante t. El algoritmo de los mínimos cuadrados recursivos se escribe entonces:
Y se obtiene:
F(t) que es una matriz 2x2 en este caso preciso se inicializa, por ejemplo, de la manera siguiente:
En el sistema de ecuaciones (14), las variables λ1,λ2 son escalares y se denominan factores de omisión. Es necesario que se presenten las condiciones 0 < λ1 ≤ 1y0 ≤ λ2<
2. Puede elegirse, por ejemplo, λ1 comprendido entre 0,95 y 0,99, y λ2 que valga la
unidad.
En este caso el criterio J minimizado por el algoritmo es:
A continuación, tras la etapa de estimación por identificación recursiva de At y de ϕ, el polinomio Rr(z -1) se calcula en línea. Rr(z -1) se determina, en cuanto al medio de determinación 31’, de modo que garantiza el seguimiento de consignas estáticas y que, a la pulsación wc, el desfase y la atenuación residuales se compensen. Para ello, es necesario resolver, siempre en línea, el sistema de ecuaciones siguiente:
Restricción en régimen estático:
Compensación de la atenuación y del desfase residuales a la pulsación wc:
Siendo la ecuación (23) una ecuación compleja, se subdivide en dos ecuaciones (parte real y parte imaginaria). Se llega, por tanto, a tres ecuaciones que permiten hallar los tres coeficientes del polinomio Rr(z -1). El valor así calculado de Rr(z -1) sirve para adaptar la función de transferencia del filtro 30, entendiéndose que el denominador Fr(z -1)
5 puede elegirse libremente siempre que se trate de un polinomio de estabilidad de orden 3.
Ventajosamente, este último modo de realización permite un seguimiento adaptativo de la pulsación wc. Basta para ello considerar el valor de la pulsación wc que interviene en el sistema de ecuaciones que se deben resolver como un parámetro. Este parámetro wc se aplica en la entrada del medio de determinación 31’ como se representa
10 en la figura 5. Además, un medio de determinación de la pulsación 50, tal como se ha descrito anteriormente en la figura 4, puede integrarse en este último modo de realización si la pulsación wc de la consigna es un dato externo al calculador adecuado para poner en práctica el procedimiento de condicionado según la invención. La presente descripción presenta unos modos de realización particulares de
15 dispositivos y de procedimientos que permiten garantizar el seguimiento de consignas sinusoidales sin ningún error de arrastre por un simulador de movimiento. Aunque la descripción detallada se haya referido a un simulador de movimiento de rotación alrededor de un único eje, el experto en la materia comprenderá que la invención se aplica asimismo a los simuladores de movimiento que presentan varios ejes alrededor de los cuales
20 pueden generarse unos movimientos de rotación instantánea y a los simuladores de movimiento de translación a lo largo de una o de varias direcciones de desplazamiento.
Claims (11)
- Reivindicaciones1. Dispositivo de condicionado con retroacción de un simulador de movimiento(10) que permite un seguimiento efectivo por el simulador de una consigna, estando modelizado dicho simulador de movimiento, entre su entrada constituida por una señal de mando u(t) y su salida constituida por una magnitud medida y(t) entre su velocidad, su posición o su aceleración, por una función de transferencia B(z -1)/A(z -1), comprendiendo dicho dispositivo de condicionado un corrector (20) sintetizado a partir de dicha modelización del simulador de movimiento y que equivale a un corrector RST, comprendiendo dicho corrector una entrada de consigna, una entrada de retroacción a la que se aplica dicha magnitud medida y(t) y una salida que produce dicha señal de mando u(t), siendo entonces la función de transferencia entre la entrada de consigna del corrector y la magnitud medida H(z -1)/W(z -1), caracterizado porque comprende además un filtro de consigna (30) que toma en la entrada la consigna que es una señal de consigna sinusoidal c(t) que presenta una pulsación wc y que aplica en la salida una señal de consigna filtrada c’(t) a la entrada de consigna de dicho corrector (20); presentando dicho filtro de consigna una función de transferencia Rr(z -1)/Fr(z -1), y siendo adaptativo,y porque dicho numerador Rr(z -1) de la función de transferencia es tal que la-1-1-1-1expresión Fr(z )W(z)-Rr(z )H(z ) se factoriza en la forma:
imagen1 y porque dicho numerador Rr(z -1) de la función de transferencia es la solución de una ecuación denominada de Bezout:imagen1 para la pulsación wc de la señal de consigna, y porque comprende un medio para determinar Rr(z -1) adecuado para resolver en línea la ecuación de Bezout en función del parámetro que constituye la pulsación wc de dicha señal de consigna. - 2. Dispositivo de condicionado con retroacción de un simulador de movimiento(10) que permite un seguimiento efectivo por el simulador de una consigna, estando modelizado dicho simulador de movimiento, entre su entrada constituida por una señal de mando u(t) y su salida constituida por una magnitud medida y(t) entre su velocidad, suposición o su aceleración, por una función de transferencia B(z -1)/A(z -1), comprendiendo dicho dispositivo de condicionado un corrector (20) sintetizado a partir de dicha modelización del simulador de movimiento y equivalente a un corrector RST, comprendiendo dicho corrector una entrada de consigna, una entrada de retroacción a la 5 que se aplica dicha magnitud medida y(t) y una salida que produce dicha señal de mando u(t), siendo por tanto la función de transferencia entre la entrada de consigna del corrector y la magnitud medida H(z -1)/W(z -1); caracterizado porque comprende además un filtro de consigna (30) que toma en la entrada la consigna que es una señal de consigna sinusoidal c(t) que presenta una pulsación wc y que aplica en la salida una señal de consigna filtrada 10 c’(t) a la entrada de consigna de dicho corrector (20); presentando dicho filtro de consignauna función de transferencia Rr(z -1)/Fr(z -1) y siendo adaptativo, y porque comprende: -un medio de simulación del conjunto formado por el corrector y por el sistemafísico, que produce una magnitud medida ideal ym(t) y que presenta como 15 función de transferencia H(z -1)/W(z -1);-un medio de estimación de la atenuación y del desfase residuales adecuado para determinar, a partir de la magnitud medida real y(t) y de la magnitud medida ideal ym(t), los valores de la atenuación residual At y del desfase residual ϕ, entre el movimiento real y(t) del simulador de movimiento y la20 magnitud medida ideal ym(t);-un medio de determinación de Rr(z -1) adecuado para calcular en línea, a la pulsación wc de la señal de consigna, dicho numerador Rr(z -1) de la función de transferencia del filtro de consigna, en función de la atenuación y del desfase residuales determinados por dicho medio de estimación, por resolución en25 línea del sistema de ecuaciones:
imagen1 tomando el medio de determinación de Rr(z -1) también como parámetro de entrada el valor de la pulsación de dicha señal de consigna. -
- 3.
- Dispositivo de condicionado según la reivindicación 2, caracterizado porque dicho medio de estimación de la atenuación y del desfase residuales se basa en un algoritmo de identificación recursivo, por ejemplo un algoritmo de los mínimos cuadrados.
-
- 4.
- Dispositivo de condicionado según una de las reivindicaciones anteriores, caracterizado porque comprende un medio de estimación de la pulsación adecuado para determinar dicho valor de la pulsación de la consigna aplicado en la entrada de dicho filtro de consigna.
-
- 5.
- Dispositivo de condicionado según la reivindicación 4, caracterizado porque dicho medio de estimación de la pulsación se basa en un algoritmo de identificación recursivo, por ejemplo un algoritmo de los mínimos cuadrados generalizados.
-
- 6.
- Procedimiento de condicionado con retroacción de un simulador de movimiento que permite un seguimiento efectivo por el simulador de una consigna, estando modelizado dicho simulador de movimiento, entre su entrada constituida por una señal de mando u(t) y su salida constituida por una magnitud medida y(t) entre su posición, su velocidad y su aceleración, por una función de transferencia B(z -1)/A(z -1), comprendiendo dicho dispositivo de condicionado un corrector (20) sintetizado a partir de dicha modelización del simulador de movimiento y equivalente a un corrector RST, comprendiendo dicho corrector una entrada de consigna, una entrada de retroacción a la que se aplica dicha magnitud medida y(t) y una salida que produce dicha señal de mando u(t), siendo entonces la función de transferencia entre la entrada de consigna del corrector y la magnitud medida H(z -1)/W(z -1); caracterizado porque se filtra una señal de consigna sinusoidal (30) que presenta una pulsación wc para aplicar una señal de consigna filtrada c’(t) a la entrada de consigna de dicho corrector (20); siendo el filtrado de la señal de consigna adaptativo, y
porque el filtrado se realiza según una función de transferencia Rr(z -1)/Fr(z -1) cuyo-1-1-1-1-1numerador Rr(z ) se determina para que la expresión Fr(z )W(z ) -Rr(z )H(z ) se factorice en la forma:imagen1 y cuyo numerador Rr(z -1) se determina como la solución de una ecuacióndenominada de Bezout:imagen1 para la pulsación wc de la señal de consigna y porque se determina Rr(z -1) en línea resolviendo dicha ecuación de Bezout en función del parámetro que constituye la 5 pulsación wc de dicha señal de consigna. - 7. Procedimiento de condicionado con retroacción de un simulador de movimiento que permite un seguimiento efectivo por el simulador de una consigna, estando modelizado dicho simulador de movimiento, entre su entrada constituida por una10 señal de mando u(t) y su salida constituida por una magnitud medida y(t) entre su posición, su velocidad y su aceleración, por una función de transferencia B(z -1)/A(z -1), comprendiendo dicho dispositivo de condicionado un corrector (20) sintetizado a partir de dicha modelización del simulador de movimiento y equivalente a un corrector RST, comprendiendo dicho corrector una entrada de consigna, una entrada de retroacción a la15 que se aplica dicha magnitud medida y(t) y una salida que produce dicha señal de mando u(t), siendo entonces la función de transferencia entre la entrada de consigna del corrector y la magnitud medida H(z -1)/W(z -1); caracterizado porque se filtra una señal de consigna sinusoidal (30) que presenta una pulsación wc para aplicar una señal de consigna filtrada c’(t) a la entrada de consigna de dicho corrector (20); siendo el filtrado de la señal de20 consigna adaptativo, y porque: -se simula el comportamiento del conjunto formado por el corrector y por el simulador de movimiento por medio de una función de transferencia H(z -1)/W(z -1) con objeto de producir una magnitud medida ideal ym(t);25 -se estima la atenuación At y el desfase ϕ residuales entre el movimiento real y(t) del simulador de movimiento y la magnitud medida ideal ym(t) a partir de la magnitud medida real y(t) y de la magnitud medida ideal ym(t);- se determina dicho numerador Rr(z -1) en función de la pulsación wc tomada como parámetro, de la atenuación y del desfase residuales determinados en la 30 etapa de estimación, por resolución en línea del sistema de ecuación:
imagen1 imagen1 -se adapta el filtrado de la consigna con el valor determinado de Rr(z -1). - 8. Procedimiento de condicionado según la reivindicación 7, caracterizado porque5 dicha etapa de estimación de la atenuación y del desfase residuales se basa en un algoritmo de identificación recursivo, por ejemplo, un algoritmo de los mínimos cuadrados.
- 9. Procedimiento de condicionado según una de las reivindicaciones 6 a 8,caracterizado porque comprende una etapa inicial de estimación de la pulsación de dicha 10 señal de consigna.
- 10. Procedimiento de condicionado según la reivindicación 9, caracterizado porque dicha etapa de estimación de la pulsación se basa en un algoritmo de identificación recursivo, por ejemplo, un algoritmo de los mínimos cuadrados generalizados.15
- 11. Procedimiento de condicionado según una de las reivindicaciones 6 a 10, caracterizado porque se pone en práctica mediante un programa informático que comprende una serie de instrucciones adecuadas para ser cargadas en la memoria de un ordenador y para ser ejecutadas por el calculador de dicho ordenador para generar una20 señal de mando u(t) del simulador de movimiento.
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| FR0752807 | 2007-01-22 | ||
| FR0752807A FR2911699A1 (fr) | 2007-01-22 | 2007-01-22 | Optimisation de la reponse frequentielle d'un simulateur de mouvement par suivi adaptatif de consignes sinusoidales. |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| ES2347899T3 true ES2347899T3 (es) | 2010-11-22 |
Family
ID=38197899
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| ES08300040T Active ES2347899T3 (es) | 2007-01-22 | 2008-01-21 | Optimizacion de la respuesta frecuencial de un simulador de movimiento mediante seguimiento adaptativo de consignas sinusoidales. |
Country Status (6)
| Country | Link |
|---|---|
| US (1) | US8027816B2 (es) |
| EP (1) | EP1947534B1 (es) |
| AT (1) | ATE472123T1 (es) |
| DE (1) | DE602008001564D1 (es) |
| ES (1) | ES2347899T3 (es) |
| FR (1) | FR2911699A1 (es) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| FR3107367B1 (fr) * | 2020-02-14 | 2022-01-21 | Safran Electronics & Defense | Mesure de fonction de transferts dans un système mécatronique |
| US11940417B2 (en) * | 2021-02-02 | 2024-03-26 | Toyota Motor Engineering & Manufacturing North America, Inc. | Systems and methods for machine learning based flexural wave absorber |
| CN113011051B (zh) * | 2021-05-10 | 2025-08-19 | 瑞声光电科技(常州)有限公司 | 马达的非线性系统建模方法、装置、电子设备及存储介质 |
| US20230351559A1 (en) * | 2022-04-29 | 2023-11-02 | Government Of The United States Of America, As Represented By The Secretary Of Commerce | Image recovery apparatus and removing aberrations in an acquired image from imperfect imaging optics |
| CN116594295B (zh) * | 2023-04-20 | 2026-01-30 | 西南交通大学 | 一种基于Koopman算子的高速列车模型预测控制方法 |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5124626A (en) * | 1990-12-20 | 1992-06-23 | Mts Systems Corporation | Sinusoidal signal amplitude and phase control for an adaptive feedback control system |
| EP1626003A1 (en) | 2004-08-11 | 2006-02-15 | Philip Morris Products S.A. | Method and apparatus for collating rod-shaped articles |
| FR2887044B1 (fr) * | 2005-06-10 | 2007-08-10 | Wuilfert Societe Par Actions S | Dispositif de reglage automatique des asservissements d'un simulateur mecanique de mouvements et dispositif associe |
-
2007
- 2007-01-22 FR FR0752807A patent/FR2911699A1/fr not_active Withdrawn
-
2008
- 2008-01-21 ES ES08300040T patent/ES2347899T3/es active Active
- 2008-01-21 AT AT08300040T patent/ATE472123T1/de not_active IP Right Cessation
- 2008-01-21 DE DE602008001564T patent/DE602008001564D1/de active Active
- 2008-01-21 EP EP08300040A patent/EP1947534B1/fr active Active
- 2008-01-22 US US12/017,559 patent/US8027816B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| EP1947534B1 (fr) | 2010-06-23 |
| ATE472123T1 (de) | 2010-07-15 |
| US20080262806A1 (en) | 2008-10-23 |
| EP1947534A1 (fr) | 2008-07-23 |
| US8027816B2 (en) | 2011-09-27 |
| FR2911699A1 (fr) | 2008-07-25 |
| DE602008001564D1 (de) | 2010-08-05 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| ES2347899T3 (es) | Optimizacion de la respuesta frecuencial de un simulador de movimiento mediante seguimiento adaptativo de consignas sinusoidales. | |
| Phuong et al. | Disturbance observer and Kalman filter based motion control realization | |
| JP6669715B2 (ja) | 振動抑制装置 | |
| ES2601491T3 (es) | Procedimiento y dispositivo de control activo de vibraciones mecánicas mediante la aplicación de una ley de control constituida por un corrector central y por un parámetro de Youla | |
| Miermeister et al. | Auto-calibration method for overconstrained cable-driven parallel robots | |
| ES2359921T3 (es) | Dispositivo de regulación automática de los servocontroles de un simulador mecánico de movimientos y dispositivo asociado. | |
| CN108827299A (zh) | 一种基于改进四元数二阶互补滤波的飞行器姿态解算方法 | |
| BRPI0811741B1 (pt) | Robô e respectivos sistema e método de controle | |
| JP5730614B2 (ja) | トルクセンサ校正装置、校正方法、及びプログラム | |
| WO2019087357A1 (ja) | キャリブレーション装置、キャリブレーション方法および制御装置 | |
| CN113330373B (zh) | 控制装置、模型创建方法以及记录介质 | |
| US8386058B2 (en) | Method and device for robust rejection of periodic disturbances in an axis-position control loop | |
| Al-Fahoum et al. | Design of a modified Madgwick filter for quaternion-based orientation estimation using AHRS | |
| JPWO2020188650A1 (ja) | 制御装置および制御システム | |
| JP3697484B2 (ja) | 磁力支持天秤装置における動的力評価システム | |
| JPS62204109A (ja) | ロボツトア−ム姿勢測定装置 | |
| Ivoilov et al. | The tilt angle estimation in the inverted pendulum stabilization task | |
| Bonafilia et al. | Self-balancing two-wheeled robot | |
| JP3396425B2 (ja) | 振動台制御装置 | |
| Bloemers et al. | Parameter-dependent feedforward strategies for motion systems | |
| CN113383281B (zh) | 控制装置以及存储介质 | |
| Peza Solís et al. | Modeling and tip position control of a flexible link robot: Experimental results | |
| Edamana et al. | Control and estimation with threshold sensing for inertial measurement unit calibration using a piezoelectric microstage | |
| Zayane-Aissa et al. | Control of a perturbed under-actuated mechanical system | |
| Han et al. | Stabilization of pan-tilt systems using acceleration based lmi-lqr controller |