03.06.2013 Views

Geodesia. Cartografía. Sistemas de referencia. Tiempos.

Geodesia. Cartografía. Sistemas de referencia. Tiempos.

Geodesia. Cartografía. Sistemas de referencia. Tiempos.

SHOW MORE
SHOW LESS

You also want an ePaper? Increase the reach of your titles

YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.

<strong>Sistemas</strong> <strong>de</strong> navegación integrados<br />

Filtrado óptimo <strong>de</strong> sistemas lineales: el filtro <strong>de</strong> Kalman.<br />

Navegación Aérea<br />

Tema 6: <strong>Sistemas</strong> <strong>de</strong> navegación integrados. El filtro <strong>de</strong><br />

Kalman.<br />

<strong>Sistemas</strong> <strong>de</strong> navegación integrados<br />

Filtrado óptimo <strong>de</strong> sistemas lineales: el filtro <strong>de</strong> Kalman.<br />

Fusión <strong>de</strong> sensores.<br />

Fusión <strong>de</strong> sensores. Ejemplo: el canal vertical.<br />

INS-GPS<br />

Una aeronave actual dispone <strong>de</strong> una gran diversidad <strong>de</strong><br />

sensores y sistemas <strong>de</strong> navegación, que pue<strong>de</strong>n obtener total o<br />

parcialmente las variables <strong>de</strong> navegación PVAT.<br />

Por ejemplo hemos visto el INS, que a partir <strong>de</strong> las medidas<br />

<strong>de</strong> la IMU, el mo<strong>de</strong>lo <strong>de</strong> Tierra y gravedad, y una estimación<br />

inicial, nos da posición, velocidad y actitud en todo momento.<br />

También hemos visto el GPS, que igualmente es capaz <strong>de</strong><br />

darnos todos éstos datos, o al menos (si no disponemos <strong>de</strong><br />

múltiples antenas), la posición y la velocidad.<br />

Pue<strong>de</strong> haber otros sistemas (DME-DME, etc...)<br />

Cada sistema dará una estimación diferente, sujeta a error.<br />

La i<strong>de</strong>a <strong>de</strong> fusión <strong>de</strong> sensores y <strong>de</strong> los sistemas <strong>de</strong> navegación<br />

integrados, consiste en obtener una única estimación PVAT a<br />

partir <strong>de</strong> todas las anteriores, tal que el error sea el menor<br />

posible.<br />

2 / 26<br />

<strong>Sistemas</strong> <strong>de</strong> navegación integrados<br />

Filtrado óptimo <strong>de</strong> sistemas lineales: el filtro <strong>de</strong> Kalman.<br />

Ejemplo: el canal vertical.<br />

Fusión <strong>de</strong> sensores. Ejemplo: el canal vertical.<br />

INS-GPS<br />

Se vio en el tema 4 que el canal vertical <strong>de</strong>l INS es inestable.<br />

Una forma <strong>de</strong> estabilizar el canal es usar la medida <strong>de</strong> altitud<br />

obtenida <strong>de</strong> medidas barométricas, hB. Se <strong>de</strong>nomina<br />

“estimador baro-inercial <strong>de</strong> la altitud”.<br />

Recor<strong>de</strong>mos que las ecuaciones <strong>de</strong>l canal vertical venían dadas<br />

por:<br />

˙ˆh = − ˆVD,<br />

˙ˆVD = ˆρz +<br />

µe<br />

,<br />

(Re + ˆh) 2<br />

don<strong>de</strong> ˆρz es la componente z <strong>de</strong> −(ˆω n n/e + 2ˆωn e/i )× ˆv n + â n NG .<br />

<strong>Sistemas</strong> <strong>de</strong> navegación integrados<br />

Filtrado óptimo <strong>de</strong> sistemas lineales: el filtro <strong>de</strong> Kalman.<br />

Estimador baro-inercial <strong>de</strong> la altitud I<br />

Fusión <strong>de</strong> sensores. Ejemplo: el canal vertical.<br />

INS-GPS<br />

Se modifica el canal vertical <strong>de</strong>l INS <strong>de</strong> la siguiente forma,<br />

usando hB:<br />

˙ˆh = − ˆVD − C1(ˆh − hB),<br />

µe<br />

˙ˆVD = ˆρz +<br />

(Re + ˆ h) 2 + C2( ˆ h − hB) + C3<br />

t<br />

don<strong>de</strong> C1, C2 y C3 son ganancias a <strong>de</strong>terminar.<br />

Calculando como en el tema 4 el error <strong>de</strong> altitud y<br />

<strong>de</strong>spreciando el error en el término ρz, obtenemos:<br />

δ ˙h = −δVD + C1(ˆh − hB),<br />

δ ˙VD ≈ − 2g0<br />

δh − C2(ˆh − hB) − C3<br />

Re<br />

t<br />

0<br />

0<br />

3 / 26<br />

( ˆ h(τ) − hB(τ))dτ,<br />

(ˆh(τ) − hB(τ))dτ,<br />

y obsérvese que ˆh − hB = ˆh − h + h − hB = −(δh − δhB),<br />

don<strong>de</strong> δhB es el error <strong>de</strong> estimación barométrico, que<br />

suponemos aproximadamente constante.<br />

4 / 26

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!