ES2810925T3 - Procedimiento y sistema de geolocalización para el cálculo directo de elementos de desplazamiento - Google Patents

Procedimiento y sistema de geolocalización para el cálculo directo de elementos de desplazamiento Download PDF

Info

Publication number
ES2810925T3
ES2810925T3 ES17748459T ES17748459T ES2810925T3 ES 2810925 T3 ES2810925 T3 ES 2810925T3 ES 17748459 T ES17748459 T ES 17748459T ES 17748459 T ES17748459 T ES 17748459T ES 2810925 T3 ES2810925 T3 ES 2810925T3
Authority
ES
Spain
Prior art keywords
coordinates
objects
ranging
anchor
displacement
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
ES17748459T
Other languages
English (en)
Inventor
Alain Lemer
Frédérique Ywanne
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.)
Thales SA
Original Assignee
Thales 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 Thales SA filed Critical Thales SA
Application granted granted Critical
Publication of ES2810925T3 publication Critical patent/ES2810925T3/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
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0284Relative positioning
    • G01S5/0289Relative positioning of multiple transceivers, e.g. in ad hoc networks
    • 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
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0252Radio frequency fingerprinting
    • G01S5/02521Radio frequency fingerprinting using a radio-map
    • G01S5/02524Creating or updating the radio-map
    • G01S5/02525Gathering the radio frequency fingerprints
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/18Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Data Mining & Analysis (AREA)
  • Mathematical Optimization (AREA)
  • Theoretical Computer Science (AREA)
  • Mathematical Physics (AREA)
  • Computational Mathematics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mathematical Analysis (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Operations Research (AREA)
  • Probability & Statistics with Applications (AREA)
  • Evolutionary Biology (AREA)
  • Algebra (AREA)
  • Bioinformatics & Computational Biology (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Bioinformatics & Cheminformatics (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

Procedimiento para determinar la posición de uno o varios objetos susceptibles de desplazarse en una red, estando dotados uno o varios objetos de una capacidad de medida de distancia a los otros objetos de la red, al menos una parte de las coordenadas de un objeto es conocida, caracterizado porque comprende al menos las etapas siguientes: - Definir un conjunto de puntos Ai o anclas y las incertidumbres asociadas a sus coordenadas, describiendo las coordenadas de anclas y la incertidumbre sobre las coordenadas informaciones sobre la posición de los objetos y la incertidumbre sobre estas informaciones, - Generar un conjunto que contiene las posiciones estimadas de los objetos y definir una posición inicial de los puntos, - Medir un conjunto de distancias entre al menos dos objetos Mi, Mj, con incertidumbres asociadas y ejecutar las etapas siguientes: - Etapa 1, para cada obj eto Mi, calcular el desplazamiento **(Ver fórmula)**correspondiente a la suma vectorial de los desplazamientos de medida o ranging sobre el conjunto de medidas de ranging disponibles hacia el objeto Mi e inducidas sobre este objeto Mi por la totalidad de otros objetos que disponen de una medida de ranging a partir de dicho objeto Mi, debidos a la medida rij de ranging relativa entre Mi y Mj y su incertidumbre σrij con Ri = {rij} el conjunto de medidas de ranging disponibles hacia Mi, y **(Ver fórmula)**donde **(Ver fórmula)**con Δij las coordenadas de MjMi, Φ es una función de desplazamiento dada, - Etapa 2, (302), para cada objeto Mi que posee una coordenada de anclaje en un ancla Ai virtual asociado, calcular un valor de desplazamiento de retorno**(Ver fórmula)** hacia este ancla con **(Ver fórmula)** , Ψ una función de desplazamiento, - Etapa 3, (303), a cada objeto Mi aplicar un desplazamiento igual a la suma del desplazamiento del ranging**(Ver fórmula)** y de la corrección **(Ver fórmula)**de anclaje calculados anteriormente, - Etapa 4, (304), calcular el cuadrado del término de error**(Ver fórmula)** donde con **(Ver fórmula)** es un término de error entre la estimación de la distancia d(Mi, Mj) después del desplazamiento del objeto en la etapa 3 y la medida de la distancia rij proporcionada por los dispositivos de ranging sobre el conjunto de nodos, comparar esta cantidad con un criterio de corte definido por adelantado por un operador, si **(Ver fórmula)**o bien max(|Δij|) < separaciónMáx, si esta prueba se cumple, ir a la etapa 6, - Si no, Etapa 5, (305), comprobar si se alcanza un número máximo de iteraciones, si l < lmáx entonces iterar I = I + 1 e ir a la etapa 1, si no ir a la etapa 6, - Etapa 6, (306), fin de las iteraciones, definir la posición de objetos correspondiente a la mejor estimación de la posición real de los objetos obtenida para cada objeto.

Description

DESCRIPCIÓN
Procedimiento y sistema de geolocalización para el cálculo directo de elementos de desplazamiento
La invención se refiere a un procedimiento y a un sistema que permiten la geolocalización de uno o de varios objetos a partir de medidas de distancia obtenidas por una función de medida de distancias entre nodos conocida bajo el término anglosajón “ranging" y de posiciones de anclas imprecisas, para el cálculo directo de elementos de desplazamiento. El procedimiento permite por tanto determinar la posición de un objeto sobre un mapa, sobre un plano, en una referencia dada con la ayuda de sus coordenadas geográficas, latitud/longitud u otras coordenadas.
La determinación de la posición de un objeto del cual se conocen las distancias a otros objetos de posiciones conocidas es un tema clásico en el campo de la localización. En general, se utilizan estaciones de detección cuya posición es perfectamente conocida o “anclas”. En este caso, la incertidumbre del resultado de la posición reside principalmente en la precisión de las medidas de las distancias denominadas más adelante “ranging’’.
Otro enfoque posible consiste en determinar el posicionamiento relativo de los nodos de una red de estaciones, sobre la única base de información es de distancias relativas entre todos o parte de estos nodos. El conocimiento preciso de un número limitado de informaciones a priori de las posiciones sobre ciertos nodos permite por tanto determinar la posición absoluta del conjunto de los nodos de la red. Sin embargo, deben superarse varios obstáculos, por ejemplo:
• El conjunto de las medidas de distancias entre los nodos no es forzosamente accesible, debido al alcance de los módulos de ranging,
Las medidas de distancias están necesariamente contaminadas de errores que hacen que la resolución geométrica sea potencialmente sobredeterminada,
• Las informaciones necesarias para el posicionamiento absoluto pueden distribuirse sobre las coordenadas de varios nodos,
• Finalmente, las informaciones necesarias para el posicionamiento absoluto pueden, del mismo modo, estar contaminadas de errores, potencialmente más importantes que los asociados al ranging.
Este último punto es particularmente importante en la práctica, en especial en navegación colaborativa. De hecho, la información de posicionamiento absoluto de ciertos nodos es a menudo obtenida por receptores del sistema de posicionamiento por satélite conocidos bajo la abreviatura GNSS comerciales (Global Navigation Satellite System), cuyo error de posicionamiento puede, en condiciones de recepción difíciles, exceder ampliamente los errores de las medidas de distancia (ranging) entre nodos. Ignorar esta situación puede por tanto conducir a errores de posicionamiento de los nodos libres, incluso a rechazar medidas de ranging válidas, pero incompatibles con las distancias calculadas a partir de las posiciones absolutas supuestas sin errores.
Uno de los problemas técnicos planteado es encontrar una solución eficaz de cálculo de las posiciones de nodos, con el fin de que una métrica de las separaciones entre las medidas de ranging y las distancias entre nodos de la solución sean mínimas y teniendo en cuenta la incertidumbre asociada a los errores de ranging y a los errores de posicionamiento absoluto.
La técnica anterior describe principalmente dos enfoques para tratar este problema.
Un primer enfoque consiste en reconstruir una geometría relativa de los nodos de una red a partir de informaciones de ranging y, posiblemente, de informaciones angulares entre nodos, por ejemplo por geometría en el seno de un nodo. Estos métodos son generalmente reagrupados bajo el término de “localización sin ancla” o en anglosajón “Anchor Free Localization". En este enfoque, que utiliza únicamente las medidas de ranging, todas las posiciones de los nodos son libres, a priori, y los métodos buscan ajustar las mismas de manera que el error cuadrático medio entre las distancias calculadas entre nodos y las medidas de ranging sean mínimos. Se han propuesto algoritmos muy numerosos, desde el simple algoritmo de tipo muelle de masa, o “mass-spring" a técnicas de optimización más complejas, por ejemplo, la resolución de mínimos cuadrados por Newton-Raphson, el filtrado particular, etc. Lo esencial de las variantes de este enfoque se fija en evitar la convergencia hacia un mínimo local sin, sin embargo, garantizarlo.
Un segundo enfoque contempla reconstruir la posición absoluta de los nodos de la red a partir de informaciones de ranging a través del conocimiento a priori de la posición de ciertos entre sí, denominados “anclas”. Se trata igualmente de minimizar la separación cuadrática media entre la distancia entre las posiciones de los nodos y las medidas de ranging, siendo ciertas posiciones a priori fijas y conocidas. El problema es por tanto un problema de minimización de una función de coordenadas de nodos libres, por ejemplo a través de un algoritmo de tipo de mayor pendiente o en anglosajón “steepest descent". El artículo “Anchor-Based Three-Dimensional Localization Using Range Measurements", Wang, Yue y otros, ilustra este enfoque que no garantiza sin embargo el logro de un óptimo global. Trabajos más teóricos proponen métodos de optimización global.
Un tercer enfoque utiliza fuentes o anclas externos de posiciones no conocidas. El problema es conocido bajo el término “auto calibración” en el cual se busca localizar de forma conjunta las fuentes y los sensores que las detectan. Se utilizan diferencias de tiempo de llegada o TDOA, lo que da una información menos rica que una medida directa de ranging, asimilable a un tiempo de llegada o TOA (abreviado anglosajón de “ Time Of Arrivai’", y que no aprovecha informaciones a priori sobre las posiciones de las fuentes. El artículo “Calibration-Free TDOA Self-Localization, Wendeberg Johannes y otros, in Journal of Location Based Services, May 2013’ ilustra una implementación posible de este enfoque a través de varios algoritmos clásicos, de tipo mass-spring, de gradiente descendente, de Gauss-Newton...) o más específicos “algoritmo de “Cone alignment"), siendo conocidos estos algoritmos por el experto en la materia.
Uno de los inconvenientes de la técnica anterior es que se supone:
• O bien que todas las posiciones de los sensores son libres, sólo entregando una geometría del conjunto de los nodos potencialmente precisa, pero de coordenadas relativas de los nodos entre sí,
• O bien que la determinación de la posición absoluta de los nodos se basa en el conocimiento externo de la posición de ciertos entre sí cuya exactitud se supone perfecta.
A priori, la técnica anterior no trata de la integración conjunta de la incertidumbre sobre la posición de anclas y, de la posible reconsideración de estas posiciones.
El artículo “Effective error control o f iterative localization for wireless sensor networks" Wu, Xiaoping y otros, describe un procedimiento de control de error para prevenir errores de propagación y de acumulación en un procedimiento de localización considerando los errores de posición de nodos y los errores de medida.
La figura 1 ilustra los problemas no resueltos por la técnica anterior. En este ejemplo, las coordenadas de los anclas asociadas a los nodos Mi y M2 se supone que son accesibles de manera ideal, es decir sin error, por ejemplo gracias a estudios topográficos, mientras que las coordenadas del ancla M3 están en la práctica contaminadas por un error d3, por ejemplo medido por un sistema GNSS, posicionando el ancla M3 en el punto M'3. Otra hipótesis de esta ilustración es que la precisión de ranging es perfecta, en la práctica muy inferior a d3. Las medidas de ranging son representadas por flechas en la figura 1. Las técnicas de la técnica anterior estiman de forma incorrecta la posición del nodo libre en M'4, distribuyendo la posición real del nodo libre M4 los errores de ranging asociados a este nodo, lo que resulta en un mínimo de error cuadrático medio residual importante. Además, la posición del nodo M3 no se reconsidera y permanece errónea.
El procedimiento según la invención va, en especial, a aprovechar el conjunto de incertidumbres de las medidas de ranging y de las posiciones de anclas, lo que permite, en especial, modificar la posición de los anclas, con el fin de resultar en un error cuadrático mínimo sobre las medidas de ranging. El resultado de la implementación del procedimiento según la invención permitirá la obtención precisa de la posición de un objeto en un espacio dado.
La invención se refiere a un procedimiento para determinar la posición de uno o varios objetos susceptibles de desplazarse en una red, estando dotado cada objeto de una capacidad de medida de distancia a otros nodos de la red, siendo conocida al menos una parte de las coordenadas de un objeto, caracterizado porque comprende al menos las etapas siguientes:
Definir un conjunto de puntos Ai o anclas y las incertidumbres asociadas a sus coordenadas, describiendo las coordenadas de los anclas y la incertidumbre sobre las coordenadas informaciones sobre la posición de los objetos y la incertidumbre sobre estas informaciones,
Generar un conjunto que contiene las posiciones estimadas de los objetos y definir una posición inicial de los puntos,
Medir un conjunto de distancia entre al menos dos objetos Mi, Mj, con incertidumbres asociadas, y ejecutar las etapas siguientes:
Figure imgf000003_0001
• Etapa 1, para cada objeto M¡, calcular el desplazamiento correspondiente a la suma vectorial de los desplazamientos de medida o ranging sobre el conjunto de medidas de ranging disponibles hacia el objeto Mi e inducidas sobre este objeto Mi por la totalidad de otros objetos que disponen de una medida de ranging a partir de dicho objeto M¡, debidos a la medida r¡¡ de ranging relativa entre y y su incertidumbre
Orij con R¡ = {nj} el conjunto de medidas de ranging disponibles hacia Mi, y j<=R; donde sJ —*I = <p t ( \a I .J ,0 rij ' M ’M‘
I con Aij las coordenadas de M¡M¡, 9 es una función de desplazamiento dada, Etapa 2, para cada objeto que posee una coordenada de anclaje en un ancla A virtual asociado, calcular un valor de desplazamiento de retorno a-w hacia este ancla con ~ ^ ^ f ^ i + />% ) ^ una función de desplazamiento,
Etapa 3, a cada objeto aplicar un desplazamiento igual a la suma del desplazamiento del ranging Ó c y de la corrección a-w de anclaje calculados anteriormente, 0/W;(/+1) OM¡(í)+S_^l+ a^¡.
Etapa 4, calcular el cuadrado del término de error
Figure imgf000004_0003
donde
Figure imgf000004_0004
con A/j= r¡j-d(Mi,Mj), A es un término de error entre la estimación de la distancia d(M i, Mj) después del desplazamiento del objeto en la etapa 3 y la medida de la distancia nj proporcionada por dispositivos de ranging sobre el conjunto de nodos, comparar esta cantidad a un criterio de corte definido por adelantado por un operador, si
Figure imgf000004_0001
o bien max(| A/j|) < separaciónMáx, si esta prueba se cumple, ir a la etapa 6,
• Si no, Etapa 5, comprobar si se alcanza un número máximo de iteraciones, si l < lmáx entonces iterar I = I 1 e ir a la etapa 1, si no ir a la etapa 6,
• Etapa 6, fin de las iteraciones, definir la posición de los objetos correspondiente a la mejor estimación de la posición real de los objetos obtenida para cada objeto.
Las coordenadas pueden obtenerse por un medio externo de geolocalización cuya precisión es conocida.
Un ancla y su vector de incertidumbre son, por ejemplo, definidos de la manera siguiente:
Si una medida
Figure imgf000004_0002
externa se supone conocida, por un dispositivo de geolocalización, tal como por ejemplo _ k un sensor GNSS o un informe topográfico, sobre la coordenada k del objeto con una incertidumbre Ai k — *
entonces la kés¡ma coordenada del ancla A es igual a m. • y la kés¡ma coordenada del vector aAi de incertidumbre _ Á
es igual a Ai ’
En el caso contrario, la kés¡ma coordenada del ancla A está fijada a un valor arbitrario (por ejemplo, 0) y la pésima coordenada del vector aAi de incertidumbre está fijada en un valor arbitrario negativo.
Es posible utilizar una función de desplazamiento proporcional a una función intermedia definida de la manera siguiente:
Figure imgf000004_0005
donde £ representa la separación en la posición de equilibrio.
Según otra variante de realización, se utiliza una función de desplazamiento proporcional a una función intermedia definida de la manera siguiente
Figure imgf000004_0006
Un coeficiente de convergencia utilizado para la función de desplazamiento es, por ejemplo, un parámetro de convergencia comprendido entre 0 y 0,5.
Las coordenadas de los anclas Ai son, por ejemplo, definidas de la manera siguiente:
■ iguales a medidas conocidas a priori con una incertidumbre positiva o nula (la misma se refiere en la coordenada correspondiente del vector % '), las coordenadas son coordenadas de anclaje,
■ en ausencia de medidas, la coordenada correspondiente será inutilizada, las coordenadas son libres.
Según una variante de realización, se define una posición inicial de los puntos {M/(0)}/=o..n-i , de la manera siguiente:
• de manera arbitraria determinista,
• de manera aleatoria, utilizando un sorteo de los valores de coordenadas de los nodos,
• utilizando las posiciones estimadas resultantes de una aplicación anterior del procedimiento,
• utilizando la solución de los métodos de resolución sub optima tales como la pseudolinealización (PSL), • utilizando datos de anclaje disponibles para A i, estas coordenadas son preferiblemente utilizadas para las coordenadas iniciales correspondientes de Mi.
Para la implementación del procedimiento, es posible designar un objeto como maestro adaptado para ejecutar las etapas del procedimiento según la invención.
Según otra variante de realización, cada objeto se adapta para ejecutar las etapas del procedimiento según la invención.
El objeto cuya posiciones buscada es, por ejemplo, un nodo en una red de comunicación.
La invención se refiere también a un dispositivo que permite determinar la posición de uno o varios objetos susceptibles de desplazarse en una red, estando dotado el objeto de un dispositivo de medidas de distancia entre nodos y de un medio de comunicación con los otros nodos, comunicando los otros nodos entre sí por un enlace de radiofrecuencia, caracterizado porque comprende al menos un procesador adaptado para ejecutar las etapas del procedimiento según la invención y un dispositivo de medida de la posición de los nodos.
Otras características y ventajas de la presente invención aparecerán mejor de la lectura de la descripción siguiente, de ejemplos de realización, adjuntados a las figuras que representan:
• La figura 1, una ilustración de los problemas de la técnica anterior,
• La figura 2, un esquema de la red de comunicación,
• La figura 3, un organigrama con las etapas principales del procedimiento según la invención, y
• Las figuras 4, 5, 6 y 7, una ilustración de las etapas del procedimiento según la invención.
Con el fin de hacer comprender mejor el procedimiento según la invención, el ejemplo siguiente es dado en el caso de un sistema 1 de comunicación que comprende varios nodos Mi. Cada nodo Mi (M1, M2, M3) comprende, por ejemplo, un medio 10 de comunicación, un procesador 12 adaptado para ejecutar las etapas del procedimiento según la invención, y una batería 13 o dispositivo de alimentación. Los nodos Mi se comunican entre sí, por ejemplo, por un enlace de radiofrecuencia, inalámbrico o por otros medios conocidos por el experto en la técnica.
El sistema comprende también un dispositivo para determinar la posición absoluta de todos o parte de los nodos, por tanto, todos o parte de los nodos pueden por ejemplo estar equipados de un receptor 11, el cual, conectado con un dispositivo 20 de satélite, permite al nodo equipado del receptor 11 ser geolocalizado. Este dispositivo puede ser un sistema de Localización GPS (Global Positioning System), un sistema GNSS (Global Navigation Satellite System), un medio de topografía, etc., en la figura 2, el nodo M2 está equipado de un receptor, mientras que el nodo M3 no lo está.
Comprende también un dispositivo de medida de distancia o dispositivo 21 de ranging colocalizado por ejemplo sobre un nodo Mi o sobre cada uno de los nodos Mi del sistema. Por ejemplo, el dispositivo se puede presentar en forma de un mapa electrónico portado por el nodo. Según otra variante de realización, esta podría ser una funcionalidad del sistema de comunicación a nivel de un nodo que mide los tiempos tomados por la onda de radio para transitar entre los nodos.
En esta red, para la implementación del procedimiento, ciertos de estos nodos serán de posición conocida y asimilados a anclas.
En el procedimiento según la invención, el principio consiste, en especial, en asimilar el conjunto de los nodos de la red a un cuerpo elásticamente deformable, estando conectados los nodos entre sí por resortes virtuales cuya distancia a la posición de equilibrio se define:
• Por la diferencia entre su interdistancia euclidiana, y
• por una medida de ranging obtenida gracias a un dispositivo externo.
El procedimiento va a calcular, explícitamente, los desplazamientos de los nodos compatibles de las incertidumbres sobre la distancia entre los nodos (las medidas de ranging) y estas sobre la posición absoluta de los nodos supuestos conocidos o anclas.
Las figuras 5 a 7, detalladas posteriormente en la descripción, ilustran el desplazamiento iterativo de los nodos de una solución candidata (posición estimada de los nodos) hacia una posición que minimiza el criterio global de error poniendo, en especial en juego: •
• El cálculo de vectores que conectan pares de nodos de la solución asociada a cada medida de ranging, • La evaluación de una medida de error entre la distancia entre nodos de la solución y la misma medida por el dispositivo de ranging, por ejemplo, la diferencia entre la norma de estos vectores y la medida de ranging asociada,
la sola memorización de la posición de los nodos que proviene de las etapas del procedimiento según la invención, de las coordenadas de anclajes medidas y de sus incertidumbres asociadas.
Sea un conjunto de N nodos de Mi posiciones:
Figure imgf000006_0001
en tres dimensiones (3D) y
Figure imgf000006_0002
en dos dimensiones (2D), las coordenadas se eligen en una referencia cartesiana, siendo O el punto de origen elegido en esta referencia.
La distancia entre dos nodos Mi, M¡, d(Mi, Mj) se define por d(M¡,Mj)-\\N\¡Mj\ C0nj unt0 de posiciones de los N nodos en un instante dado t, Pi(t)={Mi(t)}/=o..N-i se denomina “geometría actual”. nj es una medida de distancia (ranging) obtenida entre el nodo Mi, y el nodo Mj, por un dispositivo de medida dedicado (módulo de ranging situado por ejemplo a nivel del nodo) y conocido con una incertidumbre cnj, correspondiente a una separación tipo sobre la medida.
Se denominará “ancla o “medida de anclaje” A » a una información de posición absoluta sobre la kés¡ma coordenada —k
del nodo M j, obtenida con una incertidumbre ° Ai "Esta información puede obtenerse por medios diversos tales como informes topográficos o receptores GNSS. La información sobre la posición de un ancla varía en función del instante de medida. Es una función entregada por ejemplo en tiempo real por un dispositivo GPS. En aras de la simplicidad de la escritura, el tiempo no se indica en la descripción de la invención, un experto en la técnica no tendrá dificultad en integrarlo.
Todas las coordenadas de un ancla pueden ser conocidas a priori, o en parte solamente, por ejemplo, cuando la posición del nodo se determina por examen de un mapa: si el nodo está situado en una carretera, se puede saber que el nodo está en una latitud dada sin conocer la longitud.
El procedimiento según la invención se basa, en especial, en el cálculo directo de elementos de desplazamiento de la posición de los nodos en cada iteración del procedimiento, teniendo en cuenta la incertidumbre relativa entre las k
medidas de ranging a r¡¡, y la incertidumbre ° Ai sobre la posición de anclajes eventuales.
Según una variante de realización, y con el fin de no particularizar el papel de los nodos asociados a un ancla efectivo y permitir la generalización del procedimiento a anclajes parciales, es decir, al menos una coordenada del nodo es restringida por una medida externa, un ancla A virtual y un vector aAi de incertidumbre se asocian a cada nodo M¡.
El ancla virtual y el vector de incertidumbre se definen como sigue por sus coordenadas de índice k:
Si una medida ■' externa se supone conocida (medida directa de las coordenadas por un dispositivo de geolocalización tal como, por ejemplo, un sensor GNSS o un informe topográfico) sobre la coordenada k del r j n i ' . . nodo Mi con Ai la incertidumbre (por ejemplo, la separación tipo de medidas sobre ¡ ), por tanto la kesima
coordenada del ancla A es igual a ¿ y la késima coordenada del vector0^ de incertidumbre es igual a Ai . Esta késima coordenada del nodo será denominada “anclada”;
En el caso contrario, la kés¡ma coordenada del ancla A es fijada a un valor arbitrario (por ejemplo, 0), y la kés¡ma coordenada del vector aAi de incertidumbre fijada a un valor unitario negativo (por ejemplo, -1). Esta coordenada del nodo será denominada “ libre”.
En cada iteración del procedimiento, se calcula para cada nodo Mí.
3 i
• la suma vectorial de desplazamientos de ranging aplicables al nodo únicamente debidos a las separaciones con respecto a las medidas de ranging) relativas al nodo M¡. Este d —e>splazamiento se calcula como la suma sobre el conjunto de medidas de ranging Ri de los desplazamientos °j-» debidos a la medida d ranging ry relativo entre Mi y Mj y a su incertidumbre Unj;
El vector que une los dos puntos y se define como sigue
Figure imgf000007_0006
donde
Figure imgf000007_0001
con Aij las coordenadas de M¡M¡, 9 es una función de desplazamiento dada y R¡ = {rj } el conjunto de medidas de ranging disponibles hacia Mi.
Si todas o parte de las coordenadas de están “ancladas”, se calculan desplazamiento de retorno hacia el ancla OC •'o corrección de anclaje. Para limitar la aparición de posibles fenómenos de oscilación, el cálculo de esta corrección de anclajes se efectúa sobre la posición de Mi, trasladada de la corrección de ranging asociada.
La corrección de anclaje es
Figure imgf000007_0007
CQn ^ ung func¡¿jn ^g desplazamiento.
La elección de las funciones de desplazamiento 9 y 9 es libre con la condición de que conduzca a un desplazamiento hacia un punto de equilibrio
Figure imgf000007_0002
para 9 y (A H ' - 0) para 9.
Estas funciones son, por ejemplo, seleccionadas para reflejar un cierto grado de conocimiento sobre las distribuciones de probabilidades asociadas a las medidas. Se dan ejemplos de función de desplazamiento a continuación.
Para distribuciones gaussianas, los desplazamientos son proporcionales a una función intermedia:
Figure imgf000007_0003
donde z representa la separación en la posición de equilibrio.
• Si esta separación £ es reducida delante de a, la probabilidad de que la medida se aproxime al equilibrio es elevada: esta función será próxima a 0 y el desplazamiento correctivo será reducido,
• Si esta separación £ es grande por delante de a, la probabilidad de que la medida se aproxime al equilibrio es reducida: esta función será próxima a 1 y el desplazamiento correctivo será grande.
Sin información particular sobre la ley de probabilidad de los errores, la función intermedia se define como sigue:
Figure imgf000007_0004
• El desplazamiento correspondiente a una fracción constante de la separación al equilibrio.
Algunos casos particulares son dados a título ilustrativo:
• Si o=0, la coordenada es perfectamente conocida (medida conocida con una precisión infinita, en la práctica muy inferior a la precisión de posicionamiento buscada, como en el caso de un informe topográfico): el desplazamiento será tal que lleva a la coordenada exactamente al valor de medida;
• Si a<0, la coordenada es libre (artificio de notación que indica que la coordenada no está anclada). No se aplica ningún desplazamiento de retorno (en la práctica, no es necesario ningún cálculo para estas coordenadas). A través de la definición de esta función intermedia, las funciones 9 y 9 se pueden escribir:
Figure imgf000007_0005
• El parámetro p es un parámetro de convergencia comprendido estrictamente entre 0 y 0,5. Cuanto más reducido es este parámetro, más adecuado será el procedimiento para converger en presencia de un gran número de nodos y de posiciones iniciales alejadas de la solución óptima, pero más reducida la velocidad de convergencia será. Según una variante de realización, el parámetro de convergencia es tomado como p=1/N.
Figure imgf000008_0001
función de desplazamiento,
con Ai la primera coordenada del punto Mi y oí la incertidumbre correspondiente.
En ausencia de medidas de anclajes, vI'(A,<r)=Oi e| procedimiento converge portanto hacia una solución diferenciada, es decir una geometría de nodos en la que las posiciones relativas de los nodos de la solución son compatibles con las medidas de ranging disponibles (es decir, la geometría real puede ser deducida a través de operaciones de traslación, rotación y simetría de conjunto).
La búsqueda de una solución, es decir, de la posición real de los nodos, para un juego de ranging dado entre N nodos es iterativa. La misma supone, en especial:
• Crear un conjunto de N puntos denominados anclajes virtuales {/\/}fo../v-i y de N vectores âAÍ)i=0..N-1 de incertidumbre asociados a estos anclajes;
Las coordenadas de estos puntos Ai de anclaje son:
■ ¡guales a medidas conocidas a priori con una incertidumbre positiva o nula (la misma se refiere en la coordenada correspondiente del vector (% ') , se hablará de coordenadas de anclaje,
■ en ausencia de medidas, la coordenada correspondiente será inutilizada (valor arbitrario, por ejemplo, 0).
Esta ausencia de información se memoriza (por ejemplo, poniendo el valor negativo -1 en la coordenada correspondiente del vector Se hablará por tanto de coordenadas libres;
• Crear un conjunto de N puntos {Mi}i=0..N-i que contendrán las posiciones estimadas de los nodos de la red por el procedimiento;
• Definir una posición “ inicial” de los puntos {Mi}i=0..N-i que puede ser fijada:
• de manera arbitraria determinista,
• de manera aleatoria, utilizando un sorteo de los valores de coordenadas de los nodos,
• utilizando las posiciones estimadas resultantes de una aplicación anterior del procedimiento,
• utilizando la solución de los métodos de resolución subóptimos tales como la pseudolinealización (PSL), • utilizando datos de anclaje disponibles para A i, estas coordenadas son preferiblemente utilizadas para las coordenadas iniciales correspondientes de Mi.
Disponer un conjunto E de Q medidas de ranging entre dos nodos i y j: E={r//}ge[0,Q-i] con (i,_/)e[0,A/-1]I 2y las incertidumbres asociadas {üY//}ge[0,Q-i];
• Definir las funciones de desplazamiento 9 y 9.
El formalismo de anclajes virtuales no es esencial para la implementación del procedimiento según la invención, pero simplifica la descripción. De hecho es posible calcular las correcciones de anclaje describiendo un bucle de cálculo sobre las únicas coordenadas de anclaje y sus incertidumbres, lo que reduce tanto los cálculos como los almacenamientos inútiles para las coordenadas libres.
El procedimiento comprende por ejemplo las etapas siguientes, reiteradas, ilustradas en la figura 3:
Para I=0 a Imáx, con el valor de a Imáx elegido para limitar el tiempo pasado en caso de ausencia de convergencia de las etapas;
Etapa 1, 301, para cada nodo M¡, calcular el desplazamiento de ranging
Figure imgf000008_0002
donde M M
Figure imgf000008_0003
induce sobre este nodo Mi por la totalidad de los otros nodos disponiendo de una medida de ranging a partir del nodo Mi.
Etapa 2, 302, para cada nodo Mi, que posee una coordenada de anclaje en el ancla Ai virtual asociado, calcular una corrección a->/ de anclaje, es decir, el desplazamiento de retorno hacia este ancla, por la fórmula
Figure imgf000009_0001
S^.¡,(JA¡) es e| desplazamiento de retorno función del vector y de un desplazamiento
Etapa 3, 303, en cada nodo M¡, aplicar un desplazamiento igual a la suma del desplazamiento del ranging <- >l y de la corrección “ ->/ de anclaje calculados anteriormente. 0/W,(/+1 )-0/W /(/)+£>_>/+«_>./,
N - \
A l = l A : a2 = V al IJ
Etapa 4, 304, calcular ;=0 donde i = con A/j= nj-d(Mi,Mj), donde A se interpreta como un término de error entre estimación de la distancia y medida de distancia proporcionada por los dispositivos de ranging, comparar esta cantidad con un criterio de corte definido por adelantado por un operador, por ejemplo,
A toí< A fin ,
si o bien max(| A/j|) < separaciónMáx, si esta prueba se cumple, ir a la etapa 6,
Etapa 5, 305, si no, si el criterio de corte no es verificado, se va a comprobar si se alcanza un número máximo de iteración, si l < lmáx entonces iterar I = I 1 e ir a la etapa 1, sino ir a la etapa 6,
Etapa 6, 306, fin de las iteraciones. En este estado, las posiciones de los nodos Mi corresponden a la mejor estimación de la posición real obtenida por la implementación de las etapas.
Se señala que si l = lmáx, el procedimiento no converge hacia una solución que respeten las restricciones de error impuestas deseadas: esto indica al usuario que la posición estimada de los nodos puede que no sea satisfactoria.
En este caso, las cantidades A2 tot y máx(| A/j| proporcionan una medida de esta separación de los objetivos de *2
precisiones f in (error cuadrático total) y separaciónMáx (error elemental máximo en un par de nodos).
Las figuras 4 a 7 esquematizan el resultado de las etapas del procedimiento según la invención, respectivamente, para la primera iteración, la segunda iteración, la trigésima iteración y las posiciones finales en las que la incertidumbre sobre la posición del punto M3 de coordenadas (0, 100) es netamente superior a las de los otros puntos M1 , M2 y M4.
En estas figuras, se representan cuatro nodos M1 , M2 , M3 y M4 en una referencia cartesiana graduada en metros. Los puntos M1 y M2 están anclados con una precisión elevada (por ejemplo a través de un estudio topográfico de 10 cm de precisión), el punto M3 está anclado pero su posición inicial es incorrectamente medida con un error de 20 m (por ejemplo, gracias a un medio GNSS de incertidumbre de 15 m de separación tipo) y el punto M4 no está anclado (ningún medio local de medida de posición absoluta). Todos los nodos están equipados de un dispositivo de ranging local que permite medir la distancia a los otros nodos, con una incertidumbre de 50 cm de separación tipo. Estos valores sólo son ilustrativos del procedimiento.
Las posiciones reales de los nodos se materializan por estrellas, las posiciones de la solución inicial se representan por círculos y las posiciones estimadas de los nodos por el procedimiento según la invención con la ayuda de cuadrados para la iteración actual. Las flechas en trazo de puntos tienen una longitud igual a las medidas de ranging entre nodos, y las flechas en trazo continuo corresponden a los desplazamientos aplicados durante las etapas del procedimiento.
En la figura 4 se representa el punto M1 de posición estimado P1 , el punto M2 de posición estimado P2 , el punto M3 de posición estimado P3, así como una posición relativa a la posición inicial, teniendo el punto M4 una posición 401 estimada, una posición 402 correspondiente a la solución inicial y una posición 403 real.
La figura 5 muestra que después de la segunda iteración, la posición estimada para el punto M4 se desplaza en 501, después en la figura 6, en el punto 601 después de la trigésima iteración y en la figura 7, el fin de las etapas en el punto 701. Esta ilustración muestra que el punto M4 al cual no está anclada ninguna coordenada, ha sido desplazado de iteración en iteración de una posición de inicialización alejada de coordenadas (50, -50) hacia la posición buscada de coordenadas (50, 50). En el mismo tiempo, el punto M3 aunque anclado pero con una incertidumbre importante, se ve llevado hacia su posición real por la implementación de procedimiento. Los puntos M1 y M2 apenas se mueven, debido a la gran precisión de su anclaje.
El procedimiento según la invención permite el cálculo de una solución para un juego de medidas de ranging y posiblemente de posiciones ancladas dadas. Puede ser aplicado de nuevo:
• Tras la recepción de nuevas medidas de ranging (o bien en cada nueva medida, o bien después de la recepción de un lote de medidas para reducir las demandas de medios de cálculo);
• Tras la recepción de un nuevo juego de restricciones de anclaje (por ejemplo, informaciones sobre las coordenadas de ciertos nodos, que provienen por ejemplo de receptores GNSS, o de informes topográficos); • Según la aplicación contemplada, una nueva aplicación del procedimiento puede utilizar, como solución inicial, la solución calculada anteriormente, en particular si la cinemática de los nodos implica desplazamientos limitados con respecto a la cadencia de refresco de las medidas de ranging. La reutilización de una solución calculada anteriormente como inicialización de una nueva aplicación del procedimiento en un instante posterior limita los riesgos de no convergencia y permite reducir considerablemente el número de iteraciones para converger hacia la nueva estimación de la posición de los nodos.
Las etapas del procedimiento según la invención se aplican por ejemplo en un sistema descentralizado, en el cual todos los nodos implicados comprenden un procesador adaptado para ejecutar las etapas, intercambiando los nodos las informaciones gracias a un medio de comunicación.
El procedimiento se aplica también en un sistema centralizado en el que un nodo de red es por ejemplo designado nodo central.*
El procedimiento según la invención ofrece una simplicidad de los cálculos tanto en términos de memoria, como de potencia de cálculo. Los únicos cálculos necesarios para el funcionamiento del procedimiento son la determinación de los vectores formados por los pares de nodos de la red para los cuales está disponible una medida de ranging. Además, la introducción de restricciones tales como la fijación de todas o parte de las coordenadas de anclas, asociada a la incertidumbre de estas coordenadas, se expresa muy simplemente modificando, con respecto a estas incertidumbres, la función no lineal de cálculo de desplazamiento hacia una posición de equilibrio (pudiendo ser tabulada esta última para limitar las demandas de recursos de cálculo).

Claims (11)

REIVINDICACIONES
1. Procedimiento para determinar la posición de uno o varios objetos susceptibles de desplazarse en una red, estando dotados uno o varios objetos de una capacidad de medida de distancia a los otros objetos de la red, al menos una parte de las coordenadas de un objeto es conocida, caracterizado porque comprende al menos las etapas siguientes:
• Definir un conjunto de puntos Ai o anclas y las incertidumbres asociadas a sus coordenadas, describiendo las coordenadas de anclas y la incertidumbre sobre las coordenadas informaciones sobre la posición de los objetos y la incertidumbre sobre estas informaciones,
• Generar un conjunto que contiene las posiciones estimadas de los objetos y definir una posición inicial de los puntos,
• Medir un conjunto de distancias entre al menos dos objetos Mi, Mj, con incertidumbres asociadas y ejecutar las etapas siguientes:
Figure imgf000011_0001
Etapa 1, para cada objeto M¡, calcular el desplazamiento jsR‘ correspondiente a la suma vectorial de los desplazamientos de medida o ranging sobre el conjunto de medidas de ranging disponibles hacia el objeto Mi e inducidas sobre este objeto Mi por la totalidad de otros objetos que disponen de una medida de ranging a partir de dicho objeto Mi, debidos a la medida n¡ de ranging relativa entre y Mjy su incertidumbre Onjcon R¡ = {r¡j\ el conjunto de medidas de ranging disponibles hacia M¡,
I \ M ¡M:
Figure imgf000011_0002
: < r \\r°n j) r 1—
y ]sR: donde w ,M\\ con Aij las coordenadas de M¡M¡, 9 es una función de desplazamiento dada,
Etapa 2, (302), para cada objeto M que posee una coordenada de anclaje en un ancla A virtual asociado,
calcular un valor de desplazamiento de retorno a-y¡ hacia este ancla con <*-* = 'V(A¡M¡ S^¡,crA¡) Y
una función de desplazamiento,
Etapa 3, (303), a cada objeto aplicar un desplazamiento igual a la suma del desplazamiento del ranging S * y de la corrección a->/' de anclaje calculados anteriormente,
A í-l
AL=lAj a2 »=y / —I a2 V.
Etapa 4, (304), calcular el cuadrado del término de error 1=0 donde i * l con A/j = rij -d(Mi,Mj), A es un término de error entre la estimación de la distancia d(Mi, Mj) después del desplazamiento del objeto en la etapa 3 y la medida de la distancia proporcionada por los dispositivos de ranging sobre el conjunto de nodos, comparar esta cantidad con un criterio de corte definido por
Figure imgf000011_0003
adelantado por un operador, si o bien max(|Aj|) < separaciónMáx, si esta prueba se cumple, ir a la etapa 6,
Si no, Etapa 5, (305), comprobar si se alcanza un número máximo de iteraciones, si l < lmáx entonces iterar I = I 1 e ir a la etapa 1, si no ir a la etapa 6,
Etapa 6, (306), fin de las iteraciones, definir la posición de objetos correspondiente a la mejor estimación de la posición real de los objetos obtenida para cada objeto.
2. Procedimiento según la reivindicación 1, caracterizado porque se define un ancla y su vector de incertidumbre de la manera siguiente:
yin
Si una medida ■ externa se supone conocida sobre la coordenada k del objeto Mi con una incertidumbre —k k * A i, entonces la kés¡ma coordenada del ancla A es igual a ’ ¡ y la kés¡ma coordenada del vector0^/' de
incertidumbre es igual a u a¡ .
en el caso contrario, la kés¡ma coordenada del ancla A es fijada a un valor arbitrario y la ké; coordenada del vector aAi de incertidumbre fijada a un valor unitario negativo.
3. Procedimiento según una de las reivindicaciones 1 o 2, caracterizado porque se utiliza una función de desplazamiento proporcional a una función intermedia definida de la manera siguiente:
Figure imgf000012_0001
donde £ representa la separación en la posición de equilibrio.
4. Procedimiento según una de las reivindicaciones 1 o 2, caracterizado porque se utiliza una función de desplazamiento proporcional a una función intermedia definida de la manera siguiente:
Figure imgf000012_0002
5. Procedimiento según una de las reivindicaciones 3 o 4, caracterizado porque se tiene en cuenta en una función de desplazamiento de un parámetro de convergencia comprendido entre 0 y 0,5 como coeficiente.
6. Procedimiento según una de las reivindicaciones anteriores, caracterizado porque las coordenadas de anclas A i son definidas de la manera siguiente:
■ ¡guales a medidas conocidas a priori con una incertidumbre positiva o nula (la misma se refiere en la
coordenada correspondiente del vector aA i), las coordenadas son coordenadas de anclaje,
■ en ausencia de medidas, la coordenada correspondiente será inutilizada, las coordenadas son libres.
7. Procedimiento según una de las reivindicaciones anteriores, caracterizado porque se define una posición inicial de los puntos {M/(0)}/=0..w- 1 , de la manera siguiente:
• de manera arbitraria determinista,
• de manera aleatoria, utilizando un sorteo de los valores de coordenadas de los nodos,
• utilizando las posiciones estimadas resultantes de una aplicación anterior del procedimiento,
• utilizando la solución de los métodos de resolución sub optima tales como la pseudolinealización (PSL), • utilizando datos de anclaje disponibles para A, estas coordenadas son preferiblemente utilizadas para las coordenadas iniciales correspondientes de M.
8. Procedimiento según una de las reivindicaciones anteriores caracterizado porque un objeto está diseñado como maestro y por qué dicho objeto está adaptado para ejecutar las etapas del procedimiento según una de las reivindicaciones 1 a 7 y para centralizar los resultados.
9. Procedimiento según una de las reivindicaciones anteriores, caracterizado porque cada objeto de la red se adapta a ejecutar las etapas del procedimiento según una de las reivindicaciones 1 a 7 y a centralizar los resultados.
10. Procedimiento según una de las reivindicaciones anteriores caracterizado porque el objeto cuya posición es buscada es un nodo en una red de comunicación.
11. Dispositivo que permite determinar la posición de uno o varios objetos susceptibles de desplazarse en una red, estando dotados uno o varios objetos de un dispositivo (21) de medidas de distancia entre nodos, comunicando los nodos entre sí gracias a un medio (10) de comunicación, caracterizado porque comprende al menos un procesador (12) adaptado para ejecutar las etapas del procedimiento según una de las reivindicaciones 1 a 10, un dispositivo de medida (11, 20) de la posición de los nodos.
ES17748459T 2016-08-02 2017-08-01 Procedimiento y sistema de geolocalización para el cálculo directo de elementos de desplazamiento Active ES2810925T3 (es)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
FR1601190A FR3054887B1 (fr) 2016-08-02 2016-08-02 Procede et systeme de geolocalisation par calcul direct d'elements de deplacement
PCT/EP2017/069482 WO2018024750A1 (fr) 2016-08-02 2017-08-01 Procede et systeme de geolocalisation par calcul direct d'elements de deplacement

Publications (1)

Publication Number Publication Date
ES2810925T3 true ES2810925T3 (es) 2021-03-09

Family

ID=57485549

Family Applications (1)

Application Number Title Priority Date Filing Date
ES17748459T Active ES2810925T3 (es) 2016-08-02 2017-08-01 Procedimiento y sistema de geolocalización para el cálculo directo de elementos de desplazamiento

Country Status (7)

Country Link
US (1) US10663557B2 (es)
EP (1) EP3494403B1 (es)
DK (1) DK3494403T3 (es)
ES (1) ES2810925T3 (es)
FR (1) FR3054887B1 (es)
PL (1) PL3494403T3 (es)
WO (1) WO2018024750A1 (es)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11297068B2 (en) 2018-12-18 2022-04-05 At&T Intellectual Property I, L.P. Anchoring client devices for network service access control
FR3100894B1 (fr) * 2019-09-13 2021-11-26 Mac Lloyd Sas Système de localisation et/ou de chronométrage

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7123925B2 (en) * 2002-06-18 2006-10-17 British Telecommunications Public Limited Company Method and apparatus for locating devices
EP1617601B1 (en) * 2004-04-20 2013-04-03 Ambient Holding B.V. Distributed precision based localization algorithm for ad-hoc wireless networks
EP2927700B1 (en) * 2014-04-01 2019-08-07 ABB Schweiz AG Method for monitoring system variables of a distribution or transmission grid
US10754004B2 (en) * 2015-03-25 2020-08-25 International Business Machines Corporation Methods and apparatus for localizing a source of a set of radio signals
US9990335B2 (en) * 2016-06-27 2018-06-05 The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration Universal and automated monte carlo method code for uncertainty propagation in metrology databases

Also Published As

Publication number Publication date
US20190170852A1 (en) 2019-06-06
DK3494403T3 (da) 2020-08-17
PL3494403T3 (pl) 2020-11-02
WO2018024750A1 (fr) 2018-02-08
FR3054887B1 (fr) 2019-09-06
EP3494403A1 (fr) 2019-06-12
FR3054887A1 (fr) 2018-02-09
EP3494403B1 (fr) 2020-05-13
US10663557B2 (en) 2020-05-26

Similar Documents

Publication Publication Date Title
Yao et al. An integrated IMU and UWB sensor based indoor positioning system
US11231480B2 (en) System and global method for geolocation using imprecise distance and anchor position measurements
EP3430419B1 (en) Estimating locations of mobile devices in a wireless tracking system
Shi et al. Anchor self-localization algorithm based on UWB ranging and inertial measurements
EP2634593B1 (en) Positioning using a local wave-propagation model
US20180283882A1 (en) Location-based services system and method therefor
Tian et al. A resetting approach for INS and UWB sensor fusion using particle filter for pedestrian tracking
Wen et al. 3D LiDAR aided GNSS NLOS mitigation in urban canyons
Georgy et al. Vehicle navigator using a mixture particle filter for inertial sensors/odometer/map data/GPS integration
CN106643709B (zh) 一种海上运载体的组合导航方法及装置
CN109613585A (zh) 一种对基站天线超短基线gnss双天线实时测向的方法
US8548731B2 (en) Navigation method, navigation system, navigation device, vehicle provided therewith and group of vehicles
US8260567B1 (en) System and method for angles-only position and velocity determination using closed-form triangulation
JPH03183980A (ja) 衛星方式位置決めシステムにおける基準受信アンテナに対する2次受信アンテナの相対的位置決定方法及び装置
KR20120124501A (ko) 도심 네비게이션을 위한 강화된 데이터베이스 정보
JP5933846B2 (ja) 位置計測装置および位置計測方法
ES2810925T3 (es) Procedimiento y sistema de geolocalización para el cálculo directo de elementos de desplazamiento
JP2014102137A (ja) 自己位置推定装置
CN108931791A (zh) 卫惯紧组合钟差修正系统和方法
CN108463741A (zh) 多历元gnss载波相位整数解析
ES2369476T3 (es) Procedimientos y sistema para la determinación de ángulos de mira entre dos dispositivos.
KR20130036145A (ko) 이동 정보 결정 장치, 수신기 및 그에 의한 방법
Zhang et al. Carrier-phase-based initial heading alignment for land vehicular MEMS GNSS/INS navigation system
Wang et al. Land vehicle navigation using odometry/INS/vision integrated system
Dahmane et al. Controlling the degree of observability in GPS/INS integration land-vehicle navigation based on extended Kalman filter