BECHERET, Yves (Le Ponant de Paris27 rue Leblanc, Paris, F-75015, FR)
| REVENDICATIONS 1. Procédé de détermination d'un cap en direction du Nord géographique au moyen d'un module senseur iner- tiel comportant trois axes de mesure gyrométriques et trois axes de mesure accélérométriques, comprenant les étapes de : - exploiter des données du module senseur iner- tiel selon un mode chercheur de Nord pour obtenir une première valeur de cap, - exploiter des données du module senseur iner- tiel selon mode gyrocompas pour obtenir une deuxième valeur de cap, - déterminer le cap en direction du nord en uti- lisant la première valeur de cap et la deuxième valeur de cap. 2. Procédé selon la revendication 1, dans lequel le calcul du cap comprend les étapes de : - calculer un écart entre la première valeur de cap et la deuxième valeur de cap, - retenir comme cap en direction du Nord la première valeur de cap et/ou la deuxième valeur de cap en tenant compte de l'écart calculé. 3. Procédé selon la revendication 2, comprenant l'étape d'estimer une cohérence de l'écart calculé avec une hypothèse d'absence de mouvement de la centrale iner- tielle par rapport au sol et : - si l'écart est cohérent prendre la première valeur de cap comme cap, - si l'écart est incohérent prendre la deuxième valeur de cap comme cap en direction du Nord. 4. Procédé selon la revendication 3, dans lequel l'estimation de cohérence comprend l'étape de comparer l'écart pondéré d'un cosinus de latitude à au moins un seuil. 5. Procédé selon la revendication 4, dans lequel le seuil est égal à la racine carrée de la somme du carré d'un écart-type d'une composante de dérive moyenne Est des gyromètres pendant le temps de mesure et du carré d'un écart-type d'une variation moyenne de biais des ac- céléromètres en direction du Sud pendant le temps de mesure. 6. Procédé selon la revendication 1, dans lequel le calcul du cap comprend les étapes de : - pondérer la première valeur de cap et la deuxième valeur de cap, - additionner la première valeur de cap et la deuxième valeur de cap ainsi pondérées pour obtenir le cap en direction du Nord, la pondération étant déterminée pour minimiser un écart-type d'une erreur sur le cap en direction du Nord. 7. Procédé selon la revendication 1, comprenant l'étape de détecter un mouvement du module senseur par un détecteur extérieur au module senseur inertiel et de re- tenir comme cap en direction du Nord la deuxième valeur de cap . |
La présente invention concerne un procédé de re- cherche d'un cap en direction du Nord géographique.
La recherche du Nord géographique est une phase préalable à toute opération de visée, de désignation, de guidage ou de navigation afin de déterminer un cap de référence à partir duquel seront déterminées les données de visée ou de navigation. Lorsque le guidage ou la navigation sont réalisés au moyen d'un système comportant une centrale inertielle ou module senseur inertiel, le système devient opérationnel après qu'il a été « aligné » sur ce cap. II est connu de déterminer un cap en direction du nord en utilisant un chercheur de Nord qui comporte un gyroscope fermement arrimé au sol en position horizontale. Le chercheur de Nord détermine précisément la direction du Nord en l'absence de mouvement du gyroscope par rapport à la surface terrestre. La précision de la détermination ne dépend principalement que de la dérive du gyroscope, voire de la stabilité de la dérive lorsque sont effectuées deux mesures à des caps opposés. En revanche, le plus petit mouvement du gyroscope, même imper- ceptible par un être humain, dégrade rapidement cette précision et fausse la recherche du Nord. L'installation du chercheur de Nord doit donc être particulièrement soignée afin d'éviter de tels mouvements.
Avec les équipements pourvus d'un module senseur inertiel complet nécessaire à la navigation inertielle, il est connu de déterminer un cap en direction du Nord en exploitant les données du module senseur inertiel selon un mode gyrocompas alors que l'équipement est immobilisé en position par rapport à la surface terrestre. On rap- pelle qu'un module senseur inertiel comprend trois axes de mesure accélérométriques et trois axes de mesure gyro- métriques. L'alignement de l'équipement consiste soit à amener puis maintenir physiquement le module senseur inertiel dans une position prédéterminée par rapport à un repère géographique local ou inertiel, soit à estimer puis entretenir par calcul les écarts angulaires entre le repère géographique local ou inertiel et le module senseur inertiel.
Dans ce dernier cas, l'exploitation combinée des données issues des accéléromètres et des gyromètres, associée à une quasi-absence de déplacement par rapport à la Terre, permet de réaliser un alignement et donc d' identifier et entretenir le cap du cœur du module senseur. Toutefois, la précision du cap ainsi déterminé dé- pend donc de celle des accéléromètres dont le prix croît rapidement en fonction de la précision demandée. A précision égale, un chercheur de Nord est bien moins onéreux qu' un gyrocompas .
On notera que, par extension, on nomme gyrocompas à la fois le mode de calcul et le dispositif technique spécialement agencé pour la mise en œuvre de ce calcul . Il en est de même pour le chercheur de Nord.
Un but de l'invention est de fournir un moyen permettant d'optimiser la recherche de Nord au moyen d'un module senseur inertiel.
A cet effet, on prévoit, selon l'invention, un procédé de détermination d'un cap en direction du Nord géographique au moyen d'un module senseur inertiel comportant trois axes de mesure gyrométriques et trois axes de mesure accélérométriques, comprenant les étapes de :
- exploiter des données du module senseur inertiel selon un mode chercheur de Nord pour obtenir une première valeur de cap,
- exploiter des données du module senseur iner- tiel selon un mode gyrocompas pour obtenir une deuxième valeur de cap,
- déterminer le cap en direction du nord en utilisant la première valeur de cap et la deuxième valeur de cap. Ainsi, la première valeur de cap est calculée en utilisant le module senseur inertie1 comme chercheur de Nord, c'est-à-dire en calculant le cap à partir de données gyrométriques, les données accélérométriques n'étant pas utilisées dans le calcul du cap lui-même mais simple- ment pour déterminer le plan horizontal moyen vis-à-vis du module senseur. La deuxième valeur de cap est calculée en utilisant le mode gyrocompas, c'est-à-dire en utilisant le flux de données accélérométriques en plus des données gyrométriques pour estimer le cap et l'assiette de la centrale inertielle. Ceci permet d'obtenir une valeur de cap relativement précise en limitant le risque d'une erreur importante liée à un mouvement angulaire de la centrale inertielle.
Avantageusement, le calcul du cap comprend les étapes de :
- calculer un écart entre la première valeur de cap et la deuxième valeur de cap,
- retenir comme cap en direction du Nord la première valeur de cap et/ou la deuxième valeur de cap en tenant compte de l'écart calculé.
Ces deux valeurs de cap sont affectées d'erreurs dont une composante commune résultant de la dérive moyenne des gyromètres pendant la mesure et une composante non commune résultant des évolutions d'un biais (ou décalage) des accéléromètres . L'effet d'une dérive de biais accélérométrique est négligeable en ce qui concerne la première valeur de cap mais peut générer une erreur de cap supérieure à l'effet des erreurs gyrométriques en ce qui concerne la deuxième valeur de cap. L'écart entre les deux valeurs de cap n'est en revanche pas affecté par la dérive des gyromètres qui s'élimine lors du calcul de l'écart. L'écart peut alors servir de donnée discriminante pour retenir de manière simple et fiable l'une ou l'autre valeur de cap comme cap en direction du Nord. Si l'écart est très faible voire nul, la première valeur de cap, qui est la plus précise dans l'absolu, est retenue. Dans le cas contraire, la deuxième valeur de cap est retenue. Le procédé de l'invention facilite ainsi la sélection du mode opératoire le plus performant en fonction des conditions de mesure.
Plus précisément, le procédé comprend l'étape d'estimer une cohérence de l'écart calculé avec une hypothèse d'absence de mouvement de la centrale inertielle par rapport au sol et : - si l'écart est cohérent prendre la première valeur de cap comme cap en direction du Nord,
- si l'écart est incohérent prendre la deuxième valeur de cap comme cap en direction du Nord.
Eventuellement, si l'écart ne permet pas de conclure sur la cohérence de l'écart avec l'hypothèse d'une absence de rotation du module senseur par rapport à la terre, il est possible d'utiliser une combinaison des deux valeurs de cap pour obtenir le cap retenu.
De préférence, l'estimation de cohérence comprend l'étape de comparer l'écart pondéré d'un cosinus de latitude à au moins un seuil et, avantageusement, le seuil est égal à la racine carrée de la somme du carré d'un écart- type d'une composante de dérive moyenne Est des gyromètres pendant le temps de mesure et du carré d'un écart- type d'une variation moyenne de biais des accéléro- mètres en direction du Sud pendant le temps de mesure.
Ce mode de calcul est particulièrement efficace pour sélectionner la valeur de cap.
En variante, le calcul du cap comprend les étapes de : pondérer la première valeur de cap et la deuxième valeur de cap,
- additionner la première valeur de cap et la deuxième valeur de cap ainsi pondérées pour obtenir le cap en direction du Nord, la pondération étant déterminée pour minimiser un écart-type d'une erreur sur le cap en direction du Nord.
Ceci permet de limiter l'erreur de cap en cas de mouvement tout en conservant une précision statistique correcte en l'absence de mouvement angulaire du module senseur par rapport au sol sans recourir à des accéléro- mètres coûteux.
Avantageusement, le procédé comprend l'étape de détecter un mouvement du module senseur inertiel par un détecteur extérieur au module senseur inertiel et de retenir comme cap en direction du Nord la deuxième valeur de cap .
Ainsi, si une information extérieure montre que le module senseur inertiel a été déplacée, la deuxième valeur de cap est automatiquement retenue.
D'autres caractéristiques et avantages de l'invention ressortiront à la lecture de la description qui suit d'un mode de mise en œuvre particulier non limitatif de l'invention. II sera fait référence à la figure unique annexée représentant par un bloc-diagramme une mise en œuvre du procédé de l'invention.
Le procédé de l'invention concerne la recherche du Nord géographique au moyen d'un module senseur iner- tiel ou centrale inertielle 1 comportant une plateforme 2 pourvue d' accéléromètres 3 (dont un seul est représenté sur la figure) et reliée par des gyromètres 5 (dont un seul est représenté sur la figure) à un support fixe 4 comme un boîtier. Il est entendu que la description et la représentation de la centrale inertielle sont simplifiées à l'extrême, l'invention ne portant pas sur la structure de la centrale inertielle qui est connue par ailleurs. La centrale inertielle 1 est solidaire d'un équipement, tel qu'un véhicule, ayant un châssis auquel le boîtier de la centrale inertielle 1 est rigidement fixé.
La centrale inertielle 1 est associée à un calculateur 6 qui exécute un programme 7 de commande de la centrale inertielle 1 agencé pour calculer un cap en direction du Nord géographique : - comme un chercheur de Nord en utilisant les signaux de données issus d'au moins un des gyromètres 5,
- comme un gyrocompas en utilisant également les signaux de données issus des accéléromètres 3.
Le procédé conforme à l'invention comprend ainsi les étapes de :
- exploiter des données fournies par la centrale inertielle 1 selon un mode chercheur de Nord pour obtenir une première valeur de cap C CN/
- exploiter les données issues de la centrale inertielle 1 selon un mode gyrocompas pour obtenir une deuxième valeur de cap C G c •
Les deux valeurs de cap C CN et C G c sont affectées d'une erreur comportant une composante gyrométrique et une composante accélérométrique . La composante gyrométrique d'erreur de cap, identique pour le calcul de la première valeur de cap et le calcul de la deuxième valeur de cap, résulte des dérives moyennes des gyromètres projetées sur la direction Est- Ouest. La composante gyrométrique d'erreur de cap est égale à Dm E / (Ω τ * cos (L A1 ,) ) où Dm E est la dérive moyenne sur la direction Est due aux dérives moyennes des gyromètres (moyenne sur la durée utile de recherche de nord) , Ω τ est le module de la vitesse de rotation de la Terre par rapport à un repère inertiel (soit environ 4375 μrad/mn ou 15,04 °/h) et L AL est la latitude d'alignement de la centrale inertielle 1 lors de la recherche de Nord. La composante accélérométrique d'erreur de cap est négligeable devant la composante gyrométrique pour la première valeur de cap C CN - L'erreur sur la première va- leur de cap C CN comporte en outre une composante qui résulte de la rotation moyenne Rm E du cœur de la centrale inertielle 1 autour de la direction Est (cette rotation est due aux mouvements du boîtier et éventuellement aux micros rotations et déformées entre le boîtier et le cœur) et qui vaut Rm E / (Ω τ * cos (L AL ) ) .
La composante accélérométrique d'erreur de cap pour la deuxième valeur de cap C GC résulte des rampes de biais des accéléromètres et vaut (PBm s /g)/(Ω τ * cos (L AL ) ) où g est la pesanteur locale et PBm 3 est la variation moyenne de biais des accéléromètres en direction du Sud.
Le procédé comprend l'étape de calculer un écart ou différence ΔC entre la première valeur de cap et la deuxième valeur de cap utilisant toutes deux des données inertielles mesurées pendant la même période. L'écart des deux caps calculés et est affecté d'une erreur valant
[(PBm s /g)- Rm E ] / (Ω τ * cos (L AL ) ) de sorte que cet écart est indépendant des dérives des gyromètres.
Le procédé prévoit de retenir comme cap la pre- mière valeur de cap ou la deuxième valeur de cap en tenant compte de l'écart entre ces deux valeurs.
Dans le mode de réalisation préféré, le procédé comprend l'étape d'estimer une cohérence de l'écart calculé avec une hypothèse d'absence de rotation de la cen- traie inertielle par rapport au sol et :
- si l'écart est cohérent prendre la première valeur de cap C CN comme cap en direction du Nord,
- si l'écart est incohérent prendre la deuxième valeur de cap C G c comme cap en direction du Nord. L'estimation de cohérence comprend l'étape de comparer l'écart, pondéré d'un cosinus de latitude et du module de vitesse de la rotation de la Terre, à un seuil S.
Plus précisément, on vérifie si : -S < ΔC * (Ω τ * cos (LAL) ) < S (1) où S= ( (écart-type de (PBm s /g) ) 2 + (écart-type de Dm E ) 2 ) 1/2 .
Si la relation (1) est vérifiée, alors la première valeur C 0N est retenue comme cap en direction du Nord. Si la relation (1) n'est pas vérifiée, alors la deuxième valeur C G c est retenue comme cap en direction du Nord.
Le procédé de l'invention comprend l'étape de détecter un mouvement de la centrale inertielle par un détecteur extérieur à la centrale inertielle et de retenir comme cap en direction du Nord la deuxième valeur de cap
En variante, le calcul du cap comprend les étapes de :
- pondérer la première valeur de cap C CN et la deuxième valeur de cap C G c/
- additionner la première valeur de cap et la deuxième valeur de cap ainsi pondérées pour obtenir le cap en direction du Nord, la formule de calcul pondération en fonction de l'écart calculée ΔC ou ΔC* (Ω τ *cos (LA L ) ) étant déterminée pour minimiser un écart- type sur une erreur sur le cap obtenu.
Le cap en direction du Nord (ou, dans cette variante, cap pondéré) est alors égal à : λ c *C G c + (l-λ c )*C C N où le coefficient de pondéra- tion λ c est tel que 0<λ c <l et λ c est une fonction de l'écart calculé ΔC * (Ω τ * cos (LAL) ) .
Le cap ainsi calculé est sensible aux dérives des gyromètres de manière identique aux deux autres valeurs de cap calculé décrites ci-dessus. L'erreur ErrCp(λ c ) affectant le cap pondéré est telle que :
ErrCp (λ c ) * (Ω τ * cos (LAL) ) =Dm E +λ c* PBτn s /g+ (l-λ c ) *Rm E où Rm E =PBm s /g - ΔC* (Ω τ * cos (L A L) ) .
Plusieurs critères peuvent permettre de définir la manière dont le coefficient de pondération λ c peut varier en fonction de la donnée ΔC* (Ω τ * COS(L AL ) ) OU en fonction de ΔC. Par exemple, on choisit la loi de variation du coefficient de pondération λ c en fonction de X=ΔC * (Ω τ * cos (L AL ) ) qui minimise, pour une latitude don- née et pour l'écart type des vitesses de rotation moyenne possibles « Rm E » ne déclenchant pas une détection de mouvement, l'écart type (considéré en terme statique et non temporel) de l'erreur sur le cap pondéré ErrCp (λ c ) * (Ω τ * cos (LAL) ) • Bien entendu, l'invention n'est pas limitée au mode de mise en œuvre décrit mais englobe toute variante entrant dans le champ de l'invention telle que définie par les revendications.
La structure de la centrale inertielle peut être différente de celle décrite ici.
Le nombre de mesures réalisées pour le calcul des valeurs de cap peut être supérieur à un.
Ainsi, il est possible de monter la centrale inertielle sur un élément réglable en position angulaire autour d'un axe sensiblement normal au sol et d'effectuer un calcul de cap pour trois positions angulaires différentes, ce qui permet en effectuant une moyenne des trois valeurs calculées d'éliminer l'effet de la dérive des gy- romètres sur l'erreur de cap (la dérive étant de forme sinusoïdale) .