FR 2916531 A1 20081128 FR 0703629 A 20070522 Procédé d'estimation des erreurs position et vitesse d'une centrale inertielle à l'aide d'un radar à imagerie SAR Le domaine de l'invention concerne : - le guidage précis d'un missile sur une cible fixe à partir d'un autodirecteur SAR Synthetic Aperture Radar . - le recalage de la centrale inertielle d'un aéronef portant un radar SAR Synthetic Aperture Radar . La présente demande de brevet décrit l'invention dans le cadre d'un guidage d'un missile sur une cible fixe. De manière générale, les radars à antenne synthétique (SAR : Synthetic Aperture Radar) sont des radars qui exploitent par traitement, le déplacement du porteur pour améliorer la résolution liée à la largeur du faisceau d'antenne. La résolution spatiale, qui caractérise la finesse de l'image SAR acquise, est donc obtenue : - dans la direction de l'axe antenne par la résolution en distance du radar ; - dans la direction perpendiculaire à l'axe antenne par le traitement SAR Cette remarque met en évidence que le porteur doit avoir un mouvement suivant la direction perpendiculaire à l'axe antenne, ce qui interdit d'effectuer une imagerie SAR sur le devant de la trajectoire, c'est-à-dire suivant la direction du vecteur vitesse. Le traitement du type SAR est notamment décrit dans l'ouvrage de J.Darricau : Physique et Théorie du Radar ùTome 3, 3ème édition ù Chapitre 21, page 25 483 ù Editeur Sodipe, Paris 1994. Ainsi, l'acquisition d'une image SAR sur une cible et son environnement permet de restituer la scène avec une résolution fine (de la classe métrique ou même submétrique). L'exploitation de cette image à partir des informations élaborées lors de la préparation d'une mission permet de localiser précisément la cible dans l'image 30 et ce notamment lorsque la mission consiste pour un missile à localiser avec précision une cible et à se diriger vers elle avec précision. Le positionnement géographique de l'image SAR est obtenu à partir des informations délivrées par la centrale inertielle du missile. Or ces informations peuvent être fortement bruitées ce qui conduit alors à une forte imprécision sur le positionnement géographique de l'image SAR. Il apparaît donc qu'à cause de ce phénomène bien que la cible soit localisée précisément dans l'image SAR, il ne soit pas possible d'en déduire une localisation géographique précise. Il est rappelé que l'activation du mode SAR impose un dépointage angulaire entre le vecteur vitesse et la direction missile-cible et donc une trajectoire non directe comme illustré en figure 1. Une première étape correspond à une portion de trajectoire avec cartographies répétées sur la cible. Lors du rapprochement vers la cible, le dépointage angulaire diminue jusqu'à devenir trop faible pour être compatible du mode SAR correspondant à une seconde étape. Ainsi à partir d'une certaine distance, l'autodirecteur arrête son fonctionnement et le missile rallie la cible en mode purement inertiel à partir des informations recalées par l'autodirecteur. Durant ce ralliement, les erreurs sur le vecteur vitesse estimé par la centrale inertielle génèrent une dérive de la trajectoire missile, ce qui peut conduire à un décalage important du point d'impact par rapport à la cible comme illustré en figure 2. Pour éviter ce phénomène, l'invention propose un procédé d'estimation des erreurs de la centrale inertielle au niveau position et vitesse qui pour des durées faibles peut être assimilée à un biais constant. Plus précisément l'invention a pour objet un procédé de détermination de l'erreur de position et du biais vitesse de la centrale inertielle embarquée d'un porteur poursuivant une trajectoire en direction d'une cible, caractérisé en ce qu'il comporte les étapes suivantes : l'acquisition à bord du porteur d'une série d'images de type SAR de la cible , - l'exploitation desdites images pour effectuer à partir de chacune des 30 images aune mesure de la distance et une mesure du Doppler de la cible ; - l'estimation de la position précise du porteur par rapport à la cible et du biais vitesse, à partir des mesures de distance et du Doppler de la cible avec un filtre estimateur. 35 Avantageusement le filtre est un filtre de Kalman Etendu discret. Avantageusement le procédé de l'invention comprend une étape préalable d'optimisation de trajectoire pour optimiser les performances du filtre estimateur. Avantageusement, le procédé comporte l'utilisation d'un outil comportant une fonction de coût sous contraintes. Avantageusement, la fonction de coût sous contraintes est la borne de Cramer Rao associée à l'estimation de la position du porteur par rapport à la cible et du biais vitesse. Avantageusement, le procédé comporte les étapes suivantes : 10 - la segmentation de la trajectoire en N tronçons ; - la détermination des 2N composantes de l'accélération transversale du porteur le long de la trajectoire en optimisant la borne de Cramer Rao pour la dernière image acquise. Par ailleurs les contraintes prises en compte par la fonction de coût sont 15 du type facteur de charge maximal du porteur et/ou dépointage angulaire minimal entre le vecteur vitesse et la direction porteur-cible et/ou l'angle d'impact minimal dans le plan vertical. Ainsi selon le procédé de l'invention, les informations estimées par le porteur sont la position de la cible et les erreurs vitesse de la centrale inertielle. Ces 20 informations sont évaluées à partir de la distance et du Doppler de la cible estimés à l'issue du traitement de chaque image SAR. Le filtre fournit une estimation de la position réelle du porteur et une estimation du biais vitesse à partir des mesures distance et Doppler issues de l'exploitation des images SAR. 25 Ces mesures sont repérées dans un repère dont l'origine est la cible permettant ainsi une détermination précise de la position du porteur par rapport à la cible. L'invention sera mieux comprise et d'autres avantages apparaîtront à la 30 lecture de la description qui va suivre et grâce aux figures annexées parmi lesquelles : la figure 1 illustre la trajectoire non directe empruntée par un missile effectuant des images SAR sur la cible, avec un dépointage angulaire entre le vecteur vitesse et la direction porteur-cible ; la figure 2 illustre l'erreur sur la vitesse engendrée par la centrale inertielle au niveau du point d'impact réel par rapport à une cible lors d'une mission sans correction d'erreur ; la figure 3 illustre le décalage entre la localisation estimée de l'image 5 SAR à partir des informations inertielles et la localisation exacte de l'image SAR ; la figure 4 illustre la position de la cible au point d'intersection des cercles iso distance et iso Doppler associés à l'ensemble des mesures obtenues le long d'une trajectoire non optimisée 10 - la figure 5 illustre l'optimisation de la trajectoire vis à vis de la localisation de la cible. L'invention va être décrite dans le cadre d'une mission pour laquelle un missile autodirecteur cherche à localiser avec précision une cible. L'invention pourrait 15 tout aussi bien être appliquée à tout aéronef portant un radar qui réalise des images SAR répétées sur un objet au sol. De manière générale en définissant les paramètres suivants : - Xe : position courante du missile 20 - Xd : position initiale du missile (à t = 0) - Xm : déplacement du missile depuis t=0 estimé par la centrale inertielle - t : temps courant - b : erreurs vitesse de la centrale inertielle modélisées par des biais On a l'équation d'évolution suivante V: L V 25 Xe =Xm ùt•b+Xd Les positions sont exprimées dans un repère dont l'origine est la cible. La position courante de la cible caractérise donc la position relative missile-cible qui est l'information exploitée par le guidage du missile Et l'on peut considérer en première approximation que : 30 Le symbole signifie la dérivation par rapport au temps. Par ailleurs les équations de mesure sont les suivantes : • Le déplacement du missile estimé par la centrale inertielle X. qui est faussé par un biais constant sur la vitesse 5 • La distance Missile-Cible d=IX,äùt•b+Xdl+wd Le symbole Ilall correspond à la norme du vecteur a • La fréquence Doppler 2 (Xût•b+Xd;V,,, ûb) f __ 2 IX,,, ût•b+Xd I +wf avec Vm vitesse estimée par la centrale inertielle Le symbole (a b) correspond au produit scalaire entre les vecteurs a et b 15 Où wd et w f sont les bruits de mesure, de variance o -d2 et a -J.2 La précision sur la position de l'image SAR par rapport au missile dépend de la précision sur la vitesse de la centrale inertielle comme illustré en figure 3 qui schématise le décalage entre la localisation exacte de l'image SAR et la localisation estimée de l'image SAR et ce en fonction du décalage entre la vitesse vraie et la 20 vitesse estimée. Pour s'affranchir des erreurs de la centrale inertielle sur la vitesse, la démarche retenue est la suivante : Le traitement de chaque image SAR fournit la Distance et le Doppler de la cible, la cible se situe sur un cercle correspondant à l'intersection d'une sphère iso 25 Distance et d'un cône Iso Doppler comme illustré en figure 4. Les axes correspondent au repère géographique centré sur la cible, l'unité étant proportionnelle à des mètres. L'exploitation de la répétition des images fournit une estimée de la position de la cible et le biais vitesse. 6 Le paragraphe ci-après détaille les équations du filtre qui fournit une estimation position Xd et une valeur du biais vitesse b à partir des mesures distance et Doppler issues de l'exploitation des images SAR. Le filtre peut avantageusement être un filtre de Kalman Etendu discret. Conformément au paragraphe précédent le vecteur d'état X comprend six composantes qui sont les coordonnées du point Xd et les biais vitesse b suivant trois axes orthogonaux. Les notations suivantes sont utilisées dans ce paragraphe : - X(kjk-1) correspond à la prédiction de l'état à l'instant k estimée à l'instant 1 o k-1 X(kjk) est l'estimation de l'état à l'instant k effectuée à l'instant k Y(k) est la mesure (distance, Doppler) effectuée à l'instant k Ces notations d'indice s'appliquent aussi à la matrice de covariance de l'état Rx. 15 Le pas de discrétisation temporel correspond à la cadence de renouvellement des images SAR. Conditions Initiales L'état X(0) et la matrice de covariance Rx(O 1 0) sont initialisés à partir de 20 la connaissance de la trajectoire théorique et des performances attendues de la centrale inertielle. Prédiction - Prédiction de l'état : X(k I k-1) = X(k-1 J k-1) 25 -Prédiction de la covariance de l'état :Rx(k 1 k-1) = Rx(k-1 ~ k-1) -Prédiction de la mesure : Yp(k J k-1) = c(X(k ~ k-1)) La fonction c est détaillée ci après Innovation 30 - Calcul de l'innovation : e(k) = Y(k) ù Yp(k 1 k-1) - Covariance de l'innovation :Re(k) = H(k) Rx(k 1 k-1) H(k)T + Rm(k) La matrice H(k) correspond au jacobien des mesures, cette matrice est détaillée ci après. La matrice Rm(k) est la covariance des bruits de mesure Gain de Kalman - Calcul du gain de Kalman : K(k) = Rx(k 1 k-1) H(k)T Re(k)-' Estimations finales - Correction de la prédiction : X(k ~ k) = X(k k-1) + K(k) e(k) - Correction de la covariance : Rx(k I k) = [I û K(k) H(k)] Rx(k j k-1) La fonction c correspond à l'expression de la mesure attendue en fonction de l'état estimé IX. ùt•b+Xd(klkù1)I c(X (k kù1 = 2 (Xm ù t b(k k -1) + Xd (kl k -1); V,n ù b(kl k -1)) Xn, ùt•b(klkù1)+Xd(kkù1)I L'expression du Jacobien des mesures est la suivante. Pour des simplifications de notation, dans cette expression Xd et b correspondent respectivement à Xd(k: j k-1) et à b(k f k-1). (Xmùt•b+Xd Xmù1•b+X,! IIXm t b+Xdlùit II4ù1-b+XdII 2 Vmùb (Xmùt b+Xd)•;Xmùt-b+Xd;Vmùb)\T 2 t Vm m ' ùb (X ùt•b+Xl,) (Ym t.b+X, ;V,mùb)\ X t b+X r _ _ _ ! _ m 1 \lxmùtb+xll ~Ixm--t•b+XdII' 2 IIXm-t•b+XdII I~xmùt b+X,lII' IIX,n-1•b+XdII Selon l'invention, le procédé propose d'utiliser un filtre estimateur. Pour renforcer l'efficacité d'un tel filtre, il peut avantageusement être prévu en amont d'optimiser la trajectoire du porteur en direction de la cible. En effet la forme de la trajectoire a un impact direct sur les performances de ce filtre estimateur. Ce couplage peut être appréhendé en considérant les positions relatives de l'ensemble des cercles associés aux distance et Doppler de la Hx = cible obtenues à partir du traitement de chaque image SAR. Il apparaît par exemple qu'une trajectoire effectuée dans un plan à incidence constante conduit à des cercles qui sont tous tangents à une droite passant par la cible. La figure 4 illustre ce phénomène. La position estimée de la cible a donc tendance à glisser le long de cette droite ce qui se traduit par des erreurs importantes. Par contre dans le cas d'une trajectoire ayant du défilement suivant les trois axes, les cercles distance Doppler sont tous dans des plans différents, ce qui permet de localiser plus précisément le point d'intersection qui est la cible comme illustré en figure 5. De façon à optimiser les performances du filtre estimateur, il est proposé 1 o d'utiliser un outil permettant de rechercher une trajectoire optimale vis à vis des précisions de la position relative de la cible et des erreurs vitesse estimées à la fin de l'activation de l'autodirecteur c'est-à-dire lors de l'engagement du ralliement inertiel sur la cible. Cet outil doit permettre de déterminer la trajectoire à partir de la résolution d'un problème du type optimisation d'une fonction de coût sous 15 contraintes. La fonction de coût considérée est la borne de Cramer Rao évaluée pour la dernière image SAR acquise. Cette borne correspond à la meilleure précision obtenable par un filtre estimateur non biaisé. Les contraintes prises en compte portent sur l'autodirecteur (portée, squint angle minimal compatible du mode SAR,..) 20 et sur le missile (facteur de charge,...). La trajectoire est découpée en N tronçons. Pour chacune de ces portions de trajectoire, l'accélération transversale est supposée constante. L'outil détermine les 2*N composantes des accélérations le long de la trajectoire, ce qui après intégration fournit la forme de la trajectoire sachant que le point de départ de la 25 trajectoire est fixée par l'utilisateur et que la cible se trouve à l'origine du repère. La détermination des 2*N composantes de l'accélération est obtenue de façon à optimiser la borne de Cramer Rao pour la dernière image acquise. La borne de Cramer Rao est l'inverse de la matrice de Fisher J k , qui pour le modèle retenu, est obtenue par l'équation récursive suivante : 30 T Jk+I = Jk + Hk+l . Rk+, Hk+l Où 5 Hk+, est le Jacobien de la fonction de mesure, évalué en la vraie valeur de l'état avec le Jacobien de f qui est la matrice des dérivées partielles • Rk+, est la matrice de covariance du bruit de mesure • Jo est l'inverse de la covariance de l'état initial Pour le modèle l'expression du Jacobien des mesures est Hk = III Xmùt•b+X,,II 2 Vn,ùb ~T r 2 2 vIIXn,ùt•b+,M ùt• Vnùb ~Xnùt•b+X1 r JIXmùt•b+XdIl (X,,ùt•b+Xd)•(Xn,ùt•b+X,,;Vn,ùb4 11X,,, ùt•b+.X, 3 t .T X,nùt•b+XX •b+Xa (Xn ùt•b+Xi)•(X,,,,ùt•b+XI;lin, ùb) IIXm,ùt•b+Xdr T X,,, ùt b+Xd Ilx,,,ùt b+Xt 10 Où les différentes fonctions sont évaluées au temps t = tk correspondant à l'instant de la k-ieme mesure. Le calcul récursif de Jk pour une trajectoire va permettre d'évaluer la qualité de celle- ci en calculant la trace de la borne de Cramèr-Rao pour la dernière image acquise, 15 ce qui caractérise la précision globale du point d'impact dans le cas d'un missile parfait. Plus cette trace est faible et plus les informations fournies par l'autodirecteur permettent un guidage précis sur la cible. L'optimisation de la trajectoire est effectuée en considérant les contraintes 20 suivantes : le facteur de charge maximal du missile pendant la phase de cartographie SAR et pendant le ralliement inertiel, le dépointage angulaire minimal entre le vecteur vitesse et la direction missile-cible. 25 l'angle d'impact minimal dans le plan vertical. REVENDICATIONS 1. Procédé pour déterminer l'erreur de position et le biais vitesse d'une centrale inertielle à bord d'un porteur poursuivant une trajectoire en direction d'une cible fixe, caractérisé en ce qu'il comporte en outre les étapes suivantes : - l'acquisition à bord du porteur d'une série d'images de type SAR de la cible , l'exploitation desdites images pour mesurer à partir de chacune des images une mesure de la distance et une mesure du Doppler de la cible ; l'estimation de la position précise du porteur par rapport à la cible et du biais vitesse, à partir des mesures de distance et du Doppler de la cible avec un filtre estimateur. 2. Procédé pour déterminer l'erreur de position et le biais vitesse d'une centrale inertielle à bord d'un porteur poursuivant une trajectoire en direction d'une 15 cible selon la revendication 1, caractérisé en ce que le filtre est un filtre de kalman 3. Procédé pour déterminer l'erreur de position et le biais vitesse d'une centrale inertielle à bord d'un porteur poursuivant une trajectoire en direction d'une cible selon l'une des revendications 1 ou 2, caractérisé en ce qu'il comprend une 20 étape préalable d'optimisation de trajectoire pour optimiser les performances du filtre estimateur. 4. Procédé pour déterminer l'erreur de position et le biais vitesse d'une centrale inertielle à bord d'un porteur poursuivant une trajectoire en direction d'une 25 cible selon la revendication 3, caractérisé en ce qu'il comprend l'utilisation d'un outil comportant une fonction de coût sous contraintes. 5. Procédé pour déterminer l'erreur de position et le biais vitesse d'une centrale inertielle à bord d'un porteur poursuivant une trajectoire en direction d'une 30 cible selon la revendication 4, caractérisé en ce que la fonction de coût sous contrainte est la borne de Cramer Rao. 6. Procédé pour déterminer l'erreur de position et le biais vitesse d'une centrale inertielle à bord d'un porteur poursuivant une trajectoire en direction d'une cible selon la revendication 5, caractérisé en ce qu'il comprend les étapes suivantes : - la segmentation de la trajectoire en N tronçons ; la détermination des 2N composantes de l'accélération transversale du porteur le long de la trajectoire en optimisant la borne de Cramer Rao pour la dernière image acquise. 7. Procédé pour déterminer l'erreur de position et le biais vitesse d'une centrale inertielle d'un porteur poursuivant une trajectoire en direction d'une cible selon l'une des revendications 3 à 6, caractérisé en ce que les contraintes prises en compte lors de l'optimisation de la trajectoire de type facteur de charge maximal du porteur et/ou dépointage angulaire minimal entre le vecteur vitesse et la direction porteur-cible et/ou l'angle d'impact minimal dans le plan vertical.15