ES2657436T3 - Procedimiento y dispositivo de pilotaje de un artefacto orientable por medio de un accionador servomandado en actitud sobre una trayectoria - Google Patents
Procedimiento y dispositivo de pilotaje de un artefacto orientable por medio de un accionador servomandado en actitud sobre una trayectoria Download PDFInfo
- Publication number
- ES2657436T3 ES2657436T3 ES03815096.7T ES03815096T ES2657436T3 ES 2657436 T3 ES2657436 T3 ES 2657436T3 ES 03815096 T ES03815096 T ES 03815096T ES 2657436 T3 ES2657436 T3 ES 2657436T3
- Authority
- ES
- Spain
- Prior art keywords
- attitude
- gain
- speed
- pilot
- parameters
- 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
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000013016 damping Methods 0.000 claims abstract description 26
- 238000012546 transfer Methods 0.000 claims abstract description 16
- 238000004422 calculation algorithm Methods 0.000 claims description 13
- 238000005259 measurement Methods 0.000 claims description 13
- 238000004088 simulation Methods 0.000 claims description 8
- 238000011161 development Methods 0.000 claims description 6
- 230000004044 response Effects 0.000 claims description 4
- 238000012937 correction Methods 0.000 claims description 2
- 238000012360 testing method Methods 0.000 claims description 2
- 238000010200 validation analysis Methods 0.000 claims description 2
- 230000015572 biosynthetic process Effects 0.000 description 18
- 238000003786 synthesis reaction Methods 0.000 description 18
- 230000014509 gene expression Effects 0.000 description 15
- 230000005484 gravity Effects 0.000 description 9
- 230000008901 benefit Effects 0.000 description 6
- 230000000875 corresponding effect Effects 0.000 description 5
- 239000000243 solution Substances 0.000 description 4
- 230000002123 temporal effect Effects 0.000 description 3
- 230000002596 correlated effect Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000011084 recovery Methods 0.000 description 2
- 230000001052 transient effect Effects 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 241000380131 Ammophila arenaria Species 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000009365 direct transmission Effects 0.000 description 1
- 239000006185 dispersion Substances 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
- 238000010304 firing Methods 0.000 description 1
- 230000036039 immunity Effects 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 230000010363 phase shift Effects 0.000 description 1
- 230000010349 pulsation Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 239000002689 soil Substances 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
- 238000001308 synthesis method Methods 0.000 description 1
- 238000013518 transcription Methods 0.000 description 1
- 230000035897 transcription Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/107—Simultaneous control of position or course in three dimensions specially adapted for missiles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
Procedimiento de pilotaje en vuelo de un artefacto propulsado provisto de un accionador orientable, servomandado en actitud sobre una trayectoria y sometido a unas perturbaciones exteriores según el cual, al menos en cabeceo: - se define previamente una ley de pilotaje que incluye un término corrector del primer orden, un término de transferencia que incluye unos parámetros característicos del artefacto y unas perturbaciones exteriores (A6, K1), una ganancia en actitud (Kp) y una ganancia en velocidad de actitud (Kv); - se definen previamente unas relaciones de correlación entre la ganancia en velocidad de actitud y los parámetros del término corrector en función de la ganancia en actitud, unos parámetros del término de transferencia del artefacto y de dos términos que representan unas consignas de rapidez (wn) y de amortiguación (z) y - para al menos una fase de vuelo del artefacto, se determinan unos valores de los parámetros del término de transferencia y se elige la ganancia en actitud y los términos de rapidez y de amortiguación, se deducen de ello los parámetros del término corrector y la ganancia en velocidad y se aplica al accionador la ley de pilotaje con estos valores de los parámetros.
Description
5
10
15
20
25
30
35
40
45
50
55
60
65
DESCRIPCIÓN
Procedimiento y dispositivo de pilotaje de un artefacto orientable por medio de un accionador servomandado en actitud sobre una trayectoria
La invención se refiere a un procedimiento y a un dispositivo para el control en pilotaje de un artefacto propulsado que está provisto de medios de mando en orientación, en concreto, una lanzadera provista de toberas orientables.
Recordatorios
Para el control de vuelo de las lanzaderas, se distinguen el guiado y el pilotaje. Aproximadamente, se puede decir que:
- el guiado da las instrucciones que permiten llevar a cabo la misión (consignas de actitudes). Estas instrucciones permiten definir el movimiento del centro de gravedad de la lanzadera para que esta consiga una diana predeterminada (órbita de transferencia generalmente);
- el pilotaje sigue las instrucciones proporcionadas por el guiado estabilizando el movimiento de la lanzadera alrededor de su centro de gravedad y adaptándose a las variaciones del entorno exterior (perturbaciones tales como viento, racha, ...) e interior (dispersiones y desconocimientos sobre los parámetros de la lanzadera, ...).
Se pueden afinar las dos propuestas anteriores diciendo que: A partir del conocimiento del punto diana y de la posición corriente de la lanzadera medida por unos sensores inerciales, el guiado calcula la trayectoria que debe seguir la referencia de consigna de actitud de la lanzadera (su origen está fijado sobre el centro de gravedad de la lanzadera y uno de sus ejes da la dirección que debe seguir el eje del artefacto; las mediciones inerciales de la lanzadera proporcionan las actitudes de la lanzadera definidas en una referencia que se supone galilea elegida fija en el suelo).
Cuando la lanzadera no está sometida a ninguna perturbación y el bucle de pilotaje responde instantáneamente, el eje del artefacto coincide con uno de los ejes de la referencia de consigna.
El pilotaje es un bucle de servomando que tiene como finalidad primera estabilizar los movimientos de la lanzadera alrededor de su centro de gravedad (noción de estabilidad), tradicionalmente, ajustando la orientación del empuje. Por otra parte, el pilotaje realiza en la medida de lo posible la consigna de actitud enviada por el guiado (el pilotaje es un sistema servomandado "seguidor") y asegura una cierta inmunidad de la lanzadera de cara a las perturbaciones que es susceptible de encontrar (el pilotaje es un bucle de regulación). Para esto, la función pilotaje, a partir de las mediciones inerciales de actitudes (las mismas que las utilizadas por el guiado), determina la orientación conveniente del empuje.
Una perturbación tal como el viento perturba el vuelo de la lanzadera generando un movimiento alrededor de su centro de gravedad. En realidad, el viento también genera un movimiento de conjunto de la lanzadera (movimiento en traslación o deriva). Como el guiado tiene en cuenta el punto corriente de la lanzadera (con la ayuda de las mediciones inerciales) para establecer una nueva trayectoria hasta el punto diana, no es erróneo considerar únicamente los movimientos alrededor del centro de gravedad para el establecimiento de las prestaciones de la función de pilotaje.
La función pilotaje debe tener en cuenta ciertas particularidades de las cuales el hecho, en concreto, de que por naturaleza, la lanzadera es un sistema no estacionario. Sus características físicas (posición del centro de gravedad, masa, inercia) y aerodinámicas evolucionan en función del vuelo. Unas fases transitorias van a llegar a interactuar con la función pilotaje, de entre las cuales la separación de nivel, la presencia de perturbaciones externas (viento) e internas (descentrado del empuje, por ejemplo). Finalmente, como cualquier sistema físico, los parámetros de la lanzadera están afectados por indeterminaciones.
La función pilotaje se establece a partir de un cuaderno de cargas que tiene en cuenta explícitamente los elementos anteriores. Este cuaderno de cargas es tradicionalmente el siguiente:
- Estabilizar la lanzadera.
- Recuperar la lanzadera y minimizar la incidencia a en fase de vuelo atmosférico (véase figura 1).
- Seguir la consigna de actitud generada por el guiado.
- Rechazar las perturbaciones externas e internas.
- Tener en cuenta las prestaciones del servo-timón.
5
10
15
20
25
30
35
40
45
50
55
60
65
El algoritmo de pilotaje está integrado generalmente en forma de ecuaciones recurrentes en un calculador numérico. El algoritmo de guiado, a partir de las informaciones proporcionadas por los detectores (actitudes, velocidades de actitudes, aceleraciones) y de la navegación, calcula las consignas de actitud que debe realizar el bucle de pilotaje y que, por lo tanto, sirven para el algoritmo de pilotaje.
En general, las leyes de pilotaje están determinadas suponiendo un desacoplamiento de los ejes de cabeceo, guiñada y balanceo. Esta hipótesis permite sintetizar la ley utilizando un modelo de un eje válido para los ángulos pequeños. El efecto del acoplamiento de las tres leyes (una para cada eje) se verifica a posteriori en simulación de tres ejes.
La figura 2 establece el esquema funcional de un eje de la ley de pilotaje. El algoritmo de pilotaje se ve como una caja "negra" que dispone de informaciones que provienen de los detectores de la lanzadera (central inercial para la medición de actitud y girómetro para la medición de la velocidad de actitud) y que define un mando para el accionador de un eje, en este caso, una tobera.
La representación de un eje supone que el movimiento de la lanzadera es un movimiento plano. Por otra parte, el accionador está servomandado en posición. Unifica una posición equivalente a la consigna de viraje traducida en elongación.
Estado de la técnica
La principal dificultad que encuentra el diseñador del conjunto de pilotaje es la nueva transcripción de los objetivos físicos que debe satisfacer la ley de pilotaje para deducir un criterio matemático que pueda optimizarse a continuación. Esta nueva transcripción necesita eludir la naturaleza física de los objetivos para encontrar una representación matemática adecuada.
A título de ejemplo, la estabilidad (desde un punto de vista físico) está constatada por la calidad de amortiguación de la respuesta temporal del bucle de pilotaje sometida a una perturbación o a una consigna. Matemáticamente, también se puede decir que el grado de estabilidad (valor de la amortiguación) está relacionado con el coeficiente de sobretensión del bucle de pilotaje (resonancia del bucle de pilotaje a una frecuencia dada). La relación explícita entre la amortiguación y el coeficiente de sobretensión solo existe para unos sistemas denominados académicos (sistemas del segundo orden).
A pesar de estas restricciones, las síntesis actuales de leyes de pilotaje utilizan la noción de sobretensión más bien que de amortiguación para tener en cuenta un objetivo de estabilidad, ya que esta se adapta muy bien a los criterios establecidos a partir de la minimización de una norma matemática. Como la relación entre sobretensión y amortiguación no es directa, solo es a posteriori por simulación temporal, como se constata la amortiguación.
Las leyes de pilotaje que se conocen utilizan los siguientes algoritmos de síntesis:
- el método LQG (A4, M45, A5),
- el método H (A5).
Cada algoritmo propone unos parámetros de síntesis que permiten optimizar la ley para que esta responda a las exigencias y a las restricciones requeridas para el pilotaje (estabilidad, prestación en recuperación, solidez en estabilidad y en prestación).
Los métodos de síntesis anteriores buscan globalizar los diferentes objetivos utilizando la noción de sistema estándar. Un gran número de problemas de análisis así como de síntesis de mando pueden escribirse por un único y mismo esquema estándar sobre el que es posible formular los objetivos de la ley en forma de un criterio matemático del que se busca minimizar la norma (norma H2 o H^). La noción de problema estándar es, por lo tanto, extremadamente potente para globalizar los objetivos en forma de un criterio matemático único. No obstante, esta globalización se paga alejándose del sentido físico que se puede dar al criterio resultante.
Por otra parte, la puesta en forma estándar genera generalmente una complejidad del algoritmo. No estando los parámetros de síntesis forzosamente adaptados a la resolución del problema planteado, se está obligado a darse unos grados de libertad suplementarios (de donde surge un aumento del orden) para transcribir de nuevo correctamente los objetivos considerados.
Los métodos modernos actualmente utilizados aportan un plus indiscutible en el análisis y la síntesis de los objetivos de una ley de mando. Por el contrario, el criterio resultante a partir del cual se efectuará la síntesis de la ley, conduce a aplicar un proceso "ensayo-error" para converger hacia un resultado satisfactorio.
En efecto, las soluciones que se obtienen con estos algoritmos no permiten obtener una relación entre el comportamiento en frecuencia y el comportamiento temporal de otra manera que no se por simulación, en particular,
5
10
15
20
25
30
35
40
45
50
55
60
65
el fuerte nivel de sobretensión del bucle cerrado correlacionado con una amortiguación conveniente de este último. Por lo tanto, solo se puede buscar la ley óptima en iteraciones sucesivas "síntesis-simulación-verificación". El documento US 4659035 divulga un procedimiento y un dispositivo de pilotaje en vuelo de un artefacto propulsado provisto de un accionador orientable.
Problema técnico y presentación de la invención
La invención tiene como objeto un procedimiento y un dispositivo de pilotaje de un artefacto orientable, servomandado en actitud sobre una trayectoria y sometido a unas perturbaciones exteriores, que implementa un algoritmo de pilotaje cuyos parámetros pueden estar correlacionados con unos objetivos físicos fijados para el pilotaje.
Propone para ello un procedimiento de pilotaje conforme con la reivindicación 1.
Propone, asimismo, un dispositivo de pilotaje adaptado para la implementación del procedimiento tal como se describe más arriba, que incluye una entrada que recibe al menos una medición en actitud de cabeceo, una salida destinada a aplicar un mando de un accionador, al menos un bucle de servomando en cabeceo conectado entre esta entrada y esta salida y que incluye un filtro corrector del primer orden, un término de transferencia que incluye unos parámetros característicos del artefacto y unas perturbaciones exteriores, una ganancia en actitud y una ganancia en velocidad de actitud.
Se puede señalar que la elección de una ley de pilotaje tan sencilla va, a priori, en contra del análisis actual del experto en la materia según el cual un algoritmo sencillo, por lo tanto, con pocos parámetros, está poco adaptado para un buen pilotaje. Sin embargo, contra todo pronóstico, la elección de una ley tan sencilla ha resultado que permite la elaboración de leyes que permiten correlacionar, teniendo en cuenta ciertas simplificaciones de cálculo, por ejemplo, por desarrollo limitado del bucle cerrado, los parámetros de una ley de este tipo con unos parámetros físicos tales como la amortiguación (por lo tanto, la estabilidad) y la rapidez del servomando (por lo tanto, unas prestaciones temporales), con la ganancia en actitud alrededor del eje considerado, así como con unos parámetros físicos de la modelización.
Lista de figuras
Los objetos, características y ventajas de la invención se describirán con referencia a las figuras en las que:
- la figura 1 es un esquema clásico que muestra el régimen de las restricciones sobre un artefacto sometido a una presión dinámica,
- la figura 2 es un esquema clásico de un sistema de pilotaje de un eje,
- la figura 3 es un esquema clásico que define diversos ángulos, para un eje dado,
- la figura 4 es un esquema de una arquitectura genérica de una ley de pilotaje analítica utilizada según la invención, para un eje dado,
- la figura 5 es una variante de ello, en el caso en que la velocidad angular alrededor del eje considerado no se mide,
- la figura 6 es una curva que correlaciona la ganancia y la fase del bucle abierto en el caso nominal y en los casos
denominados BF y HF,
- las figuras 7 y 8 son unas curvas que dan la respuesta en actitud, viraje e incidencia del bucle cerrado de pilotaje para el BF (A6mín, K1máx) y HF (A6máx, K1mín).
Descripción detallada
Según la invención, se utiliza el algoritmo de pilotaje estrictamente necesario, en cuanto a complejidad, para asegurar el pilotaje de un artefacto.
El algoritmo se basa en una estructura genérica cuyos parámetros se calculan de manera formal en función de los del artefacto que hay que pilotar y de las características deseadas del pilotaje (seguimiento de trayectoria, minimización de la incidencia, fases transitorias, ...). La ley tiene en cuenta explícitamente las indeterminaciones de los parámetros del artefacto y un retardo de cadena globalizado (retardo inducido por la dinámica del accionador + retardo de los sensores + retardo debido al muestreo).
Esta ley es aplicable en un marco no estacionario (evolución de los parámetros de la lanzadera). La ley no estacionaria se obtiene rápidamente, ya que los parámetros de esta son formales. Teniendo en cuenta la estructura genérica, no hay problemas asociados a las técnicas de interpolación ampliamente utilizadas en los pilotajes de las
5
10
15
20
25
30
35
40
45
50
55
60
lanzaderas.
La aportación innegable de este método es que los parámetros de síntesis son unos parámetros físicos de alto nivel (amortiguación del bucle cerrado, banda pasante,). Se sabe asociar a estos parámetros una magnitud física y un objetivo correspondientes. La regulación se obtiene, por lo tanto, directamente a partir de exigencias físicas expresadas por el diseñador.
Esto se desprende de las siguientes explicaciones que, por cuestión de simplificaciones, se limitan al pilotaje del modo rígido de un artefacto. La presencia eventual de los modos flexibles puede tenerse en cuenta eligiendo una política "prudente", es decir, evitando excitar los modos flexibles por la ganancia de bucle de la ley de pilotaje (por añadidura de un filtro atenuador, por ejemplo).
El establecimiento de una ley de pilotaje necesita la introducción de un modelo de la lanzadera llamado modelo de síntesis. La dinámica de bucle abierto no corregido puede representarse por dos ecuaciones acopladas que describen los movimientos de actitud y de deriva de la lanzadera (cf. fig. 3).
El establecimiento de la ley de pilotaje necesita la elección de un modelo apropiado del artefacto llamado modelo de síntesis.
La dinámica de bucle abierto no corregido puede representarse, con referencia a las magnitudes definidas en la figura 3, por dos ecuaciones acopladas que describen los movimientos de actitud y de deriva del artefacto.
En primer lugar, limitándose a los ángulos pequeños, el momento en cabeceo puede estar definido por las ecuaciones (1) del anexo, mientras que las fuerzas transversas con respecto al eje de la velocidad del aire pueden estar definidas por las ecuaciones (2).
Por otra parte, los diversos ángulos de la figura 3 están relacionados por la ecuación (3) que, después de derivación con respecto al tiempo, da las ecuaciones (4).
Después de eliminación de y entre las ecuaciones (2) y (4) se obtiene el sistema de ecuaciones (5) donde s es la variable de Laplace.
Si se supone que los términos identificados en la condición (C) son pequeños para los valores de este estos contenidos en la banda pasante del bucle de pilotaje, se puede aproximar la expresión (5) por la expresión (6).
Esta expresión muestra que el sistema es de orden 2 con una dinámica del primer orden, inestable en la pulsación
El sistema de ecuaciones (6) constituye el modelo de síntesis a partir del que van a establecerse las bases de la síntesis analítica.
De ello se desprende que la transferencia de mando, es decir, la transferencia entre la variable controlada (0) y el mando (viraje P) se expresa por el término K1/(s2-A6).
Los comportamientos del servo-timón y de la cadena de medición pueden modelizarse por un retardo puro global de cadena, t, en serie con la transferencia de mando, de donde surge la expresión (7), donde G' representa, desde el punto de vista automático, una representación matemática del sistema físico que se quiere poner en bucle.
El retardo puro se ha aproximado, en la expresión anteriormente citada, por una aproximación de PADÉ de orden 1.
La puesta en bucle se realiza de modo que el bucle cerrado correspondiente responda a los objetivos de estabilidad y de prestación que se esperan.
Ejemplos de arquitecturas genéricas de la ley de pilotaje analítica.
La figura 4 muestra la arquitectura genérica de la ley de pilotaje analítica. Se presenta suponiendo que las mediciones en actitud, pero también en velocidad de actitud son accesibles, pero, como se mostrará esto más adelante, esta hipótesis no constituye una limitación del método.
En esta arquitectura, el retardo t suma el retardo de cadena, el retardo inducido por el muestreo-bloqueo, así como el retardo equivalente al desfase del timón. Este retardo también puede constar del desfase de un filtro destinado a atenuar localmente la ganancia de bucle de la ley de pilotaje para asegurar una solidez en ganancia de un modo flexible de lanzadera.
5
10
15
20
25
30
35
40
45
50
55
60
S + o1
Se impone un corrector del primer orden en la cadena directa s + ®2 y una ganancia en velocidad de actitud (Kv) y una ganancia en actitud (Kp). El orden de la ley de pilotaje es, por lo tanto, igual a 1.
Se evalúa la primera dinámica del procedimiento en bucle cerrado para fijar este último sobre un modelo del 2° orden de parámetros (Z, o>n). Esta política permite condensar el compromiso prestación-estabilidad de una manera elegante. La amortiguación induce un cierto grado de estabilidad, mientras que m (rapidez del servomando) genera unas prestaciones temporales. Los parámetros (Z, o>n) constituyen, por lo tanto, los parámetros de regulación de "alto nivel".
A continuación, se efectúa un desarrollo limitado del bucle cerrado hasta el orden 3. Se obtiene un sistema de tres ecuaciones a partir de las cuales tres de los cuatro parámetros de regulación de la ley de pilotaje (Kv, o>1, o>2) se deducen en función de (Kp, o>n, Z) por las ecuaciones (8).
Con el fin de evitar una cierta pesadez de la exposición, las soluciones anteriores se han establecido sin tener en cuenta el retardo global del bucle t. En presencia de este, estas últimas son claramente más complejas. No obstante, todavía existen las soluciones y pueden implantarse fácilmente en el centro de un software de síntesis de ley. Pueden formularse las siguientes observaciones:
- El polo del corrector de la cadena directa es inestable (m <0).
- Los parámetros (Kv, m1, M2) son función de Kp. Desde un punto de vista matemático, se habría podido elegir determinar Kp y otros dos parámetros en función del cuarto. No obstante, es más juicioso dejar Kp como parámetro libre, ya que este puede elegirse de manera independiente de la dinámica de bucle cerrado. Un valor nulo de Kp favorecerá una minimización de la incidencia del artefacto, mientras que un valor no nulo generará un seguimiento y una regulación de la actitud de la lanzadera.
- El cero del corrector compensa la dinámica estable del artefacto (coi = 4\).
- Para A6 = 0, el polo y el cero del corrector de la cadena directa tienden hacia 0. La estabilidad del sistema está asegurada por un avance de fase bien conocido por las técnicas clásicas de mando y definida por Kp + sKv.
La determinación de los parámetros de la ley muestra que estos se han calculado a partir de parámetros de alto nivel (amortiguación y rapidez del bucle cerrado). Esto nos permite establecer la relación entre esta amortiguación y el margen de estabilidad del servomando expresado en forma de un margen de ganancia M0 (recordemos que el margen de ganancia es el valor de la ganancia del bucle abierto cuando la entrada y la salida de este último están desfasadas en 180°, obteniéndose la inestabilidad justa para un valor del margen de ganancia = 1) dado por la ecuación (9).
Observamos que el margen de ganancia se afina en Z (amortiguación del bucle cerrado). En concreto, es mínimo para una ganancia en actitud nula ((Kp = 0). Su valor está dado por la expresión (10).
Si se elige una dinámica de bucle cerrado definida por con = (en este caso, la lanzadera está estabilizada), el margen de ganancia está expresado por la expresión (11).
Esta expresión anterior establece la relación directa entre la amortiguación y el margen de estabilidad.
El método anterior es aplicable aunque la medición de velocidad de actitud no esté accesible. En este caso, se estima esta última por un filtro estimador de tipo paso alto propio (existencia de un término de transmisión directa a las altas frecuencias) o estrictamente propio (corte de la ganancia de filtro a las altas frecuencias con una pendiente de 20 dB por década al menos). Elijamos un filtro de paso alto con un corte de 20 dB por década. Su expresión está definida por la ecuación (12).
La ley de pilotaje se convierte entonces en una ley de monopuesta en bucle cuya arquitectura está definida por la figura 5.
Como para el caso con retorno de velocidad de actitud, las expresiones de la ley de pilotaje (o>1, m2, Kv) pueden determinarse completamente por desarrollo del bucle cerrado en el orden 3 y en función de los parámetros Kp, o>n, Z, m y t.
Elección de los parámetros de regulación
El seguimiento de actitud genera forzosamente una toma de incidencia que puede ser alteradora desde el punto de vista de los esfuerzos generales aplicados sobre la lanzadera. Por consiguiente, la elección de la ganancia en actitud
5
10
15
20
25
30
35
40
45
50
55
60
65
se hace de la siguiente manera:
Deberá fijarse un valor no nulo de Kp si se desea un buen seguimiento de actitud (despegue, fase de vuelo fuera de la atmósfera).
Deberá elegirse un valor escaso o nulo de Kp para minimizar la incidencia en unas fases de vuelo críticas, como las que corresponden a la presión dinámica máxima.
El valor de o>n determina la rapidez de contrarreacción del bucle de pilotaje. La pulsación o>n debe seleccionarse convenientemente para que la recuperación de la lanzadera a la presión dinámica máxima sea compatible con la incidencia admisible y las prestaciones del servotimón. El parámetro de regulación o>n está relacionado, por lo tanto, estrechamente con el objetivo de prestación de la ley de pilotaje. La elección de o>n tendrá en cuenta las indeterminaciones sobre los parámetros de la lanzadera (objetivo de solidez en prestación).
Los objetivos de estabilidad y de solidez en estabilidad están fijados por el parámetro Z, de manera que todas las lanzaderas definidas por las variaciones de los parámetros A6 y K1, se estabilicen con una amortiguación al menos igual a la amortiguación especificada por el diseñador.
Evolución no estacionaria de la ley
Teniendo en cuenta las diferentes restricciones que intervienen en el transcurso del vuelo (despegue, seguimiento de trayectoria, estabilidad del artefacto en las fases críticas, precisión de inyección en órbita (lanzadera civil) o de disparo (misil), la ley más interesante es el resultado de una interpolación de varias leyes lineales calculadas en diferentes instantes del vuelo. Los parámetros de la ley se convierten entonces en unas funciones del tiempo. Siendo la estructura del corrector genérica, la interpolación de estos parámetros puede efectuarse de manera directa, conservando estos el mismo sentido físico de un instante de vuelo a otro.
En un instante de vuelo t, se definen:
- los parámetros de la lanzadera A6(t) y K1 (t),
- una ganancia en actitud Kp(t),
- una rapidez del bucle de pilotaje o>n(t),
- una amortiguación Z(t) que puede elegirse constante para todo el vuelo.
Los parámetros de la ley que corresponden al instante t se evalúan a partir de las fórmulas analíticas proporcionadas por el desarrollo limitado del bucle cerrado.
El proceso de síntesis se reitera para n puntos de vuelo del nivel considerado. La ley global no estacionaria se obtiene interpolando las n leyes estacionarias.
Ampliación de la estructura de la ley
La ley analítica tiene dos formas genéricas de base según si se dispone o no de un retorno de velocidad de actitud, dadas por las ecuaciones (13) y (14).
Estas formas pueden ampliarse aunque la naturaleza de la solución esté definida por una de las dos formas de base. Una primera propuesta consiste en hacer compleja la una o la otra de las formas de bases multiplicando estas últimas por un filtro de cualquier orden. Este filtro tendrá como objetivos, ya sea reducir localmente en frecuencias la ganancia para evitar excitar unos modos flexibles de la lanzadera a unas frecuencias particulares, ya sea aportar una atenuación en ganancia del bucle a partir de una cierta frecuencia definida por el diseñador.
Por supuesto, es completamente posible agregar otro tipo de filtro que no tenga ninguna función particular, si no es hacer compleja, aparentemente, una de las dos formas de base.
Sentido físico y valores tradicionales de los parámetros
Teniendo en cuenta la expresión analítica de los parámetros Kv, o>1, y o>2, es posible asociar para algunos de entre ellos un sentido físico dado:
La pulsación o>1 es igual a dinámica propia de la lanzadera. Se realiza una compensación de esta última. De manera más precisa, se puede escribir que la pulsación coi es proporcional a la presión dinámica del instante de vuelo considerado e inversamente proporcional a la inercia de la lanzadera. Su valor es, a priori, difícil de cuantificar,
5
10
15
20
25
30
35
40
45
50
puesto que este depende de las características de la lanzadera.
La expresión de la pulsación m2 es función de la rapidez optada para el bucle de pilotaje. De la misma manera que anteriormente, es difícil dar un rango de valores numéricos. No obstante, cualitativamente, se puede precisar que cuanto mayor sea el valor de C02, más rápido será el bucle de pilotaje. En la práctica, la rapidez del bucle se elige tal
que este último no fuerce el procedimiento (lanzadera) más allá de su dinámica propia (V^T).
La expresión de la ganancia Kv es relativamente compleja. Además de los términos K1, A6, Kp y mn, aparece el término de amortiguación Z, parámetro que fija la estabilidad y la solidez en estabilidad del bucle de pilotaje. Cualitativamente, el grado de estabilidad del servomando es tanto más importante en cuanto que el valor numérico de la ganancia Kv es elevado, siendo este proporcional a Z.
Ejemplo
El ejemplo de a continuación muestra la aplicación de la síntesis analítica de una ley de pilotaje estacionario para una lanzadera X. Los valores de los parámetros A6 y K1 a la presión dinámica máxima (que corresponde a una trayectoria fijada) están dados por:
A6 = 35 ± 15s-2
K1 =30 ± 10s-2
El caso mayorante para la estabilidad de la lanzadera corresponde a:
A6 = A6máx = 50 s-2 K1 = K1 mín = 20 s-2
La ley de pilotaje se sintetiza a la presión dinámica máxima con los parámetros de la lanzadera de más arriba. Se fija la amortiguación de la dinámica de bucle cerrado en:
Z = 0,3 (esto es la amortiguación requerida que corresponde al caso mayorante)
Con la finalidad de minimizar la incidencia a la presión dinámica máxima, se fija una ganancia en posición nula, sea:
Kp = 0
La elección del parámetro mn (parámetro que fija la rapidez del servomando) se determina verificando que su valor permite no rebasar la velocidad y la excursión de viraje que pueden conseguirse por el timón. Se supone que el valor de mn se conoce y está dado por:
mn = 3,5 rad/s
Si este no es el caso, se reitera la etapa de síntesis del corrector hasta encontrar un valor de mn compatible con las prestaciones del timón verificadas por simulación temporal.
Los parámetros del corrector están proporcionados por las ecuaciones en la base de la invención. Tenemos (para Kp=0)
5
10
15
20
25
30
35
40
45
50
55
La aplicación de las fórmulas supone que la cadena de pilotaje no induce retardo. Si esta hipótesis no se verifica, es necesario volver a evaluar las expresiones analíticas de los parámetros del corrector teniendo en cuenta la presencia del retardo de cadena.
El margen de ganancia de baja frecuencia está dado por la expresión analítica
a/50
3,5
Una simulación temporal muestra que se obtiene un viraje máximo del timón de 5,6° y una velocidad máxima de viraje de 30°. Estas cifras se obtienen para el caso mayorante desde el punto de vista de la estabilidad (caso A6máx, K1 mín denominado caso BF).
Las prestaciones frecuenciales están dadas por la figura 6. En particular, se encuentra, por simulación, el margen de ganancia calculado en el caso mayorante (A6máx, K1 mín).
Las prestaciones temporal obtenidas con la regulación calculada están dadas por las curvas de las figuras 7 y 8"
La ley de pilotaje analítica permite conseguir rápidamente los objetivos de estabilidad y de prestación para el conjunto de las lanzaderas descritas por las variaciones de los parámetros A6 y K1. Contrariamente a los métodos del tipo LQG o H^, la iteración frecuencial, que consiste en verificar a posteriori los márgenes de estabilidad, se ha eliminado. La iteración temporal, que permite elegir la rapidez del bucle de pilotaje, permanece necesaria, ya que el objetivo de prestación está directamente relacionado con la naturaleza de las perturbaciones que actúan sobre la lanzadera (viento, racha, perturbaciones internas, ...). La extensión no estacionaria es directa y no plantea problemas particulares desde el punto de vista de la síntesis.
La ley de pilotaje analítica puede extenderse eventualmente para unos artefactos que no sean las lanzaderas. El estudio de base muestra que está elaborada a partir de un modelo de síntesis deducido de las ecuaciones de la mecánica del vuelo, siendo la hipótesis fuerte la inestabilidad del artefacto. Por lo tanto, no hay ninguna limitación para que este tipo de ley pueda ser aplicable para unos aviones inestables sobre uno o varios ejes de vuelo (cabeceo, guiñada y balanceo). Para esto, es suficiente con adaptar las ecuaciones de la mecánica del vuelo a los aviones inestables. Esta adaptación permitirá obtener un nuevo modelo de síntesis del que se deducirán los parámetros de la ley de pilotaje analítica.
De manera preferida:
- se determinan para la fase de vuelo unos valores (A6máx, K1mín) de los parámetros del término de transferencia que mayoran las perturbaciones exteriores;
- se aplica una prueba de validación por simulación a las elecciones de la ganancia en actitud y unos términos de rapidez y de amortiguación durante toda la duración del vuelo y se aplican estas elecciones durante todo el vuelo si estas elecciones están validadas, si no, se descompone el tiempo de vuelo en varias fases;
- el término de transferencia se define para unas perturbaciones exteriores sustancialmente causadas por el aire atmosférico;
- se aplican en balanceo y en guiñada unas leyes de pilotaje definidas según el mismo método que la ley de pilotaje en cabeceo.
Anexo: Fórmulas
con
5
10
15
20
25
30
m: masa de la lanzadera Q: presión dinámica Cza: gradiente de sustentación I: inercia en cabeceo
S: superficie de referencia del artefacto para el cálculo de la fuerza de sustentación Pc: Empuje del artefacto
Lf: distancia centro de gravedad - foco aerodinámico Lt: distancia centro de gravedad - centro de rotación tobera
donde
9 fííf + á + g
1 dw 1 dw dz Vz dw
(4)
(gradiente de viento)
v dt V dz dt V dz
(La velocidad Vz es la proyección de la velocidad de la lanzadera sobre el eje vertical)
- (e'
- _ 1 1 _____1 ñ
- ' (S2-At) Ky i W
(6)
Claims (11)
- 5101520253035404550REIVINDICACIONES1. Procedimiento de pilotaje en vuelo de un artefacto propulsado provisto de un accionador orientable, servomandado en actitud sobre una trayectoria y sometido a unas perturbaciones exteriores según el cual, al menos en cabeceo:- se define previamente una ley de pilotaje que incluye un término corrector del primer orden, un término de transferencia que incluye unos parámetros característicos del artefacto y unas perturbaciones exteriores (A6, K1), una ganancia en actitud (Kp) y una ganancia en velocidad de actitud (Kv);- se definen previamente unas relaciones de correlación entre la ganancia en velocidad de actitud y los parámetros del término corrector en función de la ganancia en actitud, unos parámetros del término de transferencia del artefacto y de dos términos que representan unas consignas de rapidez (mn) y de amortiguación (Z) y- para al menos una fase de vuelo del artefacto, se determinan unos valores de los parámetros del término de transferencia y se elige la ganancia en actitud y los términos de rapidez y de amortiguación, se deducen de ello los parámetros del término corrector y la ganancia en velocidad y se aplica al accionador la ley de pilotaje con estos valores de los parámetros.
- 2. Procedimiento según la reivindicación 1, caracterizado porque se definen las leyes de correlación a partir de un desarrollo limitado de la ecuación del bucle cerrado constituido por el artefacto y su accionador.
- 3. Procedimiento según la reivindicación 1 o 2, caracterizado porque se determinan para la fase de vuelo unos valores (A6máx, K1 mín) de los parámetros del término de transferencia que mayoran las perturbaciones exteriores.
- 4. Procedimiento según una cualquiera de las reivindicaciones 1 a 3, caracterizado porque se prevé, además, en la ley de pilotaje un filtro.
- 5. Procedimiento según una cualquiera de las reivindicaciones 1 a 4, caracterizado porque se aplica la ley de pilotaje utilizando unas mediciones de la actitud y de la velocidad en actitud.
- 6. Procedimiento según una cualquiera de las reivindicaciones 1 a 4, caracterizado porque se aplica la ley de pilotaje utilizando un filtro estimador de velocidad de actitud en la ley de pilotaje.
- 7. Procedimiento según una cualquiera de las reivindicaciones 1 a 6, caracterizado porque se aplica una prueba de validación por simulación a las elecciones de la ganancia en actitud y unos términos de rapidez y de amortiguación durante toda la duración del vuelo y se aplican estas elecciones durante todo el vuelo si estas elecciones están validadas, si no, se descompone el tiempo de vuelo en varias fases.
- 8. Procedimiento según una cualquiera de las reivindicaciones 1 a 7, caracterizado porque el término de transferencia está definido para unas perturbaciones exteriores sustancialmente causadas por el aire atmosférico.
- 9. Procedimiento según una cualquiera de las reivindicaciones 1 a 8, caracterizado porque la ley de pilotaje incluye, además, un término de retardo.
- 10. Procedimiento según una cualquiera de las reivindicaciones 1 a 9, caracterizado porque se aplican en balanceo y en guiñada unas leyes de pilotaje definidas según el mismo método que la ley de pilotaje en cabeceo.
- 11. Dispositivo de pilotaje adaptado para la implementación del procedimiento según una cualquiera de las reivindicaciones 1 a 10 que incluye una entrada que recibe al menos una medición en actitud de cabeceo, una salida destinada a aplicar un mando de un accionador, al menos un bucle de servomando en cabeceo conectado entre esta entrada y esta salida y que incluye un filtro corrector del primer orden, un término de transferencia que incluye unos parámetros característicos del artefacto y unas perturbaciones exteriores, una ganancia en actitud y una ganancia en velocidad de actitud.
imagen1 Zona de depresiónEsfuerzo resultantede actitudToberaFig.1Eje del artefactoTiedroaerodinámicoZona de sobrepresion(presión dinámica)SustentaciónDirección de vectorve ocidadEstelaFig.2Medición de actitudvientoMediciónde la velocidadServomandoen posiciónaccionador hidráulicoo eléctrico)Medición de la posiciónde accionadorConsigna en posiciónde accionadorde timónGirometroAlgoritmode pilotajeConsigna—deCentra inerciaactitudimagen2 DirecciónempujeEje artefactoDireccióni velocidad aireVeracidad aireVelocidad sueloFig-3Fig.4Kp + sKy+ o\s iwc+s/wc+1s + a>$ -ALey de pilotaje analítica monopuesta en bucleFig.5Gananciaimagen3 Bucle abierto de pilotaje caso BF (A6máx, K1mín) nominal (A6nom, K1nom), HF(A6mín, K1máx)Fig.6imagen4 VirajeActitudIncidencia iTiempo sRespuesta del bucle cerrado de pilotaje caso BF (A6max, K1min)Fig.7imagen5 ActitudVirajeIncidenciaTiempo sRespuesta del bucle cerrado de pilotaje caso HF (Abmin, K1max)Fig.8
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR0215588A FR2848307B1 (fr) | 2002-12-10 | 2002-12-10 | Procede et dispositif de pilotage d'un engin orientable au moyen d'un actionneur asservi en attitude sur une trajectoire |
FR0215588 | 2002-12-10 | ||
PCT/FR2003/003637 WO2004063824A1 (fr) | 2002-12-10 | 2003-12-09 | Procede et dispositif de pilotage d'un engin orientable au moyen d'un actionneur asservi en attitude sur une trajectoire |
Publications (1)
Publication Number | Publication Date |
---|---|
ES2657436T3 true ES2657436T3 (es) | 2018-03-05 |
Family
ID=32320150
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
ES03815096.7T Expired - Lifetime ES2657436T3 (es) | 2002-12-10 | 2003-12-09 | Procedimiento y dispositivo de pilotaje de un artefacto orientable por medio de un accionador servomandado en actitud sobre una trayectoria |
Country Status (6)
Country | Link |
---|---|
EP (1) | EP1570326B8 (es) |
ES (1) | ES2657436T3 (es) |
FR (1) | FR2848307B1 (es) |
RU (1) | RU2323464C2 (es) |
UA (1) | UA82858C2 (es) |
WO (1) | WO2004063824A1 (es) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2465535C1 (ru) * | 2011-05-12 | 2012-10-27 | Открытое акционерное общество "Конструкторское бюро приборостроения" | Способ телеуправления ракетой |
RU2511610C1 (ru) * | 2012-11-13 | 2014-04-10 | Открытое акционерное общество "Конструкторское бюро приборостроения" | Способ формирования сигналов управления вращающейся вокруг продольной оси двухканальной ракетой |
CN105783612B (zh) * | 2016-03-28 | 2018-01-05 | 北京航天控制仪器研究所 | 一种通用小型化数字电动舵机控制器及其控制方法 |
RU2663251C1 (ru) * | 2017-05-30 | 2018-08-03 | Акционерное общество Московский научно-производственный комплекс "Авионика" имени О.В. Успенского (АО МНПК "Авионика") | Способ помощи в навигации для уточнения траектории летательного аппарата |
FR3073282B1 (fr) * | 2017-11-07 | 2020-10-16 | Centre Nat Etd Spatiales | Procede de guidage d'un lanceur spatial le long d'une trajectoire |
RU2695762C1 (ru) * | 2019-01-25 | 2019-07-25 | Федеральное государственное казённое военное образовательное учреждение высшего образования "Военная академия воздушно-космической обороны имени Маршала Советского Союза Г.К. Жукова" Министерства обороны Российской Федерации | Способ формирования параметров рассогласования в радиоэлектронной системе управления ракетой класса "воздух-воздух" при её самонаведении на самолёт из состава их пары по его функциональному назначению по принципу "ведущий-ведомый" |
CN111830994B (zh) * | 2020-08-05 | 2022-04-01 | 华侨大学 | 一种轮式移动机器人速度控制方法及系统 |
CN113064443B (zh) * | 2021-03-08 | 2022-10-11 | 北京理工大学 | 增益在线调整方法及使用其的阻尼回路控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4659035A (en) * | 1985-01-25 | 1987-04-21 | The United States As Represented By The Secretary Of The Navy | Rate estimation by mixing two independent rate signals |
US5259569A (en) * | 1992-02-05 | 1993-11-09 | Hughes Missile Systems Company | Roll damper for thrust vector controlled missile |
IL118883A (en) * | 1996-07-17 | 2000-06-01 | Israel State | Flight control of an airborne vehicle at low velocity |
-
2002
- 2002-12-10 FR FR0215588A patent/FR2848307B1/fr not_active Expired - Fee Related
-
2003
- 2003-09-12 UA UAA200506737A patent/UA82858C2/uk unknown
- 2003-12-09 WO PCT/FR2003/003637 patent/WO2004063824A1/fr active Application Filing
- 2003-12-09 RU RU2005121574/28A patent/RU2323464C2/ru not_active IP Right Cessation
- 2003-12-09 ES ES03815096.7T patent/ES2657436T3/es not_active Expired - Lifetime
- 2003-12-09 EP EP03815096.7A patent/EP1570326B8/fr not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
UA82858C2 (en) | 2008-05-26 |
WO2004063824A8 (fr) | 2004-09-23 |
EP1570326B8 (fr) | 2017-12-06 |
WO2004063824A1 (fr) | 2004-07-29 |
FR2848307A1 (fr) | 2004-06-11 |
EP1570326B1 (fr) | 2017-10-25 |
EP1570326A2 (fr) | 2005-09-07 |
RU2323464C2 (ru) | 2008-04-27 |
RU2005121574A (ru) | 2006-02-27 |
FR2848307B1 (fr) | 2005-08-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Raab et al. | Proposal of a unified control strategy for vertical take-off and landing transition aircraft configurations | |
Rysdyk | UAV path following for constant line-of-sight | |
Ahmed et al. | Flight control of a rotary wing UAV using backstepping | |
Moutinho et al. | Airship robust path-tracking: A tutorial on airship modelling and gain-scheduling control design | |
Alexis et al. | Model predictive quadrotor control: attitude, altitude and position experimental studies | |
ES2238444T3 (es) | Procedimiento, aparato y procedimiento de diseño para controlar los sistemas dependiendo de parametros de multiples entradas y salidas (mimo) por medio de una invariante de tiempo lineal (lti) de retroaccion. | |
Gavrilets et al. | Control logic for automated aerobatic flight of a miniature helicopter | |
AU2013234603B2 (en) | Altitude regulator | |
JPH0858697A (ja) | 対気飛行速度ベクトル計測装置を用いた対気能動制御航空機 | |
Bogdanov et al. | State-dependent Riccati equation control of a small unmanned helicopter | |
KR101844727B1 (ko) | 회전익 무인비행체를 이용한 바람 정보 추정 시스템 | |
JP4685866B2 (ja) | 動的システムを制御するためのシステムおよび方法 | |
ES2657436T3 (es) | Procedimiento y dispositivo de pilotaje de un artefacto orientable por medio de un accionador servomandado en actitud sobre una trayectoria | |
Erhard et al. | Sensors and navigation algorithms for flight control of tethered kites | |
Peddle et al. | Practical near hover flight control of a ducted fan (SLADe) | |
US20200264209A1 (en) | System and method for determining wind direction and velocity measurement from altitude for an unmanned aerial vehicle | |
Ameho et al. | Adaptive control for quadrotors | |
Smit | Autonomous landing of a fixed-wing unmanned aerial vehicle using differential GPS | |
US20220308597A1 (en) | System and method for tilt dead reckoning | |
Dumke et al. | Design, development, and flight testing of the vertical take-off and landing GNC testbed EAGLE | |
Herrington et al. | Modeling and control of a steerable cruciform parachute system through experimental testing | |
JP4617990B2 (ja) | 自動飛行制御装置、自動飛行制御方法及び自動飛行制御プログラム | |
CN109445283B (zh) | 一种用于欠驱动浮空器在平面上定点跟踪的控制方法 | |
Ducard et al. | Airspeed control for unmanned aerial vehicles: a nonlinear dynamic inversion approach | |
Orr et al. | A modern load relief guidance scheme for space launch vehicles |