FR3014556B1 - Procede et dispositif d'alignement d'une centrale inertielle - Google Patents
Procede et dispositif d'alignement d'une centrale inertielle Download PDFInfo
- Publication number
- FR3014556B1 FR3014556B1 FR1362300A FR1362300A FR3014556B1 FR 3014556 B1 FR3014556 B1 FR 3014556B1 FR 1362300 A FR1362300 A FR 1362300A FR 1362300 A FR1362300 A FR 1362300A FR 3014556 B1 FR3014556 B1 FR 3014556B1
- Authority
- FR
- France
- Prior art keywords
- orientation
- particle
- network
- propagation
- particles
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 239000002245 particle Substances 0.000 claims abstract description 130
- 238000001914 filtration Methods 0.000 claims abstract description 8
- 230000000717 retained effect Effects 0.000 claims abstract description 6
- 230000008030 elimination Effects 0.000 claims abstract description 5
- 238000003379 elimination reaction Methods 0.000 claims abstract description 5
- 238000004364 calculation method Methods 0.000 claims description 7
- 230000010354 integration Effects 0.000 claims description 7
- 230000001902 propagating effect Effects 0.000 claims description 5
- 238000013507 mapping Methods 0.000 claims description 2
- 230000000644 propagated effect Effects 0.000 description 12
- 230000007547 defect Effects 0.000 description 4
- 238000005259 measurement Methods 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- 238000012952 Resampling Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 239000000969 carrier Substances 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007850 degeneration Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000004083 survival effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
Description
Claims (4)
- REVENDICATIONS1. Procédé d’alignement d’une centrale inertielle (2) embarquée sur un porteur circulant sur un réseau (41) cartographie, ledit réseau (41) définissant pour le porteur un ensemble de couples position / orientation que le porteur peut prendre, le procédé étant caractérisé en ce qu’il comporte : (E1) une étape d’initialisation au cours de laquelle est générée une pluralité de particules, chaque particule étant définie par un couple position/orientation sur le réseau, ces particules étant choisies pour que leur couple position / orientation corresponde, avec une probabilité supérieure à un premier seuil, au couple position / orientation estimé pour le porteur ; (E2) une étape de propagation au cours de laquelle les particules font l’objet d’un filtrage particulaire avec en entrée des données inertielles fournies par la centrale inertielle (2) ; - (E3) une élimination des particules pour lesquelles aucun couple position / orientation du réseau ne correspond, avec une probabilité supérieure à une valeur seuil, à la position et à l’orientation de la particule après propagation ; (E4) une mise à jour du couple position / orientation de chaque particule non éliminée en remplaçant sa position et son orientation par un couple position / orientation qui, après propagation, lui correspond sur le réseau avec une probabilité supérieure à un deuxième seuil ; - (E5) une mise à jour d’un modèle d'erreur de la centrale inertielle (2) en fonction de l’écart entre le couple position / orientation de chaque particule après propagation et celui retenu pour sa mise à jour ; les étapes de propagation (E2), d’élimination des particules (E3), de mise à jour des paramètres des particules (E3) et de mise à jour du modèle d’erreur (E4) étant répétées jusqu'à ce qu’il n'existe plus qu’une seule particule.
- 2. Procédé d’alignement d’une centrale inertielle (2) selon la revendication précédente, dans lequel lors de l’étape de mise à jour des couples position /orientation (E4) : - on met à jour la position et l’orientation de chaque particule dont la couple position / orientation correspond à une position et une orientation sur le réseau avec la plus grande probabilité ; - on génère une particule pour chacun des autres couples position / orientation du réseau qui correspondent au couple position / orientation de la particule après propagation avec une probabilité supérieure au deuxième seuil.
- 3. Procédé d’alignement d’une centrale inertielle (2) selon l’une des revendications précédentes, selon lequel l’étape d’initialisation (E1) comporte des étapes selon lesquelles : - un utilisateur renseigne dans une unité de calcul (21) une position et une orientation qu’il estime correspondre à sa position et son orientation réelle ; - l'unité de calcul (21) génère une particule pour chacun des couples position / orientation accessibles au porteur correspondant avec une probabilité supérieure à une valeur seuil à la position et orientation estimé par l’utilisateur. . Procédé d’alignement d’une centrale inertielle (2) selon l'une des revendications précédentes, caractérisée en ce que l'étape d'initialisation (E1) comporte en outre l'initialisation d'une covariance pour chaque particule représentative de la pertinence de la particule pour représenter le couple position / orientation réel du porteur, la covariance de chaque particule étant mise à jour après chaque étape de propagation (E2), le procédé comportant en outre une étape d’élimination des particules ayant une covariance inférieure à une valeur prédéfinie. Procédé d’alignement d’une centrale inertielle (2) selon la revendication précédente, selon lequel la covariance est proportionnelle à la densité du réseau (41). Procédé d’alignement d’une centrale inertielle (2) selon l’une des revendications 4 ou 5, dans lequel le réseau (41) est un réseau routier constitué de routes présentant une largeur et une longueur et selon lequel la covariance est définie par rapport à la longueur et la largeur de la route correspondant à la position de la particule. Procédé d’alignement d’une centrale inertielle (2) selon la revendication précédente, comportant en outre une étape de calibrage d’un capteur externe de vitesse en fonction de l'écart entre le couple position / orientation de chaque particule après propagation et le couple position / orientation accessible au porteur qui lui correspondant avec la plus grande probabilité. Dispositif d’alignement d’une centrale inertielle (2) embarquée sur un porteur circulant sur un réseau (41) cartographié, ledit réseau (41) définissant pour le porteur un ensemble de couples position / orientation que le porteur peut prendre, le dispositif d’alignement comportant une base de données (41) des couples position / orientation que le porteur peut prendre et une unité de calcul (21) adaptée pour : - générer une pluralité de particules, chaque particule étant définie par un couple position/orientation sur le réseau, ces particules étant choisies pour que leur couple position / orientation corresponde, avec une probabilité supérieure à un premier seuil, au couple position / orientation estimé pour le porteur ; propager les particules par filtrage particulaire avec en entrée des données inertielles fournies par la centrale inertielle (2) ; - éliminer les particules pour lesquelles aucun couple position / orientation du réseau ne correspond, avec une probabilité supérieure à une valeur seuil, à la position et à l’orientation de la particule après propagation ; - mettre à jour le couple position / orientation de chaque particule non éliminée en remplaçant sa position et son orientation par un couple position / orientation qui, après propagation, lui correspond sur le réseau avec une probabilité supérieure à un deuxième seuil ; - mettre à jour un modèle d’erreur de la centrale inertielle (2) en fonction de l’écart entre le couple position / orientation de chaque particule après propagation et celui retenu pour sa mise à jour, - répéter des étapes de propagation, d’élimination des particules, de mise à jour des paramètres des particules et de mise à jour du modèle d’erreur jusqu'à ce qu’il n’existe plus qu'une seule particule.
- 9. Dispositif d’alignement selon la revendication précédente, caractérisé en ce que l'unité de calcul (21) comporte en outre une carte numérisée (4) des lieux dans lesquels évolue le porteur et une interface graphique (31) permettant à un utilisateur de visualiser la carte numérisée (4) ainsi que le réseau navigable (41) et de renseigner une position estimée et une orientation estimée. 10. Centrale inertielle (2) embarquée sur un porteur circulant sur un réseau (41) définissant un ensemble de couples position / orientation accessibles au porteur, le couple position / orientation du porteur étant défini par sa position et son orientation, la centrale inertielle comportant : - une pluralité de capteurs inertiels (2) ; - un module d’intégration (21) estimant la position, la vitesse et l'orientation du porteur à partir des données fournies par la centrale inertielle (2) ; - un module d’estimation d’erreurs (25) ; la centrale inertielle étant caractérisée en ce qu’elle comporte en outre une base de données (41 ) des couples position / orientation accessibles au porteur ; et en ce que le module d’intégration (21) est adapté pour : - générer une pluralité de particules, chaque particule étant définie par un couple position/orientation sur le réseau, ces particules étant choisies pour que leur couple position / orientation corresponde, avec une probabilité supérieure à un premier seuil, au couple position / orientation estimé pour le porteur ; propager les particules par filtrage particulaire avec en entrée des données inertielles fournies par la centrale inertielle (2) ; - éliminer les particules pour lesquelles aucun couple position / orientation du réseau ne correspond, avec une probabilité supérieure à une valeur seuil, à la position et à l’orientation de la particule après propagation ; - mettre à jour le couple position / orientation de chaque particule non éliminée en remplaçant sa position et son orientation par un couple position / orientation qui, après propagation, lui correspond sur le réseau avec une probabilité supérieure à un deuxième seuil ; - répéter des étapes de propagation, d’élimination des particules, de mise à jour des paramètres des particules et de mise à jour du modèle d’erreur jusqu'à ce qu'il n’existe plus qu’une seule particule ; le module d’estimation d'erreurs (25) étant adapté pour (E4) mettre à jour un modèle d'erreur de la centrale inertielle (2) en fonction de l’écart entre le couple position / orientation de chaque particule après propagation et celui retenu pour sa mise à jour.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1362300A FR3014556B1 (fr) | 2013-12-09 | 2013-12-09 | Procede et dispositif d'alignement d'une centrale inertielle |
PCT/EP2014/077030 WO2015086587A1 (fr) | 2013-12-09 | 2014-12-09 | Procédé et dispositif d'alignement d'une centrale inertielle |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1362300 | 2013-12-09 | ||
FR1362300A FR3014556B1 (fr) | 2013-12-09 | 2013-12-09 | Procede et dispositif d'alignement d'une centrale inertielle |
Publications (2)
Publication Number | Publication Date |
---|---|
FR3014556A1 FR3014556A1 (fr) | 2015-06-12 |
FR3014556B1 true FR3014556B1 (fr) | 2019-09-13 |
Family
ID=50473426
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
FR1362300A Active FR3014556B1 (fr) | 2013-12-09 | 2013-12-09 | Procede et dispositif d'alignement d'une centrale inertielle |
Country Status (2)
Country | Link |
---|---|
FR (1) | FR3014556B1 (fr) |
WO (1) | WO2015086587A1 (fr) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112880704A (zh) * | 2021-01-19 | 2021-06-01 | 中国人民解放军海军工程大学 | 光纤陀螺捷联惯导系统智能标定方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SE0004096D0 (sv) * | 2000-11-08 | 2000-11-08 | Nira Automotive Ab | Positioning system |
GB2476990A (en) * | 2010-01-19 | 2011-07-20 | Thales Holdings Uk Plc | On-board unit for determining the route taken by a vehicle without the use of a global navigation satellite system for positioning |
US8583400B2 (en) * | 2011-05-13 | 2013-11-12 | Google Inc. | Indoor localization of mobile devices |
-
2013
- 2013-12-09 FR FR1362300A patent/FR3014556B1/fr active Active
-
2014
- 2014-12-09 WO PCT/EP2014/077030 patent/WO2015086587A1/fr active Application Filing
Also Published As
Publication number | Publication date |
---|---|
WO2015086587A1 (fr) | 2015-06-18 |
FR3014556A1 (fr) | 2015-06-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2577231B1 (fr) | Dispositif d'aide a la navigation, notamment a l'interieur de bâtiments | |
WO2007135115A1 (fr) | Dispositif de navigation aerienne a capteurs inertiels et recepteurs de radionavigation et procede de navigation aerienne utilisant de tels elements | |
EP1819984B1 (fr) | Systeme de navigation inertielle hybride base sur un modele cinematique | |
EP2541199B1 (fr) | Engin spatial muni d'un dispositif d'estimation de son vecteur vitesse par rapport à un référentiel inertiel et procédé d'estimation correspondant | |
EP2541200B1 (fr) | Dispositif et procédé de navigation integrant plusieurs systemes inertiels de navigation hybridés | |
EP2627970A1 (fr) | Dispositif de localisation d'un vehicule et procede de generation d'une information de localisation d'un vehicule | |
EP3004807B1 (fr) | Procede de calibration autonome d'un equipement inertiel utilise en mode statique | |
FR2964774A1 (fr) | Procede d'estimation du mouvement d'un porteur par rapport a un environnement et dispositif de calcul pour systeme de navigation | |
EP4153465B1 (fr) | Procede de calcul d'un vecteur de vitesse instantanee d'un vehicule ferroviaire et systeme correspondant | |
EP3765818B1 (fr) | Procédé de calibration d'un gyromètre équipant un véhicule | |
EP3724605B1 (fr) | Procédé d'estimation de données de navigation d'un véhicule terrestre utilisant des paramètres de géométrie et d'orientation de route | |
EP1205732B1 (fr) | Centrale inertielle de navigation comportant un récepteur GPS intégré | |
FR3014556B1 (fr) | Procede et dispositif d'alignement d'une centrale inertielle | |
JP6778612B2 (ja) | 情報処理システム、および情報処理方法 | |
FR3106886A1 (fr) | Détermination d’informations d’aide à la navigation sur un réseau routier | |
EP4184193B1 (fr) | Procédé de détermination d'une distance corrigée | |
EP3980720B1 (fr) | Procede et dispositif de recalage d'une centrale inertielle d'un moyen de transport a partir d'informations delivrees par un viseur du moyen de transport | |
US11487025B1 (en) | Method for inferring GPS location | |
FR3081548A1 (fr) | Procede et dispositif de determination de la position precise d’un vehicule dans une cartographie routiere. | |
EP4006491A1 (fr) | Système d'aide à la navigation d'un porteur à l'aide d'amers | |
FR2704665A1 (fr) | Procédé et système de localisation d'un véhicule terrestre. | |
EP3967975A1 (fr) | Procédé de détermination de la position et de l'orientation d'un véhicule | |
EP4382392A1 (fr) | Procédé pour déterminer la position d'un véhicule ferroviaire | |
FR3041769A1 (fr) | Procede de geolocalisation | |
WO2020249812A1 (fr) | Procede de surveillance des performances d'unites de mesure inertielle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
CA | Change of address |
Effective date: 20150616 |
|
PLFP | Fee payment |
Year of fee payment: 3 |
|
PLFP | Fee payment |
Year of fee payment: 4 |
|
CD | Change of name or company name |
Owner name: SAGEM DEFENSE SECURITE, FR Effective date: 20161214 |
|
CJ | Change in legal form |
Effective date: 20161214 |
|
PLFP | Fee payment |
Year of fee payment: 5 |
|
PLFP | Fee payment |
Year of fee payment: 6 |
|
PLFP | Fee payment |
Year of fee payment: 7 |
|
PLFP | Fee payment |
Year of fee payment: 8 |
|
PLFP | Fee payment |
Year of fee payment: 9 |
|
PLFP | Fee payment |
Year of fee payment: 10 |
|
PLFP | Fee payment |
Year of fee payment: 11 |