ES2776723T3 - Método para computar una cota de error de una solución de posición de GNSS basada en filtro de Kalman - Google Patents

Método para computar una cota de error de una solución de posición de GNSS basada en filtro de Kalman Download PDF

Info

Publication number
ES2776723T3
ES2776723T3 ES14189240T ES14189240T ES2776723T3 ES 2776723 T3 ES2776723 T3 ES 2776723T3 ES 14189240 T ES14189240 T ES 14189240T ES 14189240 T ES14189240 T ES 14189240T ES 2776723 T3 ES2776723 T3 ES 2776723T3
Authority
ES
Spain
Prior art keywords
matrix
measurements
distribution
type
state vector
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
Application number
ES14189240T
Other languages
English (en)
Inventor
Madrid Pedro Francisco Navarro
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
GMV Aerospace and Defence SA
Original Assignee
GMV Aerospace and Defence SA
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by GMV Aerospace and Defence SA filed Critical GMV Aerospace and Defence SA
Application granted granted Critical
Publication of ES2776723T3 publication Critical patent/ES2776723T3/es
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/393Trajectory determination or predictive tracking, e.g. Kalman filtering

Abstract

Método para computar una cota B hasta un nivel de confianza dado 1 - α, de un error en una estimación de vector de estado, KSV, de un vector de estado, TSV, de un sistema físico tal como es proporcionado por un filtro de Kalman, recibiendo el filtro de Kalman, del sistema físico, múltiples mediciones sin procesar RMm de diferentes tipos, denotando m cada tipo de medición, proporcionando también el filtro de Kalman: - el número nOBS,m de mediciones sin procesar de tipo m; - una matriz de diseño Hm para mediciones de tipo m; - una matriz de pesos Wm usada para mediciones de tipo m; - el vector de residuos ym de las mediciones de tipo m, computado después de la actualización de mediciones de Kalman; - una matriz de covarianza P del error realizado en la estimación KSV del vector de estado; y - una matriz de transición F que define la evolución del vector de estado; en donde el método comprende las etapas de: - computar una distribución t Tm para cada tipo de medición m, estando definida cada distribución t Tm por un escalar Nm y una matriz Rm, distribución t que se obtiene usando un método de ajuste que ajusta la distribución t Tm a la suma de dos distribuciones t Tm1 y Tm2, - correspondiéndose la primera distribución t Tm1 con la proyección sobre la estimación del vector de estado, KSV, de los errores de las mediciones de tipo m en la época actual, y estando definida por un escalar Nm1 y una matriz Rm1 que se computan como sigue: Nm1 = nm + βN'm1 y Rm1 0 (r2mKmQm.!KTm). en donde: -nm = nOBS,m - tr(HmKm); -r2m = (yTmWmym + βN'm1(r'm)2/Nm1; -N'm1, r'm son los valores de Nm1, rm, respectivamente, en la época previa tk-1; - β es un parámetro de sintonía entre 0 y 1, dado como una entrada al método; - Km = PHTmWm; - correspondiéndose la segunda distribución t Tm2 con la proyección sobre la estimación del vector de estado, KSV, de los errores de las mediciones de tipo m acumulados en épocas previas, y estando definida por un escalar Nm2 y una matriz Rm2 que se computan mediante la propagación del valor previo de Tm como sigue: Nm2=N'm y Rm2 = (UR'mU'), en donde - N'm, R'm son los valores de Nm, R'm, respectivamente, en la época previa tk-1; - U = (1 - ΣmKmHm) · F; - computar la cota de error B al: i) computar una cota de error parcial Bm para cada distribución t Tm y añadir las cotas de error parciales; o, ii) aplicar la etapa previa a un número reducido de distribuciones t obtenidas de las distribuciones t Tm mediante la aplicación del método de ajuste de forma sucesiva a pares de distribuciones t Tm.

Description

DESCRIPCIÓN
Método para computar una cota de error de una solución de posición de GNSS basada en filtro de Kalman Campo de la invención
La presente invención surgió en el campo de la navegación basada en satélite (o GNSS), pero es aplicable en muchos campos en los que se usa un filtrado de Kalman. La invención da respuesta a la necesidad de unas cotas fiables para los errores de posición y de velocidad en diversas aplicaciones de la navegación de GNSS, que varían de la aviación civil al cobro electrónico de tasas (de circulación), entre otras.
Antecedentes de la invención
El problema de navegación de GNSS es el problema de estimar la posición de un usuario de GNSS por medio de la información proporcionada por la señal de GNSS como es recibida por un receptor de usuario de GNSs .
Hay varias técnicas de navegación de GNSS convencionales, la más común de las cuales es la navegación absoluta. En la navegación absoluta, el sistema de navegación computa su posición y velocidad absolutas sin información alguna más que la contenida en las señales de satélite de GNSS sometidas a seguimiento por el receptor del usuario, por medio de las así denominadas mediciones de pseudodistancia y Doppler. Para ese fin, con el fin de poder obtener su posición, se han de estimar algunos parámetros adicionales, como el sesgo y la deriva de reloj de receptor. Si se procesa más de una constelación de satélites (por ejemplo, GPS GLONASS), también es necesario añadir un sesgo entre sistemas que dé cuenta de la diferente sincronización de los relojes de satélite. En un filtro de Kalman común, la posición, la velocidad y los parámetros auxiliares se estiman de forma simultánea. La navegación de GNSS también se puede beneficiar del uso de los datos procedentes de una unidad de medición inercial, o IMU, que consiste habitualmente en un acelerómetro de 3 ejes y un giróscopo de 3 ejes. El filtro de Kalman íntimamente acoplado de GNSS IMU sustituye el modelo de propagación del filtro de Kalman de solo GNSS con una etapa de mecanización, que usa los datos procedentes de la IMU para predecir el estado de filtro de principio a fin del periodo de tiempo entre épocas de datos de GNSS sucesivas. Este filtro híbrido requiere la inclusión de nuevos parámetros en el vector de estado de Kalman, en concreto, los sesgos de acelerómetro y de giróscopo, más las variables de matriz de actitud.
Por último, es posible realizar una navegación absoluta con errores del nivel de centímetros mediante el uso de una técnica denominada PPP (Determinación de Posición Puntual Precisa). La PPP procesa mediciones de pseudodistancia y de fase de portadora procedentes de un único receptor de usuario, usando modelos físicos detallados y correcciones, y requiere órbitas de satélite y productos de reloj precisos (por ejemplo, a través de correcciones en tiempo real al mensaje de navegación). La PPP es diferente de otros enfoques de determinación de posición precisa como RTK en que es necesaria estación de referencia alguna en las proximidades del receptor de usuario.
Los únicos datos de observación que se han de procesar son mediciones procedentes del receptor de usuario. En términos del filtro de Kalman, la diferencia principal de la PPP con respecto a la navegación de GNSS convencional es que, para cada satélite, se ha de estimar un parámetro de ambigüedad de fase de portadora.
La presente invención es aplicable en los casos de GNSS independiente, de GNSS IMU y de PPP.
Para muchas aplicaciones de la navegación de GNSS, no es suficiente un cierto nivel de precisión. Además, el sistema también ha de proporcionar fiabilidad. Por ejemplo, en un sistema de peaje, a los usuarios se les debe cobrar siempre por todas las carreteras de peaje que usen y solo por ellas (ni más, ni menos). En otros campos de aplicación, como la aviación, las consecuencias de obtener una posición equivocada más allá de ciertos límites y no ser consciente de ello son mucho más drásticas. Esto se puede solucionar, en el caso de un sistema basado en GNSS, mediante la adición de un método de integridad de navegación. La integridad proporciona la garantía necesaria de que los usuarios están en donde se supone que están (es decir, en donde el sistema de navegación dice que están). Un sistema puede preservar la integridad y, al mismo tiempo, ser impreciso, siempre que el propio sistema sea consciente de la carencia de precisión. En un caso de este tipo, el problema es que el sistema puede estar no disponible más a menudo de lo deseado. Un sistema perfecto (desde el punto de vista de su fiabilidad) exhibiría una disponibilidad de un 100 % y una integridad de un 100 %. Desafortunadamente, los sistemas perfectos no existen y, en la práctica, siempre hay una compensación recíproca entre ambos objetivos.
Muchos métodos de integridad usan el concepto de Nivel de Protección (PL), que tiene por objeto proporcionar cotas a los errores de determinación de posición de GNSS hasta un cierto nivel de confianza. Por ejemplo, para un nivel de confianza dado 1 - a, un Nivel de Protección válido es un número positivo B tal que:
P(|<5| > B) < a
en donde P es el operador de probabilidad y |S| es la norma del error de posición. Los valores habituales del nivel de confianza varían de 10-4 a 10-7, y dependen de los requisitos de la aplicación de GNSS. Por ejemplo, en el contexto de la aviación aparece frecuentemente a = 10-7. Obsérvese que hay muchos valores posibles que satisfacen la condición de Nivel de Protección, pero es importante que el método proporcione unos bastante pequeños, de tal modo que no se deteriore la disponibilidad. En el caso de la navegación de GNSS, el concepto de cota de error se particulariza habitualmente para un subconjunto de las coordenadas de posición, en especial la componente vertical Su (por ejemplo, aviación civil) o las horizontales, en las direcciones Norte y Este (5e,5n), (por ejemplo, el cobro electrónico de tasas de circulación).
Este concepto de Nivel de Protección surgió como la esencia del concepto de Integridad de GNSS que se desarrolló para Sistemas de Aumento Basados en Satélite (SBAS), tales como el WAAS de EE. UU., o el EGNOS europeo entre otros, y se ha aplicado específicamente a esos sistemas así como a Sistemas de Aumento Basados en Tierra (GBAS) tales como LAAS. Tanto SBAS como GBAS son sistemas que proporcionan correcciones en tiempo real e información de integridad aplicables a las observaciones de GNSS. Las aeronaves civiles equipadas con unidades especiales de navegación de GNSS pueden recibir esas correcciones y aplicarlas a sus observaciones de GNSS, así como la información de integridad, en forma de cotas estadísticas a los errores de observación que quedan después de aplicar las correcciones. Por lo tanto, la unidad de GNSS de a bordo puede lograr una estimación más precisa de su posición (gracias a las correcciones) y, además, puede computar un Nivel de Protección para el error de posición restante.
Además, en el marco de los así denominados métodos de RAIM (Supervisión de Integridad Autónoma de Receptor), se han definido métodos autónomos para computar un Nivel de Protección. Con autónomo se pretende indicar que no depende de correcciones o de información adicional alguna que provenga de un sistema de aumento tal como un SBAS o un GBAS. El concepto de RAIM tiene por objeto proporcionar una capa de integridad al proceso de navegación de GNSS, implementando técnicas para detectar y aislar las mediciones defectuosas (es decir, las mediciones con un error excesivo) junto con los Niveles de Protección mencionados para acotar estadísticamente el error de estimación de posición. Tales métodos de cómputo de PL son, sin embargo, difíciles de justificar desde un punto de vista teórico, debido a que los mismos dependen de unas hipótesis que rara vez se sostienen en el mundo real.
El documento de patente EP2113786 divulga un método autónomo para proporcionar Niveles de Protección para la determinación de posición de GNSS basándose en residuos de navegación, que no formula hipótesis alguna acerca del comportamiento estadístico de los errores de las mediciones individuales, sino que se basa en solo una hipótesis (isotropía) tal que los errores de medición se combinan en un vector de error que puede apuntar con la misma probabilidad en cualquier dirección (del espacio de medición).
La totalidad de los métodos para computar Niveles de Protección que se han mencionado anteriormente solo son de aplicación a la estimación de mínimos cuadrados. Un método para computar Niveles de Protección para una solución de Kalman se enfrenta a nuevos requisitos:
- El filtro hace uso de diferentes tipos de mediciones (por ejemplo, pseudodistancias, mediciones Doppler y de fase de portadora en el caso de GNSS),
- El filtro combina observaciones procedentes de diferentes épocas, dando más peso a las más recientes. Además, el ruido de medición no es ruido blanco, como habitualmente supone el filtro de Kalman. En su lugar, las mediciones realizadas en épocas sucesivas muestran una correlación temporal (ruido coloreado) que puede tener un impacto (negativo) importante en la precisión de la solución de Kalman. Por lo tanto, es fundamental que el método para computar los Niveles de Protección tenga en cuenta los efectos de las correlaciones temporales. - La solución de Kalman tiene errores que provienen de la propagación de la solución entre diferentes actualizaciones, que también se deberían cuantificar.
- El tamaño del vector de estado de Kalman se puede volver bastante grande, pero habitualmente solo unos pocos de los parámetros estimados son interesantes.
Se pueden usar distribuciones t multivariantes para modelar diferentes distribuciones de error. La familia se parametriza mediante un escalar Nm, que se denomina el número de grados de libertad, y una matriz de covarianza Rm, que da una estimación del tamaño de los errores. Por lo tanto, la distribución de un vector de error 9 de dimensión d indica:
Figure imgf000003_0001
La distribución t muestra colas pesadas y proporciona una representación más realista de los errores de medición y de navegación que la distribución normal. Esta se ha usado con el fin de mejorar la robustez de los filtros de navegación frente a valores atípicos. Esta proporciona un buen modelo para los errores de medición, que se usa en un marco de trabajo bayesiano (véase, por ejemplo, "A New Approach for Improving Reliability of Personal Navigation Devices under Harsh GNSS Signal Conditions" Anup Dhital, Jared B. Bancroft y Gerard Lachapelle, Sensors, nov. de 2013, 13, 15221-15241).
Los siguientes párrafos proporcionan un resumen del filtro de Kalman y establecen la notación que se usará más adelante. El filtro de Kalman estima el valor en épocas sucesivas de un conjunto de parámetros (vector de estado), mediante el uso de la información de las mediciones que llegan de forma secuencial. Las mediciones se procesan de forma secuencial, proporcionando una nueva solución cada vez que se recibe un nuevo conjunto de observaciones. El filtro procede mediante actualizaciones de sus variables principales:
- Xk, el vector de estado, o vector de parámetros que define el estado en el tiempo o época fo;
- Pk, la matriz de covarianza de los parámetros estimados en el tiempo tk,
Este realiza dos tipos diferentes de actualizaciones:
A. Actualización de tiempo ("propagación"):
El filtro propaga el vector de estado y la matriz de covarianza de la época k - 1 a la época k; su valor después de esta actualización se indica habitualmente x^, Pk El filtro modela el comportamiento estocástico de los parámetros entre épocas sucesivas. En la configuración lineal - que es suficiente para la mayoría de los fines - la propagación de estado y de covarianza viene dada por:
Figure imgf000004_0001
en donde:
- Fk es la matriz de transición desde el tiempo tk-1 a tk, y,
- Qk es la matriz de covarianza del proceso aleatorio ("ruido de proceso") que impulsa la evolución de los parámetros del vector de estado.
En el filtro híbrido, la propagación del estado y su matriz de covarianza se realiza por un algoritmo de mecanización que procesa los datos de IMU recibidos. Para la mayoría de los fines, esta actualización se puede considerar como equivalente a la actualización lineal.
B. Actualización de mediciones:
La segunda actualización usa la información proporcionada por las mediciones para corregir el vector de estado y la matriz de covarianza, y da su valor final en la época tk indicados xk y Pk, respectivamente. El valor del vector de mediciones en la época k se puede escribir como
zk = h (xk) vk
La función h da la dependencia de las mediciones con los parámetros, y vk es el ruido de medición, que se supone que tiene una matriz de covarianza Rk. La estimación se basa en la expresión linealizada:
Zfc = H [xk vk
La matriz Hk se conoce habitualmente como la matriz de diseño (también denominada matriz de observación). La actualización de mediciones se puede realizar a través de las siguientes etapas:
- Las mediciones se reconstruyen para obtener el vector de residuos yk,
- La nueva matriz de covarianza Pk, se computa como sigue:
Pk = (HTk Wk Hk (P*-)-1) - 1
en donde Wk = P^1 es la matriz de pesos de las mediciones en la época k.
- Se solucionan las ecuaciones normales:
Axk = PkHkWk -yk
de tal modo que xk = xk Axk.
Hay otras mecanizaciones del filtro secuencial, que son matemáticamente equivalentes, pero se prefiere la escrita anteriormente para presentar el algoritmo de integridad. Por razones de claridad, en el resto del documento se suprimirá el omnipresente subíndice k. La matriz de diseño y de pesos se descompondrá en los bloques que se corresponden con cada tipo de medición m, indicadas como Hm, Wm respectivamente, como se muestra en los siguientes diagramas:
Figure imgf000005_0001
Por último, es importante analizar la influencia de las correlaciones temporales de las mediciones en el desempeño del filtro. El filtro de Kalman como se ha presentado anteriormente es óptimo con la suposición de que las mediciones tomadas en diferentes épocas están no correlacionadas. Sin embargo, es raro que este sea el caso. Habitualmente, el proceso de medición se repite en cada época y da un número constante de mediciones (por ejemplo, w), con un vector de ruido Vk asociado de tamaño w. Se supone que el ruido tiene media cero: E(vk) = 0. Las matrices de correlación temporal se pueden definir como B(k, l) = E(VkvJ). El proceso de ruido se denomina estacionario si B(k, l) = B(k + s, l + s) = B(k - 1). En el caso del ruido blanco, las mediciones en diferentes épocas no están correlacionadas, y entonces B(k, l) = 0 si k í l. En la mayoría de los casos, la matriz de correlación B es diagonal, y cada componente del vector Vk se puede analizar como un proceso unidimensional. En una dimensión, se puede definir la función de autocorrelación:
K ( ’ } = B (fe, fe)1/2 B (l, í)1/2
Si el proceso es estacionario, la función de autocorrelación es más simple y se puede escribir como:
R (k,l) = p(k - l)
La función p verifica las siguientes desigualdades:
0 < p(h) < 1
Entonces, la matriz de correlación diagonal B de un proceso estacionario será:
Figure imgf000005_0002
En el caso más simple, un proceso de Gauss-Markov, la función de autocorrelación viene dada por:
Figure imgf000005_0003
Para valores de p(h) significativamente superiores a 0, el desempeño de filtro se deteriora claramente. Por lo tanto, es muy importante tener en cuenta el efecto de las correlaciones para computar cotas para los errores de la solución de Kalman. En el método de la presente invención, cuando se consideran las correlaciones temporales para un tipo de medición m, se denotará con pm la matriz de correlación B(1) asociada del ruido de medición. Esta matriz se dará como una entrada al método. Sus valores se pueden obtener o bien a partir del conocimiento de las características del dispositivo de medición o bien mediante cualquier método independiente que las estime a partir de la evolución de las mediciones y sus residuos.
En lo que se refiere a la presente invención, la forma real de la ecuación de observación de GNSS no lineal, o cómo se deriva de la misma la matriz de diseño H, no son cuestiones relevantes, por lo que el presente documento no profundiza en tales detalles (que, por otro lado, son de uso convencional en la navegación de filtro de Kalman de GNSS y se pueden aprender de muchas fuentes bibliográficas de GNSS como, por ejemplo, "Global Positioning System: Theory & Applications, Bradford W. Parkinson y James J. Spilker (editores), 1996).
Descripción de la invención
La presente invención proporciona un método robusto y consistente para computar, de forma autónoma, Niveles de Protección para un filtro de Kalman, basándose en hipótesis simples.
El método y dispositivo de la presente invención no depende de una hipótesis restrictiva acerca del comportamiento del ruido de mediciones, este usa los residuos de las mediciones de un tipo dado, en una época dada, para estimar la magnitud de su error típico.
Un primer aspecto de la invención se refiere a un método para computar una cota B hasta un nivel de confianza dado 1 - a, de un error en una estimación de vector de estado de Kalman KSV que es una estimación de un vector de estado TSV (que comprende un conjunto de parámetros) de un sistema físico como es proporcionado por un filtro de Kalman. El filtro de Kalman recibe, del sistema físico, múltiples mediciones sin procesar RMm de diferentes tipos, denotando m cada tipo de medición. El filtro de Kalman también proporciona:
- el número noBs,m de mediciones sin procesar de tipo m;
- una matriz de diseño Hm para mediciones de tipo m;
- una matriz de pesos Wm usada para mediciones de tipo m;
- el vector de residuos ym de las mediciones de tipo m, calculado después de la actualización de mediciones de Kalman;
- una matriz de covarianza P del error realizado en la estimación KSV del vector de estado;
- una matriz de transición F que define la evolución del vector de estado.
En general, con el fin de estimar los parámetros que forman el vector de estado TSV, el vector de estado de Kalman KSV contiene parámetros adicionales que no están en el vector de estado TSV; la cota solo es de aplicación al subconjunto de parámetros de KSV que son una estimación de TSV.
De acuerdo con la invención, el método computa una distribución t Tm para cada tipo de medición m, siendo definida cada distribución t Tm por un escalar Nm y una matriz Rm. Este se obtiene usando un método de ajuste que ajusta Tm a la suma de dos distribuciones t Tm1 y Tm2, modelando la primera distribución t Tm1 los errores introducidos por las mediciones en la época actual y modelando la segunda distribución t Tm2 los errores introducidos por todas las mediciones de épocas previas:
- la primera distribución t Tm1 se corresponde con la proyección en la estimación de vector de estado KSV de los errores de las mediciones de tipo m en la época actual, y es definida por un escalar Nm1 y una matriz Rm1 que se computan como sigue: Nml = nm pN^n lyRml = (rj^KmW^1K ^ ), en donde:
- nm = nOBS,m - tr(Hm Km);
- n i = (ymWmym P ^ n l(r;n)2/Nml;
- Nmirm son los valores de Nm1, rm, respectivamente, en la época previa tk-1;
- @ es un parámetro de sintonía entre 0 y 1, dado como entrada en el método;
- Km = PHTmWm,
- la segunda distribución t Tm2 se corresponde con la proyección en la estimación de vector de estado KSV de los errores de las mediciones de tipo m acumulados en épocas previas, y es definida por un escalar Nm2 y una matriz Rm2 que se computan mediante la propagación del valor previo de Tm como sigue: Nm2 = N^ nyRm2 = (UR!mUT), en donde
- , R^ los valores de Nm, R'm respectivamente, en la época previa tk-1;
- - U = (1 - ZmKmHm) • F.
La cota de error B se computa entonces al:
i) computar una cota de error parcial Bm para cada distribución t Tm y añadir las cotas de error parciales; o, ii) aplicar la etapa previa a un número reducido de distribuciones t obtenidas de las distribuciones t Tm mediante la aplicación del método de ajuste de forma sucesiva a pares de las distribuciones t Tm.
Es decir, la presente invención proporciona un método para computar una cota de error (o Nivel de Protección), hasta un nivel de confianza dado 1 - a, para un subconjunto de los parámetros estimados por un filtro de Kalman. De acuerdo con la invención, el método descompone los errores de la solución de Kalman como una suma de los errores debido a cada de los tipos de medición usados en el filtro. Además, la contribución de cada tipo de medición es, a su vez, la suma de términos de error a partir de todas las épocas procesadas. Entonces, el cómputo de la cota de error es el resultado de tres operaciones principales:
• Computar una distribución de probabilidad de los errores de medición para cada época y tipo de medición.
• Sumar las distribuciones previas para obtener una distribución global que modela el error de la solución de Kalman, preferiblemente teniendo en cuenta las correlaciones temporales de las mediciones como se indica posteriormente.
• Computar las cotas de error para un nivel de confianza dado a partir de la distribución resultante.
En el caso particular de la navegación de GNSS, estos parámetros son preferiblemente las coordenadas de posición, o sus componentes horizontales o verticales; o las componentes horizontales y/o las verticales del error de velocidad.
Las mediciones pueden proceder de diferentes fuentes: en el caso actual, estas pueden ser observaciones de pseudodistancia, Doppler o fase de portadora de GNSS, en el caso de un filtro híbrido, también se procesan las lecturas de los sensores de IMU, aunque estas se aplican en la fase de propagación, y no en la actualización de Kalman.
Con el fin de tener en cuenta las correlaciones temporales de las mediciones, el método comprende adicionalmente:
- computar una matriz de correlación mutua Dm de las dos distribuciones t Tm1 y Tm2 como sigue:
Dm = rmKmW~1/2AmUT
en donde Am es una matriz que tiene una fila para cada medición de tipo m y una columna para cada parámetro de la estimación de vector de estado KSV;
- sustraer un término de corrección computado como tr(pmHmKm) al valor de nm, y,
- computar un nuevo valor de Am para la siguiente época t*+i, como la suma de rm • pm M ^1/2tf£y pmA'mUT, en donde pm es una matriz diagonal cuyas entradas son factores de correlación 0 < (pm)u < 1, y A'm es el valor antiguo de Am.
El método de ajuste que ajusta la suma de dos distribuciones t Tmi y Tm2 a la distribución t Tm comprende preferiblemente calcular los parámetros definitorios Nm y Rm de Tm como sigue:
^m ^ml ^m2;
y,
Nm mediante la resolución numérica de la siguiente ecuación:
Figure imgf000007_0001
en donde:
d es el tamaño o el número de parámetros del vector de estado TSV,
tm i = [W,n.tr(Km,)/tr(S)],' J
t«2 = [tyn2ír (flmz)/tr (S)],/2
tm = [Wmtr(fim)/tr(S )],/2
S = NmlRmi Nm2Rm2 Z
Z = u> (Nlnl Rmi + Nm2Rm2),
siendo w un parámetro de sintonía fina que depende del nivel de confianza 1 - a de interés (w en el rango 1-3 para niveles de confianza pequeños, w~10 para niveles de confianza altos).
En otra realización preferida de la invención, el método de ajuste que ajusta la suma de dos distribuciones t Tm1 y Tm2 a la distribución t Tm comprende calcular los parámetros definitorios Nm y Rm de Tm como sigue:
Figure imgf000007_0002
y,
- Nm = tr(Rm) • K a , a2) + 4a1a2] • [w ( - ^ 4 ^ j - i
mi m2 mi m2
en donde a1 = tr(Rm-\), a2 = tr(Rm2) y w es un parámetro de sintonía fina que depende de la confianza 1 - a de interés; una vez más, w en el rango 1-3 para niveles de confianza pequeños, w~10 para niveles de confianza altos.
En cualquier caso, el parámetro Rm se calcula preferiblemente como sigue: Rm = Rm1
Figure imgf000007_0003
De acuerdo con una realización preferida, una cota de error parcial Bm para una distribución t Tm se puede computar como sigue:
(^0 ^ (^' Nm) • ^m
en donde:
- k(a,Nm) se computa mediante la resolución numérica de la ecuación
Figure imgf000008_0001
- d es el tamaño del vector de estado TSV,
bm = [rm/d ]1/2,
- Tm es la traza de Rm tomada a lo largo de los d parámetros del vector de estado TSV,
- (Nm, Rm) son los parámetros definitorios de la distribución t Tm.
Si el tamaño del vector de estado TSV es 2, k(a, N) se puede computar como
Figure imgf000008_0002
• (a 2/N — 1)1/2.
En una realización particular, las matrices Rm se pueden simplificar a números y obtenerse como:
- Rmi = t i • [tr(KmW~íK l/d ]
- Rm2 = * R'r, , en donde R!m es el valor de Rm en la época previa tk-i.
X = tr(U )/d,
tomándose las trazas a lo largo de los d parámetros del vector de estado TSV; y,
si se consideran las correlaciones temporales, las variables Dm y Am son números, y
- Dm se computa como f i^ 2 • X ■ Am,
- Am se actualiza como la suma de PmR^ y PmA'mX, en donde pm es un factor de correlación 0 < pm < 1 dado como entrada y A'm es el valor antiguo de Am.
En una realización particular, si el filtro de Kalman también proporciona estimaciones de las derivadas temporales del vector de estado TSV, las matrices Rm son matrices 2 x 2 obtenidas de las matrices 2 x 2 Rmi, Rm2-R. = ( P-m,A Mm.C)
ml V-m,C V-m,B
Rm,A rmirPP (^m^m } K l ) / d
Rm,C Y r-’m ntTpv (Rm^m ~íK ll)/d
ftm,B (^m^m ■^m) / ^
trpp es la traza a lo largo de los bloque de la matriz cuyas filas y columnas se corresponden con parámetros de TSV, trvv es la traza a lo largo del bloque de la matriz cuyas filas y columnas se corresponden con derivadas temporales de parámetros de TSV y trpv es la traza a lo largo del bloque de la matriz cuyas filas se corresponden con parámetros de TSV y cuyas columnas se corresponden con derivadas temporales de parámetros de TSV; Rm2 = UR!mUJ, en donde fi' es el valor de Rm en la época previa tk-i;
trPP(U) trPV(U)
U = i
d \ t riv p (U) trvv(U) > y si se consideran las correlaciones temporales, la matriz Dm es una matriz 2 x 2 computada como (um vm) • UT, en donde
los parámetros (um Vm) se computan como la suma de pm (pJlA p.^B) y pm (u'm v'm) pm(u'm v^) UT, en donde pn es un factor de correlación 0 < pm < 1 dado como entrada y (u'm v!m) es el valor antiguo de (um v
En una realización particular, se incluye un tipo de medición adicional para considerar los errores de propagación de Kalman, cuya distribución t Tp se computa usando las siguientes entradas:
- una matriz de diseño Hp que es la identidad;
- una matriz de pesos Wp computada como (Q~)~x • SQX • (Q~)~x, en donde Q‘ es la propagación a la época tk de la matriz de covarianza previa Q' y 5Qi es Q- - FQ'FT;
- el número noBs,p computado como tr(Q-Wp);
- un vector de residuos yp = (xk — Fxk_í ), en donde xkj x^contienen los valores de los parámetros estimados en las épocas tk y tk-i respectivamente.
En una realización particular de la invención, el método tiene la capacidad de añadir información acerca de algunas de las fuentes de error proporcionadas por una interfaz externa, de una forma unificada. Se incluye una distribución t Te adicional, que se refiere a errores en otro conjunto de parámetros q no estimados en el filtro de Kalman pero que afectan a las mediciones. La distribución t Te se computa usando las siguientes entradas:
- una matriz de pesos We proporcionada a través de la interfaz externa;
- una matriz de diseño He computada como W~1'Lm] l lWmHmen donde la suma recorre los tipos de medición m, y Jm es la matriz de diseño del conjunto de q parámetros considerados para mediciones de tipo m;
- el número ne proporcionado a través de la interfaz externa;
- el valor de ye2 como es dado por ne.
Otro aspecto de la invención se refiere a un dispositivo para computar una cota B hasta un nivel de confianza dado 1 - a de un error en la estimación KSV de un vector de estado TSV de un sistema físico como es proporcionado por un filtro de Kalman, recibiendo el filtro de Kalman, del sistema físico, múltiples mediciones sin procesar RMm de diferentes tipos, denotando m cada tipo de medición, proporcionando también el filtro de Kalman:
- el número noBs.m de mediciones sin procesar de tipo m;
- una matriz de diseño Hm para mediciones de tipo m;
- una matriz de pesos Wm usada para mediciones de tipo m;
- el vector de residuos ym de las mediciones de tipo m, calculado después de la actualización de mediciones de Kalman;
- una matriz de covarianza P del error realizado en la estimación KSV del vector de estado;
- una matriz de transición F que define la evolución del vector de estado; y
en donde el dispositivo comprende adicionalmente:
- un módulo de ajuste configurado para ajustar una distribución t Tm a la suma de dos distribuciones t Tmi y Tm2 para cada tipo de medición m, siendo definida cada distribución t Tm por un escalar Nm y una matriz Rm;
- un primer módulo de cálculo LOCAL para recibir las salidas del filtro de Kalman, y para computar la primera distribución t Tmi que se corresponde con la proyección en la estimación de vector de estado KSV de los errores de las mediciones de tipo m en la época actual, siendo definida la primera distribución t Tmi por un escalar Nmi y una matriz Rmi que se computan como sigue: Nmi = nm + PN^1 y Rmi = (rj^KmW7^ íK^l), en donde:
nm = nOBS,m - tr(HmKm);
- N^i, r.m son los valores de Nmi, Rm respectivamente, en la época previa tk-i;
- @ es un parámetro de sintonía entre 0 y 1, dado como una entrada al método;
- Km = PHm Wm;
- un segundo módulo de cálculo PROPAG para recibir las salidas del filtro de Kalman, y para computar la segunda distribución t Tm2 que se corresponde con la proyección en la estimación de vector de estado kSv de los errores de las mediciones de tipo m acumulados en épocas previas, siendo definida la segunda distribución t Tm2 por un escalar Nm2 y una matriz Rm2 que se computan mediante la propagación del valor previo de Tm como sigue: Nm2=N^ y Rm2 = (UR’mUT), en donde
- Nm, R^ son los valores de Nm, Rm respectivamente, en la época previa tk-i;
Figure imgf000009_0001
- un tercer módulo de cálculo configurado para computar la cota de error B al:
i) computar una cota de error parcial Bm, para cada distribución t Tm y añadir las cotas de error parciales; o, ii) aplicar la etapa previa a un número reducido de distribuciones t obtenidas de las distribuciones t Tm mediante la aplicación del método de ajuste de forma sucesiva a pares de distribuciones t Tm.
El dispositivo es preferiblemente un receptor de GNSS.
Los diferentes aspectos y realizaciones de la invención definida en lo anterior se pueden combinar entre sí, siempre que estos sean compatibles entre sí.
Ventajas y características adicionales de la invención se harán evidentes a partir de la descripción detallada que se da a continuación, y se resaltarán en particular en las reivindicaciones adjuntas.
Descripción detallada de las realizaciones preferidas
La presente invención proporciona un método para computar una cota de error (o Nivel de Protección), hasta un nivel de confianza dado 1 - a, para un subconjunto de los parámetros estimados por un filtro de Kalman. En el caso particular de la navegación de GNSS, estos parámetros son las coordenadas de posición, o sus componentes horizontales o verticales. Como se ha definido anteriormente, una cota de error para un nivel de confianza 1 - a es un número positivo B tal que:
P(|<5| > B) < a
en donde |5| es la norma del vector de error de los parámetros bajo consideración.
El método se acopla al filtro de Kalman de la siguiente forma. Después de cada actualización de mediciones, el filtro proporciona una nueva solución de parámetros (por ejemplo, nueva posición y velocidad, más los nuevos valores de los parámetros auxiliares, en el caso de navegación de GNSS). Entonces, el método computa una nueva cota para el subconjunto de parámetros que se están supervisando. Como entrada, este requiere el estado actual del filtro de Kalman. Más concretamente, la entrada consiste en:
- las matrices internas del método de Kalman: matrices de diseño, de pesos, de covarianza y de transición, - la suma cuadrática del vector de residuos para cada tipo de medición.
Por lo tanto, el método es autónomo, debido a que la cota de error se puede computar sin información externa alguna acerca de la naturaleza estadística de los errores de medición.
Los siguientes párrafos describen una forma preferida del método de la presente invención, que proporciona una cota, hasta un nivel de confianza 1 - a, del error en la estimación del vector de estado de un sistema físico, TSV, por medio de un filtro de Kalman con un vector de estado de estimación KSV. Obsérvese que la KSV ha de contener los parámetros de TSV, pero también puede contener parámetros adicionales. Por ejemplo, en la navegación de GNSS, el vector de estado TSV es habitualmente la posición de un receptor de GNSS, mientras que el filtro de Kalman que computa la solución de navegación también incluye la velocidad de receptor y el sesgo y la deriva de reloj de receptor en el vector de estado de estimación KSV.
El método de la presente invención almacena, para cada tipo de medición m, las siguientes variables:
- un escalar Nm y una matriz cuadrada Rm que tiene el mismo tamaño que el vector de estado de Kalman KSV, que define una distribución t para la distribución de error acumulado debido a ese tipo de medición;
- una matriz Am que se usa para computar los efectos de la correlación temporal de mediciones. Las columnas de esta matriz se corresponden con los parámetros del vector de estado de Kalman KSV; cada fila está asociada a una medición que se repite en épocas sucesivas y muestra correlaciones temporales. Por ejemplo, en el caso de la navegación de GNSs , cada fila está asociada a los diferentes satélites que están siendo sometidos a seguimiento por el receptor.
Estas variables se inicializan como Nm = 1, Rm = 0 y Am = 0.
El método tiene dos partes principales, que se repiten en cada época:
- actualizar el valor de las variables anteriormente mencionadas;
- usarlas para computar una nueva cota de error para la solución de Kalman.
En cada época, el filtro de Kalman procesa un nuevo conjunto de mediciones, de diferentes tipos. Como resultado, se produce una nueva solución de los parámetros estimados. Entonces, el método recibe las siguientes entradas del filtro de Kalman:
- la matriz de diseño Hm de cada medición de tipo m en la época tk;
- la matriz de pesos Wm usada en la época tk para cada tipo de medición m;
- la matriz de covarianza P, actualizada con las mediciones de la época tk,
- la matriz de transición determinista F de la época tk-i a la época tk,
- el número noBs.m de mediciones de tipo m en la época tk, y
- la suma cuadrática del vector de residuos ym de cada tipo de medición m en la época tk, calculada después de la actualización de mediciones de Kalman.
La primera operación del método en la época tk es la actualización, para cada tipo de medición, de las variables Nm, Rm y Am. Un elemento importante del mecanismo es la matriz de correlación de mediciones pm. Esta es diagonal, y sus entradas 0 < (pm)u < 1 son los factores de correlación de las diferentes mediciones. Esta es una entrada al método, que o bien viene dada por la configuración o bien es estimada por un método independiente. En muchos casos, tiene sentido usar un único valor 0m que sea de aplicación a todas las mediciones, de tal modo que pm = 0m Id.
El método procede en varias etapas:
1. Computar el valor de las variables locales Nmi, Rmi que modelan los errores de la contribución de las mediciones de tipo m en la época tk, mediante las siguientes reglas:
Figure imgf000011_0001
f nf rnl = r 'm 2 K n Jn Wr 'm ~ i K ,vt Tn
Las variables N¡n l, r^ n contienen los valores de Nmi y rm computados en la época previa. El parámetro de sintonía 0 < @ <1 se da como una entrada al algoritmo. Un valor @ = 0 quiere decir que la caracterización del ruido de mediciones obtenido en la época previa no se usa en la actual. Cuando @ es superior a 0, las estadísticas previas se usan para mejorar la caracterización del ruido de error en la época actual.
2. Computar el valor de las variables locales Nm2, Rm2 que modelan los errores de la contribución de las mediciones previas de tipo m, mediante las siguientes reglas:
Figure imgf000011_0002
Obsérvese que la matriz U también se puede escribir como (1 - KH) F en términos de las matrices de diseño y de peso total H y W, con K = HTW.
3. Computar la matriz de correlación Dm como
Dm = rmKmW~1/2AmUT
4. Computar el valor actualizado de Rm mediante la regla simple:
Rm = Rml Rmz + Dw + D¡„
5. Computar las variables auxiliares tm 1, tm2, mediante el uso de las matrices intermedias Z, S:
Z = <o- (NmlRmi + Nm2Rm2)
s = NmlRmi + Nm2Rm2 + Z
1 = [Nm ltr(/?mI) / í r (S ) ]1' 3
?^n2 = |Nm2tr(ff,n2) / tr (S ) ] ‘ '*
El parámetro w > 1 sintoniza la actualización de Nm, dependiendo del nivel de confianza 1 - a. Para unos niveles de confianza más grandes, este debería ser más alto.
6. Computar el valor actualizado de Nm mediante la resolución numérica de la siguiente ecuación:
Figure imgf000011_0003
en donde la expresión tm representa el valor [Nm tr(Rm)/tr(S)]1/2 y d es el tamaño de TSV, o el número de sus parámetros.
7. Computar el valor actualizado de Am mediante la adición de las siguientes dos matrices:
rmpmW-V2^
PmAmU
La segunda operación del método en la época tk es el cómputo de la cota B(a) para esta época. También consiste en varias etapas:
1. Para cada tipo de medición m, computar la traza trm de la matriz Rm a lo largo de los parámetros de TSV. 2. Para cada tipo de medición m, computar el factor bm como
bm = [trm/df2
Como se ha mencionado anteriormente, d es el tamaño de TSV.
3. Para cada tipo de medición m, computar el factor k(a,Nm) mediante la resolución numérica de la ecuación
2 r 1 ,
B(d/2.Nm/2 )Jk (1 + y*)Wm*<nnay 1 a
4. Para cada tipo de medición m, computar una cota Bm(or) como
Bm (a) = k{a,Nm)' bm
5. Por último, computar la cota total B(a) como la suma de las parciales:
Figure imgf000012_0001
Una vez que se ha presentado el método general, los siguientes párrafos describen una implementación reducida para la navegación de GNSS con mediciones de pseudodistancia y Doppler. En este caso, las matrices Rm son 2x2, incluso si el vector de estado de Kalman es mucho más grande. Las dos componentes se corresponden con los errores de posición y de velocidad, respectivamente. El objetivo es proporcionar cotas para el error de posición horizontal (es decir, d = 2). En este caso específico, el método almacena, para cada tipo de medición m (pseudodistancia y Doppler), las siguientes variables:
- un escalar Nm y una matriz 2 x 2 Rm;
- un par de parámetros (um Vm) que se usan para computar los efectos de la correlación temporal de mediciones. Estas variables se inicializan como Nm = 1, Rm = 0, Um = 0 y Vm = 0.
- El método tiene dos partes principales, que se repiten en cada época:
- actualizar el valor de las variables anteriormente mencionadas;
- usarlas para computar una nueva cota de error para la solución de Kalman.
En cada época, el filtro de Kalman procesa un nuevo conjunto de mediciones de pseudodistancia y Doppler. Como resultado, se produce una nueva solución de los parámetros estimados y, por lo tanto, una nueva posición. El método recibe las mismas entradas del filtro de Kalman que se han mencionado anteriormente, para mediciones de pseudodistancia y Doppler.
La primera operación del método en la época tk es la actualización, para cada tipo de medición, de las variables Nm, Rm y (Um Vm). La matriz de correlación se sustituye en el presente caso con un número 0 < pm < 1, que es una entrada, como anteriormente. El método procede en varias etapas:
1. Computar el valor de las variables locales Nmi, Rmi que modelan los errores de la contribución de las mediciones de tipo m en la época tk, mediante las siguientes reglas:
Figure imgf000012_0002
Figure imgf000013_0001
en donde trpp es la traza a lo largo del bloque de la matriz cuyas filas y columnas se corresponden con parámetros de posición horizontal, trvv es la traza a lo largo del bloque de la matriz cuyas filas y columnas se corresponden con parámetros de velocidad horizontal y trpv es la traza a lo largo del bloque de la matriz cuyas filas se corresponden con parámetros de posición horizontal y cuyas columnas se corresponden con parámetros de velocidad horizontal.
2. Computar el valor de las variables locales Nm2, Rm2 que modelan los errores de la contribución de las mediciones previas de tipo m, mediante las siguientes reglas:
Nm2 = Nm
Figure imgf000013_0002
3. Computar la matriz de correlación Dm como
Figure imgf000013_0003
4. Computar el valor actualizado de Rm mediante la regla simple:
«m = « .n i «m 2 D,„ K
5. Computar las variables auxiliares tm1, tm2, mediante el uso de las matrices intermedias Z, S:
Figure imgf000013_0004
6. Computar el valor actualizado de Nm mediante la resolución numérica de la siguiente ecuación;
Figure imgf000013_0005
en donde la expresión tm representa el valor [Nmtr(Rm)/tr(S)]1/2.
7. Computar el valor actualizado de (um Vm) mediante la adición de las siguientes dos matrices;
Pm {PtnA Rmji)
Figure imgf000013_0006
La segunda operación del método en la época tk es el cómputo de la cota B(a) para esta época. También consiste en varias etapas:
1. Para cada tipo de medición m, computar el factor k(a,Nm) como
2. Para cada tipo de medición m, computar una cota Bm(a) como
Bm(a) = k(a,Nm)(Rm)1[2
3. Por último, computar la cota total B(a) como la suma de las parciales:
Figure imgf000014_0001
En este documento, el término "comprende" y sus derivaciones (tales como "comprendiendo / que comprende", etc.) no se deberían entender en un sentido excluyente, es decir, no se debería interpretar que estos términos excluyan la posibilidad de que lo que se describe y define pueda incluir elementos, etapas, etc., adicionales.
Por otro lado, obviamente la invención no se limita a la realización o realizaciones específicas descritas en el presente documento, sino que también abarca toda variación que pueda ser considerada por cualquier experto en la materia (por ejemplo, en lo que respecta a la elección de materiales, dimensiones, componentes, configuración, etc.), dentro del alcance general de la invención como se ha definido en las reivindicaciones.

Claims (15)

REIVINDICACIONES
1. Método para computar una cota B hasta un nivel de confianza dado 1 - a, de un error en una estimación de vector de estado, KSV, de un vector de estado, TSV, de un sistema físico tal como es proporcionado por un filtro de Kalman, recibiendo el filtro de Kalman, del sistema físico, múltiples mediciones sin procesar RMm de diferentes tipos, denotando m cada tipo de medición, proporcionando también el filtro de Kalman:
- el número noBs,m de mediciones sin procesar de tipo m;
- una matriz de diseño Hm para mediciones de tipo m;
- una matriz de pesos Wm usada para mediciones de tipo m;
- el vector de residuos ym de las mediciones de tipo m, computado después de la actualización de mediciones de Kalman;
- una matriz de covarianza P del error realizado en la estimación KSV del vector de estado; y
- una matriz de transición F que define la evolución del vector de estado;
en donde el método comprende las etapas de:
- computar una distribución t Tm para cada tipo de medición m, estando definida cada distribución t Tm por un escalar Nm y una matriz Rm, distribución t que se obtiene usando un método de ajuste que ajusta la distribución t Tm a la suma de dos distribuciones t Tmi y Tm2,
- correspondiéndose la primera distribución t Tmi con la proyección sobre la estimación del vector de estado, KSV, de los errores de las mediciones de tipo m en la época actual, y estando definida por un escalar Nmi y una matriz Rmi que se computan como sigue: Nmi = nm + pN^nl y Rmi = (r£KmW^Km), en donde:
-nm = nOBS,m - tr(HmKm);
-m = (ymWmym P ^n1(r;n)2/Nml;
- ^Ci, son los valores de Nmi, rm, respectivamente, en la época previa tk-i;
- @ es un parámetro de sintonía entre 0 y 1, dado como una entrada al método;
- Km = PHTm Wm;
- correspondiéndose la segunda distribución t Tm2 con la proyección sobre la estimación del vector de estado, KSV, de los errores de las mediciones de tipo m acumulados en épocas previas, y estando definida por un escalar Nm2 y una matriz Rm2 que se computan mediante la propagación del valor previo de Tm como sigue: Nm2=N^ y Rm2 = (UR'mUT), en donde
Figure imgf000015_0001
son los valores de Nm, R'm, respectivamente, en la época previa tk-i;
Figure imgf000015_0002
- computar la cota de error B al:
i) computar una cota de error parcial Bm para cada distribución t Tm y añadir las cotas de error parciales; o, ii) aplicar la etapa previa a un número reducido de distribuciones t obtenidas de las distribuciones t Tm mediante la aplicación del método de ajuste de forma sucesiva a pares de distribuciones t Tm.
2. Método de acuerdo con la reivindicación 1, en donde el método comprende adicionalmente:
- computar una matriz de correlación mutua Dm de las dos distribuciones t Tm1 y Tm2 como sigue:
Dm = rmKmWm1/2AmUT
en donde Am es una matriz que tiene una fila para cada medición de tipo m y una columna para cada parámetro de la estimación del vector de estado, KSV;
- sustraer un término de corrección computado como tr(pmHmKm) al valor de nm; y,
- computar un nuevo valor de Am para la siguiente época tk+1 como la suma de rm pmW^ l 1/2Km y PmA'mUT, en donde pm es una matriz diagonal cuyas entradas son factores de correlación 0 < (pm)u < 1, y A'm es el valor antiguo de Am.
3. Método de acuerdo con cualquiera de las reivindicaciones 1-2, en donde el método de ajuste que ajusta la suma de dos distribuciones t Tm1 y Tm2 a la distribución t Tm comprende calcular los parámetros definitorios Nm y Rm de Tm como sigue:
Rm = Rm1 + Rm2
y
Nm mediante la resolución numérica de la siguiente ecuación:
Figure imgf000016_0001
en donde:
d es el tamaño del vector de estado, TSV,
*mi = [Nmitr(R ml)/tr(S )]1' 2
Figure imgf000016_0002
siendo w un parámetro de sintonía fina que depende del nivel de confianza 1 - a
4. Método de acuerdo con cualquiera de las reivindicaciones 1-2, en donde el método de ajuste que ajusta la suma de dos distribuciones t Tmi y Tm2 a la distribución t Tm comprende calcular los parámetros definitorios Nm y Rm de Tm como sigue:
- Rm = Rm1 Rm2i
Figure imgf000016_0003
donde ai = tr(Rmi), a2 = tr(Rm2) y w es un parámetro de sintonía fina que depende del nivel de confianza 1 - a.
5. Método de acuerdo con cualquiera de las reivindicaciones 3 o 4 cuando dependen de la reivindicación 2, en donde el parámetro Rm se calcula como sigue: Rm =Rmi Rm2 Dm D£.
6. Método de acuerdo con cualquiera de las reivindicaciones 1-5, en donde una cota de error parcial Bm para una distribución t Tm se computa como sigue:
Bm(a) = k(a,Nm)-bm
en donde:
- k(a, Nm) se computa mediante la resolución numérica de la ecuación
2 r~ y4 x
S(d/2.Nm/2)J* (1 + yt)U ',**way ~ 1 °
- d es el tamaño o el número de parámetros del vector de estado TSV,
- bm = [Tm/d]V2,
- Tm es la traza de Rm tomada a lo largo de los d parámetros del vector de estado, TSV,
- siendo (Nm, Rm) los parámetros definitorios de la distribución t Tm.7
7. Método de acuerdo con la reivindicación 6, en donde si el tamaño del vector de estado, TSV, es 2, k(a,N) se computa como N ^ 2 (a'z/N - 1)1/2.
8. Método de acuerdo con cualquier reivindicación anterior, en donde las matrices Rm se pueden simplificar a números y obtenerse como:
- Rmi = r^ [tiiK mW~1K^)/d]
- Rm2 = P-fim, en donde R!m es el valor de Rm en la época previa tk-i.
- A = tr(U)/d, tomándose las trazas a lo largo de los d parámetros del vector de estado, TSV; y, si se consideran las correlaciones temporales, las variables Dm y Am son números, y
- Dm se computa como A Am,
- Am se actualiza como la suma de PmR^l y PmA'mA, en donde pm es un factor de correlación 0 < pm < 1 dado como entrada y A'm es el valor antiguo de Am.
9. Método de acuerdo con cualquier reivindicación anterior, en donde si el filtro de Kalman también proporciona estimaciones de las derivadas temporales del vector de estado TSV, las matrices Rm son matrices 2 x 2 obtenidas de las matrices 2 x 2 Rmi, Rm¿
p _ /Rm,A Rm,C \
- Rm1 = Urn,C Rm,B)
- Rm,A =r£trpp{KmW^1K l^ )/d
- Rm,c =r£ trpv(KmW^1K l^ )/d
- Rm,B =r£trw{KmWr^ 1K^)/d
- trpp es la traza a lo largo del bloque de la matriz cuyas filas y columnas se corresponden con parámetros de TSV, trw es la traza a lo largo del bloque de la matriz cuyas filas y columnas se corresponden con derivadas temporales de parámetros de TSV y trpv es la traza a lo largo del bloque de la matriz cuyas filas se corresponden con parámetros de TSV y cuyas columnas se corresponden con derivadas temporales de parámetros de TSV. ■ Rm2 = UR^Ut en donde R!m es el valor de Rm en la época previa tk-i;
(trPP(U) trPV(U)>
U = -d (' \tTyp y si se consideran las correlaciones temporales, la matriz Dm es una matriz 2 x 2 (U) tTyy(U'))
computada como / ( V /2\ ) • (um vm) • UT, en donde los parámetros (um Vm) se computan como la suma de W , b/
Pm ( p l i \ pHi 'b') y Pm'(umvm)'d T, en donde pm es un factor de correlación 0 < pm <1 dado como entrada y (u'm v!m) es el valor antiguo de (um Vm).
10. Método de acuerdo con cualquier reivindicación anterior, en donde se incluye un tipo de medición adicional para considerar los errores de propagación de filtro de Kalman, cuya distribución t Tp se computa usando las siguientes entradas:
- una matriz de diseño Hp que es la identidad;
- una matriz de pesos Wp computada como (Q')'1-5Qi (Q')'i , en donde Q- es la propagación a la época t* de la matriz de covarianza previa Q 'y 5Qi, es Q' - FQ’FT;
- el número nOBS,p computado como tr(Q-Wp);
- un vector de residuos yp = (x* - Fx*-i), en donde xk, x*-1 contienen los valores de los parámetros estimados en las épocas t* y tk-i respectivamente.
11. Método de acuerdo con cualquier reivindicación anterior, en donde se incluye un tipo de medición adicional para considerar errores en otro conjunto de parámetros q no estimados en el filtro de Kalman pero que afectan a las mediciones, cuya distribución t Te se computa usando las siguientes entradas:
- una matriz de pesos We proporcionada por una interfaz externa;
- una matriz de diseño He computada como We~1I mJ llWmHm, en donde la suma recorre los tipos de medición m, y Jm es la matriz de diseño del conjunto de q parámetros considerados para mediciones de tipo m;
- el número ne proporcionado por una interfaz externa;
- el valor de ye2 como es dado por ne.
12. Método de acuerdo con cualquier reivindicación previa, en donde el filtro de Kalman se usa para estimar una solución de navegación de GNSS, siendo los parámetros a acotar las componentes horizontales del error de posición, y en donde los tipos de medición m son dos o más de mediciones de pseudodistancia, mediciones Doppler, mediciones de fase de portadora.
13. Método de acuerdo con cualquiera de las reivindicaciones 11-12, en donde las componentes a acotar son las componentes verticales del error de posición y/o las componentes horizontales y/o las verticales del error de velocidad.
14. Dispositivo para computar una cota B hasta un nivel de confianza dado 1 - a, de un error en la estimación, KSV, de un vector de estado, TSV, de un sistema físico tal como es proporcionado por un filtro de Kalman, recibiendo el filtro de Kalman, del sistema físico, múltiples mediciones sin procesar RMm de diferentes tipos, denotando m cada tipo de medición, proporcionando también el filtro de Kalman:
- el número noBs,m de mediciones sin procesar de tipo m;
- una matriz de diseño Hm para mediciones de tipo m;
- una matriz de pesos Wm usada para mediciones de tipo m;
- el vector de residuos ym de las mediciones de tipo m, calculado después de la actualización de mediciones de Kalman;
- una matriz de covarianza P del error realizado en la estimación KSV del vector de estado;
- una matriz de transición F que define la evolución del vector de estado; y
en donde el dispositivo comprende adicionalmente:
- un módulo de ajuste configurado para ajustar una distribución t Tm a la suma de dos distribuciones t Tmi y Tm2 para cada tipo de medición m, estando definida cada distribución t Tm por un escalar Nm y una matriz Rm;
- un primer módulo de cálculo LOCAL para recibir las salidas del filtro de Kalman, y para computar la primera distribución t Tmi que se corresponde con la proyección en la estimación del vector de estado, KSV, de los errores de las mediciones de tipo m en la época actual, estando definida la primera distribución t Tmi por un escalar Nmi y una matriz Rmi que se computan como sigue: Nmí = n m N!mí y Rml = (rj^KmWr^ 1K l^ ), en donde:
-nm = nOBS,m - tr(Hm Km);
- = Cym^mym /^ml;
- ^Ci, son los valores de Nmí, rm, respectivamente, en la época previa tk-i;
- @ es un parámetro de sintonía entre 0 y 1, dado como una entrada al método;
- Km = PH^ Wm;
- un segundo módulo de cálculo PROPAG para recibir las salidas del filtro de Kalman, y para computar la segunda distribución t Tm2 que se corresponde con la proyección en la estimación del vector de estado, KSV, de los errores de las mediciones de tipo m acumulados en épocas previas, estando definida la segunda distribución t Tm2 por un escalar Nm2 y una matriz Rm2 que se computan mediante la propagación del valor previo de Tm como sigue: Nm2 = y Rm2 = (U fi^UT), en donde
- Nm, R'm son los valores de Nm, R'm respectivamente, en la época previa tk-i;
Figure imgf000018_0001
- un tercer módulo de cálculo configurado para computar la cota de error B al:
i) computar una cota de error parcial Bm para cada distribución t Tm y añadir las cotas de error parciales; o, ii) aplicar la etapa previa a un número reducido de distribuciones t obtenidas de las distribuciones t Tm mediante la aplicación del método de ajuste de forma sucesiva a pares de distribuciones t Tm.
15. Dispositivo de acuerdo con la reivindicación 14, en donde el dispositivo es un receptor de GNSS.
ES14189240T 2014-10-16 2014-10-16 Método para computar una cota de error de una solución de posición de GNSS basada en filtro de Kalman Active ES2776723T3 (es)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
EP14189240.6A EP3009860B1 (en) 2014-10-16 2014-10-16 Method for computing an error bound of a Kalman filter based GNSS position solution

Publications (1)

Publication Number Publication Date
ES2776723T3 true ES2776723T3 (es) 2020-07-31

Family

ID=51703102

Family Applications (1)

Application Number Title Priority Date Filing Date
ES14189240T Active ES2776723T3 (es) 2014-10-16 2014-10-16 Método para computar una cota de error de una solución de posición de GNSS basada en filtro de Kalman

Country Status (5)

Country Link
US (1) US10254412B2 (es)
EP (1) EP3009860B1 (es)
ES (1) ES2776723T3 (es)
PL (1) PL3009860T3 (es)
PT (1) PT3009860T (es)

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106441291B (zh) * 2016-09-27 2019-06-21 北京理工大学 一种基于强跟踪sdre滤波的组合导航系统及导航方法
EP3336584B1 (en) * 2016-12-19 2020-11-04 Trimble Inc. Outlier-tolerant navigation satellite system positioning method and system
JP6855580B2 (ja) * 2016-12-30 2021-04-07 ユー−ブロックス、アクチエンゲゼルシャフトu−blox AG Gnss受信機保護レベル
CN107728171B (zh) * 2017-09-05 2020-10-23 西南交通大学 基于粒子滤波的gnss相位系统间偏差实时追踪和精密估计方法
KR102450580B1 (ko) 2017-12-22 2022-10-07 삼성전자주식회사 금속 배선 하부의 절연층 구조를 갖는 반도체 장치
FR3076354B1 (fr) * 2017-12-28 2019-11-22 Thales Procede de controle de l'integralite de l'estimation de la position d'un porteur mobile dans un systeme de mesure de positionnement par satellite
US10976444B2 (en) * 2018-03-28 2021-04-13 Mitsubishi Electric Research Laboratories, Inc. System and method for GNSS ambiguity resolution
CN109308518B (zh) * 2018-09-13 2021-09-10 北京理工大学 一种基于概率神经网络的监测系统及其平滑参数优化方法
CN109474892B (zh) * 2018-11-05 2020-07-10 浙江工商大学 基于信息形式的强鲁棒传感器网络目标跟踪方法
CN109901204B (zh) * 2019-03-27 2020-12-04 北京航空航天大学 一种基于伪距误差分布模型的gbas完好性性能评估方法
CN110174683B (zh) * 2019-05-17 2022-12-23 中国民航大学 基于贝叶斯决策的gbas保护级完好性风险分配方法
CN110516197B (zh) * 2019-07-02 2021-10-19 东南大学 一种单位权中误差约束下的分段定权参数估计方法
US20220080991A1 (en) * 2020-09-11 2022-03-17 Beijing Wodong Tianjun Information Technology Co., Ltd. System and method for reducing uncertainty in estimating autonomous vehicle dynamics
CN112433236B (zh) * 2021-01-27 2021-05-18 腾讯科技(深圳)有限公司 误差模型标定方法、装置、设备及计算机可读存储介质
CN112926190B (zh) * 2021-01-28 2024-04-16 东南大学 一种基于vmd算法的多路径削弱方法与装置
CN114018250B (zh) * 2021-10-18 2024-05-03 杭州鸿泉物联网技术股份有限公司 惯性导航方法、电子设备、存储介质和计算机程序产品
CN114562982B (zh) * 2022-03-09 2023-09-26 北京市遥感信息研究所 一种光学和sar异源卫星影像联合平差的定权方法和装置
CN115408652B (zh) * 2022-10-31 2023-02-03 北京航空航天大学 一种基于截断误差估计的ekf组合导航保护级确定方法

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6424914B1 (en) * 2000-12-26 2002-07-23 American Gnc Corporation Fully-coupled vehicle positioning method and system thereof
US7219013B1 (en) * 2003-07-31 2007-05-15 Rockwell Collins, Inc. Method and system for fault detection and exclusion for multi-sensor navigation systems
US7769543B2 (en) * 2007-04-30 2010-08-03 The Boeing Company Fault detection and reconfiguration of an automated refueling boom
US20090182495A1 (en) * 2008-01-15 2009-07-16 Honeywell International, Inc. Navigation system with apparatus for detecting accuracy failures
ATE477508T1 (de) 2008-04-30 2010-08-15 Gmv Aerospace And Defence S A Verfahren für autonome bestimmung von sicherheitsebenen für gnss-positionierung auf basis von navigationsanpassungsfehlern und isotroper konfidenzrate

Also Published As

Publication number Publication date
EP3009860A1 (en) 2016-04-20
EP3009860B1 (en) 2019-12-18
PT3009860T (pt) 2020-03-23
PL3009860T3 (pl) 2020-06-29
US20160109579A1 (en) 2016-04-21
US10254412B2 (en) 2019-04-09

Similar Documents

Publication Publication Date Title
ES2776723T3 (es) Método para computar una cota de error de una solución de posición de GNSS basada en filtro de Kalman
Godha Performance evaluation of low cost MEMS-based IMU integrated with GPS for land vehicle navigation application
CN104181574B (zh) 一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法
EP3043148B1 (en) Heading for a hybrid navigation solution based on magnetically calibrated measurements
Won et al. Selective integration of GNSS, vision sensor, and INS using weighted DOP under GNSS-challenged environments
CN101395443B (zh) 混合定位方法和设备
Wang et al. Quadratic extended Kalman filter approach for GPS/INS integration
Giremus et al. A Rao-Blackwellized particle filter for INS/GPS integration
CN102221365A (zh) 用于确定惯性导航系统故障的系统和方法
CN102998685A (zh) 一种惯性/卫星导航系统伪距/伪距率紧组合方法
Falco et al. Low-cost real-time tightly-coupled GNSS/INS navigation system based on carrier phase double differences for UAV applications
Lee et al. An integer ambiguity resolution procedure for GPS/pseudolite/INS integration
Oh et al. Attitude determination GPS/INS integration system design using triple difference technique
Langel et al. Tightly coupled GPS/INS integration for differential carrier phase navigation systems using decentralized estimation
Mahmoud et al. Integrated INS/GPS navigation system
Carlson Mapping large, urban environments with gps-aided slam
Kim et al. A complete GPS/INS integration technique using GPS carrier phase measurements
Ding Optimal integration of GPS with inertial sensors: Modelling and implementation
Scherzinger Robust positioning with single frequency inertially aided RTK
Traugott et al. A time-relative approach for precise positioning with a miniaturized L1 GPS logger
Amt Methods for aiding height determination in pseudolite-based reference systems using batch least-squares estimation
Krawinkel et al. On the potential of receiver clock modeling in kinematic precise point positioning
Traugott et al. Conceptual approach for precise relative positioning with miniaturized GPS loggers and experimental results
Iqbal et al. Enhancing kalman filtering–based tightly coupled navigation solution through remedial estimates for pseudorange measurements using parallel cascade identification
Zhou et al. A New Integration method for MEMS based GNSS/INS Multi-sensor systems