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

Create successful ePaper yourself

Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Navegación Aérea<br />

Tema 1: <strong>Geo<strong>de</strong>sia</strong>. <strong>Cartografía</strong>. <strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>.<br />

<strong>Tiempos</strong>.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

<strong>Geo<strong>de</strong>sia</strong>: Ciencia que se ocupa <strong>de</strong> la forma, medida y<br />

representación <strong>de</strong> la Tierra y <strong>de</strong> su campo gravitatorio.<br />

También estudia otros fenómenos, como por ejemplo el<br />

movimiento <strong>de</strong> las placas tectónicas, la rotación <strong>de</strong> la Tierra,<br />

el <strong>de</strong>splazamiento <strong>de</strong> los Polos o las mareas.<br />

Forma <strong>de</strong> la Tierra: Se plantean mo<strong>de</strong>los locales<br />

(útiles para una cierta región, como por ejemplo o<br />

un país) o globales.<br />

Medida <strong>de</strong> la Tierra: A pequeña escala (topografía:<br />

estudios geodésicos, triangulaciones geodésicas con<br />

teodolitos), o a gran escala (radio <strong>de</strong> la Tierra,<br />

aplanamiento, etc...).<br />

Representación <strong>de</strong> la Tierra: En este aspecto,<br />

íntimamente ligada a la cartografía.<br />

Campo gravitatorio <strong>de</strong> la Tierra: en este aspecto se<br />

<strong>de</strong>nomina geo<strong>de</strong>sia física (rotación, mareas,<br />

<strong>de</strong>nsidad <strong>de</strong> las capas <strong>de</strong> la Tierra...). 2 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Mo<strong>de</strong>los <strong>de</strong> Tierra en la Antigüedad<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

En tiempos antiguos (primeras civilizaciones), los<br />

<strong>de</strong>splazamientos eran muy cortos y por tanto el efecto <strong>de</strong> la<br />

curvatura muy poco apreciable.<br />

Por tanto, típicamente se asumía un mo<strong>de</strong>lo <strong>de</strong> Tierra plana 1 .<br />

No obstante ya había algunos efectos<br />

apreciables para una mente observadora:<br />

En un eclipse <strong>de</strong> Luna, la sombra <strong>de</strong> la<br />

Tierra es circular (¿y si la Tierra fuera un<br />

disco?).<br />

Cuando un barco se a<strong>de</strong>ntra en el mar, lo<br />

último que <strong>de</strong>saparece son las velas!<br />

Los griegos fueron los primeros en proponer<br />

otro mo<strong>de</strong>lo <strong>de</strong> Tierra diferente: una Tierra<br />

esférica.<br />

1 Aún existe quien así lo piensa, p.ej. los miembros <strong>de</strong> la Flat Earth Society.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Mo<strong>de</strong>los <strong>de</strong> Tierra en la Antigüedad<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Los griegos eligieron una esfera por coherencia con las<br />

observaciones, pero sobre todo por motivos filosóficos: la<br />

esfera es el sólido más perfecto.<br />

Entre otros, argumentaron que la Tierra era una esfera<br />

Pitágoras, Aristóteles, Platón o Arquíme<strong>de</strong>s.<br />

El primero en estimar la circunferencia <strong>de</strong> la<br />

esfera terrestre fue Eratóstenes, alre<strong>de</strong>dor<br />

<strong>de</strong>l año 240 A.C.<br />

Eratóstenes <strong>de</strong> Cirene era un matemático,<br />

poeta, atleta, geógrafo y astrónomo griego.<br />

3 / 67<br />

También estimó la inclinación <strong>de</strong>l eje <strong>de</strong> la<br />

Tierra con respecto a la eclíptica (plano<br />

don<strong>de</strong> orbita la Tierra en torno al Sol), y se<br />

le atribuye estimar la distancia Tierra-Sol y<br />

la invención <strong>de</strong>l año bisiesto. 4 / 67


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Midiendo la circunferencia <strong>de</strong> la Tierra<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Eratóstenes usó trigonometría para medir el radio <strong>de</strong> la Tierra,<br />

supuesta ésta esférica (el radio real es aproximadamente 6370<br />

kilómetros).<br />

En Asuán, durante el Solsticio <strong>de</strong> Verano, el Sol se encontraba<br />

totalmente vertical. ¿Qué es el Solsticio <strong>de</strong> Verano y<br />

qué implica que el Sol esté vertical?<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Mo<strong>de</strong>lo <strong>de</strong> Tierra esférico<br />

El mismo día, en Alejandría, un obelisco<br />

proyectaba una sombra <strong>de</strong> ángulo 7,12 o .<br />

Eratóstenes sabía que la distancia entre<br />

Alejandría y Asuán era <strong>de</strong> unos 5000<br />

estadios.<br />

En unida<strong>de</strong>s mo<strong>de</strong>rnas, 1 estadio = 157.5<br />

metros.<br />

Ejercicio: Reproducir el cálculo <strong>de</strong><br />

Eratóstenes. 5 / 67<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Posteriormente Ptolomeo (en el siglo II D.C.) estimó el<br />

perímetro <strong>de</strong> la Tierra en 29000 kilómetros (realmente son<br />

unos 40000 kilómetros). Dado el prestigio <strong>de</strong> Ptolomeo, ésta<br />

estimación se mantuvo durante la Edad Media y Renacimiento<br />

y fue la utilizada por Colón para planear su viaje a las Indias.<br />

Si la Tierra es esférica, se pue<strong>de</strong>n <strong>de</strong>finir<br />

latitud, longitud, meridianos y paralelos.<br />

¿Cuál es la latitud y longitud <strong>de</strong> Sevilla?<br />

¿qué longitud tiene un cierto arco dado<br />

sobre un meridiano? ¿y sobre un paralelo?<br />

Tomando el radio <strong>de</strong> la Tierra como 6366.7<br />

kilómetros, ¿qué longitud cubre un minuto<br />

<strong>de</strong> arco <strong>de</strong> meridiano? (1’=1/60 grados)<br />

6 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Mo<strong>de</strong>lo <strong>de</strong> Tierra elipsoidal<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Cassini (Francia, s.XVIII) midió con precisión un arco <strong>de</strong><br />

meridiano y observó el siguiente fenómeno: tomando como<br />

<strong>referencia</strong> París, 1 grado <strong>de</strong> arco medido hacia el Norte era<br />

más largo que un grado <strong>de</strong> arco medido hacia el Sur.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

La geo<strong>de</strong>sia en tiempos mo<strong>de</strong>rnos<br />

Para resolver la discrepancia, propuso un<br />

mo<strong>de</strong>lo elipsoidal (<strong>de</strong> revolución) <strong>de</strong> la<br />

Tierra, <strong>de</strong> forma que el radio en el Polo es<br />

mayor que el radio en el Ecuador.<br />

Huygens y Newton habían propuesto<br />

décadas atrás el mo<strong>de</strong>lo opuesto, un<br />

elipsoi<strong>de</strong> <strong>de</strong> revolución con mayor radio en el<br />

Ecuador que en el Polo.<br />

El asunto se convertió en una cuestión <strong>de</strong><br />

orgullo nacional, Francia vs. Gran Bretaña.<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

La aca<strong>de</strong>mia <strong>de</strong> Ciencias francesa mandó una expedición a<br />

regiones polares para hacer medidas más precisas.<br />

Las medidas dieron la razón a los ingleses.<br />

Éste fue el primer avance importante en geo<strong>de</strong>sia en casi 20<br />

siglos.<br />

En el siglo XIX, la geo<strong>de</strong>sia aparece como<br />

ciencia in<strong>de</strong>pendiente gracias a las<br />

contribuciones <strong>de</strong> Bessel, Gauss, etc...<br />

En tiempos mo<strong>de</strong>rnos, la geo<strong>de</strong>sia ha<br />

experimentado un nuevo auge gracias a la<br />

exploración <strong>de</strong>l espacio.<br />

7 / 67<br />

<strong>Sistemas</strong> basados en satélites como GPS y<br />

otros permiten <strong>de</strong>terminar medidas<br />

geodéticas con una precisión antes<br />

inalcanzable. 8 / 67


Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Dependiendo <strong>de</strong>l objetivo que se preten<strong>de</strong> alcanzar, en<br />

diferentes disciplinas se pue<strong>de</strong>n emplear diferentes mo<strong>de</strong>los <strong>de</strong><br />

Tierra.<br />

En estudios simplificados y locales se pue<strong>de</strong> usar Tierra plana<br />

(p. ej. en Mecánica <strong>de</strong>l Vuelo).<br />

En el otro extremo está la superficie topográfica <strong>de</strong> la Tierra:<br />

es la forma real <strong>de</strong> la Tierra, pero para po<strong>de</strong>r usarla hacen<br />

falta infinitos puntos: no es práctica en la mayor parte <strong>de</strong> los<br />

casos.<br />

Otra posibilidad es <strong>de</strong>finir una superficie i<strong>de</strong>al, matemática, <strong>de</strong><br />

<strong>referencia</strong>, admitiendo que la Tierra “se parece” a pero no es<br />

exactamente dicha superficie. Hay dos posibilida<strong>de</strong>s:<br />

Esfera: más simple pero menos precisa.<br />

Elipsoi<strong>de</strong> <strong>de</strong> revolución achatado en los polos.<br />

Finalmente, el geoi<strong>de</strong> es una superficie compleja que aproxima<br />

bien la topográfica, <strong>de</strong>finida en base al mo<strong>de</strong>lo geopotencial<br />

(gravitatorio y <strong>de</strong> rotación terrestre). 9 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Elipsoi<strong>de</strong>s <strong>de</strong> <strong>referencia</strong><br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Puesto que la Tierra tiene una forma aproximadamente<br />

elipsoidal, éste mo<strong>de</strong>lo tiene el mérito <strong>de</strong> ser lo<br />

suficientemente simple como para ser manejable y lo<br />

suficientemente preciso como para ser útil en la práctica.<br />

Para <strong>de</strong>finir un elipsoi<strong>de</strong> son necesarios dos parámetros:<br />

re = semieje ecuatorial (mayor) [a veces llamado a].<br />

rp = semieje polar (menor) [a veces llamado b].<br />

Típicamente no se emplea b, sino que se<br />

utiliza el “factor <strong>de</strong> achatamiento” o <strong>de</strong><br />

aplanamiento (flattening): f = 1 − rp/re.<br />

En tablas se suele dar más bien 1/f .<br />

Otraalternativa a f es la excentricidad<br />

e = 1 − r 2 p /r 2 e .<br />

10 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Elipsoi<strong>de</strong>s <strong>de</strong> <strong>referencia</strong><br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Existen muchos elipsoi<strong>de</strong>s <strong>de</strong>finidos, que aproximan mejor<br />

diferentes zonas <strong>de</strong> la Tierra.<br />

Es sencillo convertir coor<strong>de</strong>nadas <strong>de</strong> un elipsoi<strong>de</strong> a otro.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Otros elipsoi<strong>de</strong>s <strong>de</strong> <strong>referencia</strong><br />

En la actualidad ha emergido un estándar<br />

comúnmente aceptado en todo el mundo.<br />

Se <strong>de</strong>nomina Elipsoi<strong>de</strong> Internacional <strong>de</strong><br />

Referencia WGS84.<br />

Para el WGS84, re = 6378,137 kilómetros y<br />

1/f = 298,257224.<br />

El uso <strong>de</strong>l WGS84 se <strong>de</strong>be a que es<br />

empleado por los satélites GPS; todos los<br />

receptores GPS trabajan con coor<strong>de</strong>nadas<br />

<strong>de</strong>finidas por el elipsoi<strong>de</strong> WGS84.<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Ejemplos <strong>de</strong> otros elipsoi<strong>de</strong>s <strong>de</strong> <strong>referencia</strong>:<br />

En España hasta hace poco se usaba el ED50, basado en el<br />

Internacional, pero ahora se usa el GRS80, que es equivalente<br />

(por milímetros) al WGS84.<br />

11 / 67<br />

12 / 67


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Sistema Geográfico <strong>de</strong> <strong>referencia</strong><br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Coor<strong>de</strong>nadas geodéticas o geodésicas<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

También llamado ejes Tierra o ECEF (Earth<br />

Centered, Earth Fixed).<br />

Ligado a la Tierra, rota con ella.<br />

Util para <strong>referencia</strong>r posiciones en toda la<br />

Tierra.<br />

Coor<strong>de</strong>nadas cartesianas:<br />

x ECEF = [x ECEF y ECEF z ECEF ] T .<br />

El plano Ox e y e contiene al Ecuador y el<br />

plano Ox e z e al Meridiano <strong>de</strong> Greenwich.<br />

La forma <strong>de</strong> la Tierra se asimila al elipsoi<strong>de</strong><br />

WGS84.<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Un punto queda <strong>de</strong>terminado por su<br />

altitud h, latitud geodésica φ y longitud<br />

geodésica λ.<br />

Obsérvese que h mi<strong>de</strong> la altitud sobre<br />

una perpendicular al suelo (vertical<br />

local) que no coinci<strong>de</strong> en general con<br />

una línea que una el punto con el<br />

centro <strong>de</strong> la Tierra.<br />

Relación con las coor<strong>de</strong>nadas cartesianas:<br />

x ECEF<br />

y ECEF<br />

z ECEF<br />

=<br />

=<br />

=<br />

h +<br />

h +<br />

h +<br />

!<br />

re<br />

p cos φ cos λ =<br />

1 − f (2 − f ) sen2 φ<br />

!<br />

re<br />

p cos φ sen λ =<br />

1 − f (2 − f ) sen2 φ<br />

re (1 − f ) 2<br />

!<br />

p sen φ =<br />

1 − f (2 − f ) sen2 φ<br />

h +<br />

!<br />

re<br />

h + p cos φ cos λ,<br />

1 − e2 sen2 φ<br />

!<br />

re<br />

h + p cos φ sen λ,<br />

1 − e2 sen2 φ<br />

re (1 − e 2 !<br />

)<br />

p sen φ.<br />

1 − e2 sen2 φ<br />

13 / 67<br />

14 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Coor<strong>de</strong>nadas geocéntricas<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

También se pue<strong>de</strong>n emplear coor<strong>de</strong>nadas<br />

esféricas tradicionales:Un punto P queda<br />

<strong>de</strong>terminado por el radio r (medido <strong>de</strong>s<strong>de</strong> el<br />

centro <strong>de</strong> la Tierra), la latitud geocéntrica φC y<br />

la longitud geocéntrica λC .<br />

Es evi<strong>de</strong>nte que λC = λ, al ser el elipsoi<strong>de</strong> <strong>de</strong><br />

revolución. No obstante, φ = φC .<br />

En la figura se ha elegido un meridiano β por el<br />

que se ha “cortado” el elipsoi<strong>de</strong>.<br />

Usando la figura se pue<strong>de</strong>n <strong>de</strong>mostrar las<br />

fórmulas <strong>de</strong> la anterior transparencia.<br />

Relación con las coor<strong>de</strong>nadas cartesianas:<br />

x ECEF<br />

y ECEF<br />

z ECEF<br />

q<br />

= r cos φC cos λC , r = (xECEF ) 2 + (y ECEF ) 2 + (zECEF ) 2 ,<br />

= r cos φC sen λC , tan λC =<br />

y ECEF<br />

= r sen φC , tan φC =<br />

xECEF ,<br />

z ECEF<br />

q<br />

(xECEF ) 2 +(yECEF .<br />

) 2<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Pasar <strong>de</strong> coor<strong>de</strong>nadas cartesianas a geodésicas<br />

Dadas las coor<strong>de</strong>nadas geodésicas, es inmediato obtener las<br />

coor<strong>de</strong>nadas x ECEF .<br />

El procedimiento inverso ha <strong>de</strong> hacerse numéricamente.<br />

Únicamente se pue<strong>de</strong> calcular con facilidad λ <strong>de</strong><br />

tan λ = xECEF<br />

y ECEF .<br />

Para ello conviene <strong>de</strong>finir la función N(φ) =<br />

escribir p = (x ECEF ) 2 + (y ECEF ) 2 .<br />

1 Asumir h0 = 0. Entonces tan φ0 = zECEF<br />

p(1−e2 ) .<br />

2 Iterar para i = 0, 1, . . .:<br />

a Calcular Ni =<br />

re .<br />

√ 1−e 2 sen 2 φi<br />

b Calcular hi+1 = p<br />

cos − Ni. φi<br />

c Calcular φi+1 <strong>de</strong> tan φi+1 =<br />

z ECEF<br />

“<br />

p 1−e2 Ni Ni +hi+1 re √ y<br />

1−e2 sen2 φ<br />

”. Volver a (a).<br />

3 Parar cuando el procedimiento iterativo converja.<br />

15 / 67<br />

16 / 67


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Sistema <strong>de</strong> <strong>referencia</strong> local y radios <strong>de</strong> curvatura<br />

En la figura se ve un sistema <strong>de</strong> ejes<br />

<strong>de</strong>finido localmente, llamado NED:<br />

North-East-Down.<br />

Coinci<strong>de</strong> con el sistema <strong>de</strong>finido por las<br />

coor<strong>de</strong>nadas curvilineas φ, λ, h, <strong>de</strong><br />

forma que N=e φ, E=e λ, D=e h.<br />

Dicho sistema es fundamental en<br />

navegación aérea, a veces se llama<br />

“navigation frame”.<br />

El radio <strong>de</strong> curvatura <strong>de</strong>l elipsoi<strong>de</strong> a lo largo <strong>de</strong> un meridiano<br />

(λ =cte) es Rmer =<br />

re(1−e 2 )<br />

(1−e 2 sen 2 φ) 3/2 .<br />

El radio <strong>de</strong> curvatura <strong>de</strong>l elipsoi<strong>de</strong> a lo largo <strong>de</strong> un paralelo<br />

(φ =cte) es Rnormal<br />

cos φ , don<strong>de</strong> Rnormal =<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Mo<strong>de</strong>los gravitatorios<br />

re √ .<br />

1−e2 sen2 φ<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Si la Tierra fuera una esfera perfecta, homogénea por capas<br />

esféricas (como una cebolla), la aceleración <strong>de</strong> la gravedad g<br />

sería igual a G = − µe<br />

r 3 r, don<strong>de</strong> r = x ECEF .<br />

En realidad, se tiene que G = G(r, λ, φ).<br />

Para estudiar G es más sencillo usar un potencial U G y<br />

utilizar coor<strong>de</strong>nadas geocéntricas r, λC , φC .<br />

Por tanto G = ∇UG , es <strong>de</strong>cir, en esféricas:<br />

G = ∂UG<br />

∂r er + 1<br />

r<br />

∂U G<br />

∂φC e φC<br />

Mo<strong>de</strong>lo esférico: U G = µe<br />

r .<br />

Mo<strong>de</strong>lo elipsoidal (J2):<br />

+ 1<br />

r cos λC<br />

∂U G<br />

∂λC e λC .<br />

UG = µe<br />

<br />

r 1 + J2<br />

<br />

re 2<br />

2 r (1 − 3 sen2 φC ) , don<strong>de</strong> J2 es un<br />

coeficiente.<br />

Mo<strong>de</strong>lo EGM96: hasta 360 términos realizando correciones<br />

por la forma <strong>de</strong> la Tierra y la distribución másica.<br />

17 / 67<br />

18 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

La rotación <strong>de</strong> la Tierra<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

La Tierra rota con una velocidad ωe en torno al eje z e . Puesto<br />

que los ejes ECEF son solidarios con la Tierra, en dichos ejes<br />

hay que añadir las fuerzas <strong>de</strong> inercia ficticias.<br />

Concretamente aparece una aceleración centrífuga, dada por<br />

acent = −ωe × (ωe × x ECEF ).<br />

<br />

x ECEF y ECEF T<br />

0 .<br />

Se tiene que a cent = −ω 2 e<br />

Si escribimos Uω = ω2 e r 2 cos2 φC<br />

2 , se tiene que acent = ∇Uω .<br />

Nótese que <strong>de</strong>s<strong>de</strong> el punto <strong>de</strong> vista <strong>de</strong> un observador, la<br />

aceleración centrífuga es completamente indistinguible <strong>de</strong> la<br />

gravitatoria.<br />

El geopotencial<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Por tanto a todos los efectos se pue<strong>de</strong> sumar la aceleración<br />

centrífuga a la gravitatoria, y consi<strong>de</strong>rar la suma como la<br />

“gravedad sentida” g.<br />

Se tiene por tanto g = G + a cent.<br />

A nivel <strong>de</strong> potenciales, U g = U G + U ω .<br />

La función U g se <strong>de</strong>nomina geopotencial.<br />

Obsérvese que esta misma operación no se pue<strong>de</strong> realizar con<br />

la otra fuerza <strong>de</strong> inercia producto <strong>de</strong> la no inercialidad <strong>de</strong>l<br />

sistema <strong>de</strong> <strong>referencia</strong> ECEF, que es la fuerza <strong>de</strong> Coriolis.<br />

19 / 67<br />

20 / 67


El geoi<strong>de</strong><br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

El geopotencial se utiliza para <strong>de</strong>finir el geoi<strong>de</strong>, una superficie<br />

que aproxima la forma verda<strong>de</strong>ra <strong>de</strong> la Tierra.<br />

Se <strong>de</strong>fine el geoi<strong>de</strong> como la superficie equipotencial (con<br />

respecto al geopotencial U g ) que mejor aproxima (en el<br />

sentido <strong>de</strong> mínimos cuadrados) el nivel medio <strong>de</strong>l mar global.<br />

Un geoi<strong>de</strong> (exagerado).<br />

El geoi<strong>de</strong><br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Con los mo<strong>de</strong>los gravitatorios antes<br />

expuestos:<br />

1 Si se consi<strong>de</strong>ra la gravedad <strong>de</strong> una esfera y<br />

se <strong>de</strong>sprecia la rotación <strong>de</strong> la Tierra, se<br />

tiene que el geoi<strong>de</strong> es una esfera.<br />

2 Si se consi<strong>de</strong>ra la gravedad con el mo<strong>de</strong>lo<br />

J2 (<strong>de</strong> un elipsoi<strong>de</strong>) y con la rotación <strong>de</strong> la<br />

Tierra, se obtiene el elipsoi<strong>de</strong> WGS84.<br />

3 Si se consi<strong>de</strong>ra el mo<strong>de</strong>lo completo <strong>de</strong><br />

gravedad EGM96 se obitene el llamado<br />

geoi<strong>de</strong> EGM96.<br />

21 / 67<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

En las figuras se pue<strong>de</strong> ver la relación entre la superficie <strong>de</strong> la<br />

Tierra (topográfica), el geoi<strong>de</strong>, y el elipsoi<strong>de</strong>.<br />

Se <strong>de</strong>fine N como la undulación <strong>de</strong>l geoi<strong>de</strong>. Se tiene<br />

N ≤ 100 m. En la figura <strong>de</strong> la izquierda aparece la altura<br />

elipsoidal (como h) y la altura ortométrica o<br />

elevación geoidal (como H).<br />

La altura AGL hAGL es la distancia hasta la<br />

superficie, y se <strong>de</strong>fine como la altitud menos<br />

la altura elipsoidal.<br />

Un mo<strong>de</strong>lo <strong>de</strong> terreno vendrá dado como<br />

una función que da la altura elipsoidal<br />

<strong>de</strong>pendiendo <strong>de</strong> los valores <strong>de</strong> λ y φ. 22 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

Otros mo<strong>de</strong>los gravitatorios <strong>de</strong> <strong>referencia</strong><br />

Para simplificar, en ocasiones se usan otros mo<strong>de</strong>los más<br />

simples <strong>de</strong> gravedad, p.ej. gravedad constante. No obstante, si<br />

se quiere una gran precisión habrá que utilizar el mo<strong>de</strong>lo más<br />

complejo disponible.<br />

La mayor parte <strong>de</strong> los sistemas <strong>de</strong> navegación emplean<br />

mo<strong>de</strong>los simplificados, don<strong>de</strong> se <strong>de</strong>fine g como un escalar y<br />

luego se escribe g n = [0 0 g], don<strong>de</strong> n es el sistema <strong>de</strong><br />

<strong>referencia</strong> NED (luego D es “hacia abajo”).<br />

Nosotros usaremos g = µe<br />

(re+h) 2 .<br />

El WGS84 <strong>de</strong>fine un mo<strong>de</strong>lo simplificado con algunos<br />

coeficientes (no lo usaremos).<br />

Puesto que el mo<strong>de</strong>lo no es correcto, se <strong>de</strong>be incluir la<br />

posibilidad <strong>de</strong> que tenga errores (anomalías gravitatorias):<br />

g n = [ξg − ηg g], don<strong>de</strong> ξ y η son pequeños ángulos, que se<br />

mantendrán constantes en pequeñas distancias.<br />

23 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Línea <strong>de</strong> plomada y <strong>de</strong>flexión vertical<br />

La geo<strong>de</strong>sia a través <strong>de</strong> la Historia<br />

Mo<strong>de</strong>los <strong>de</strong> Tierra<br />

Mo<strong>de</strong>los gravitatorios <strong>de</strong> la Tierra<br />

La linea <strong>de</strong> plomada o vertical astronómica<br />

es perpendicular al geoi<strong>de</strong>, y es hacia don<strong>de</strong><br />

en la realidad se dirige g.<br />

La linea perpendicular al elipsoi<strong>de</strong> es hacia<br />

don<strong>de</strong> se dirige g según el mo<strong>de</strong>lo <strong>de</strong> la<br />

anterior transparencia.<br />

La diferencia entre ambas es la llamada<br />

“<strong>de</strong>flexión vertical”.<br />

24 / 67


<strong>Cartografía</strong><br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

<strong>Cartografía</strong>: es la disciplina que estudia la teoría y la<br />

confección <strong>de</strong> mapas geográficos y cartas.<br />

Para ello combina ciencia, técnica e incluso estética, partiendo<br />

<strong>de</strong> la premisa <strong>de</strong> que se pue<strong>de</strong> comunicar información<br />

geográfica <strong>de</strong> forma efectiva mo<strong>de</strong>lando a<strong>de</strong>cuadamente la<br />

realidad física.<br />

Los principales problemas que encuentra la<br />

cartografía son:<br />

Seleccionar los aspectos geográficos que se<br />

muestran en una representación.<br />

Eliminar la complejidad innecesaria o<br />

irrelevante contenida en una representación.<br />

Combinar los elementos representativos que<br />

tiene una representación para comunicar <strong>de</strong><br />

forma efectiva la información <strong>de</strong>seada.<br />

Plasmar la representación <strong>de</strong> la realidad<br />

tridimensional sobre una superficie plana (el<br />

mapa o carta): mediante proyecciones. 25 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyecciones. Mapas y Cartas<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Mapas/Cartas: representaciones en un plano y a tamaño<br />

reducido <strong>de</strong> la superficie <strong>de</strong> la Tierra o una parte <strong>de</strong> ella.<br />

Un mapa siempre introduce distorsiones (es <strong>de</strong>cir, no es<br />

completamente fiel a la realidad) <strong>de</strong>bido a que la superficie<br />

que se preten<strong>de</strong> representar tiene curvatura.<br />

Ésto fue <strong>de</strong>mostrado matemáticamente por Euler.<br />

Para crear un mapa se emplea una proyección.<br />

Concretamente, se proyecta el plano terráqueo sobre una<br />

cierta superficie:<br />

Un plano (proyección tipo azimutal).<br />

Un cilindro (proyección cilíndrica).<br />

Un cono.<br />

26 / 67<br />

Proyecciones.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Otras formas <strong>de</strong> clasificar una proyección podrían ser:<br />

Por la orientación <strong>de</strong> la superficie respecto al Ecuador:<br />

normales, trasversales u oblicuas.<br />

Por la posición <strong>de</strong>l globo terráqueo respecto a la superficie:<br />

tangente (podría tener una línea sin <strong>de</strong>formación) o secante<br />

(podría tener dos líneas sin <strong>de</strong>formación).<br />

Más importante es el tipo <strong>de</strong> proyección; p.ej. para el caso<br />

<strong>de</strong> un plano:<br />

Gnomónica (la proyección pasa por el centro <strong>de</strong> la<br />

Tierra).<br />

Estereográfica (pasa por el punto antipodal).<br />

Ortográfica (la proyección tiene una dirección fija).<br />

Escenográfica (la proyección viene <strong>de</strong>s<strong>de</strong> fuera <strong>de</strong>l<br />

globo terrestre).<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Propieda<strong>de</strong>s <strong>de</strong> una proyección<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Las propieda<strong>de</strong>s más importantes <strong>de</strong> una proyección son:<br />

Conformidad. Una proyección es conforme si preserva los<br />

ángulos (y por tanto los rumbos); a<strong>de</strong>más preserva las formas<br />

a nivel local. Los meridianos y paralelos siguen siendo<br />

perpendiculares. Muy útiles en navegación.<br />

Conservación <strong>de</strong> áreas. Una proyección es equiareal si mantiene<br />

la proporción entre áreas. Útiles sobre todo en aplicaciones<br />

administrativas/políticas.<br />

Equidistancia: una proyección NO pue<strong>de</strong> mantener la<br />

proporción correcta entre TODAS las distancias. No obstante<br />

sí pue<strong>de</strong>n existir algunas líneas con esta propiedad: líneas<br />

automecoicas. Una carta que tenga “muchas” líneas<br />

automecoicas se <strong>de</strong>nomina equidistante.<br />

Un mapa no pue<strong>de</strong> ser conforme y equiareal (Euler); si lo<br />

fuera, sería una representación perfecta <strong>de</strong>l globo terrestre.<br />

Siempre hay que renunciar al menos a una <strong>de</strong> las propieda<strong>de</strong>s.<br />

27 / 67<br />

28 / 67


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyección <strong>de</strong> Mercator.<br />

Muy utilizada en navegación marítima.<br />

Inventada en el siglo XVI.<br />

Cilíndrica, trasversal y conforme.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyección cilíndrica equidistante.<br />

Permite ver la Tierra completa.<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Ecuaciones matemáticas:<br />

x = λ − λ0, <br />

y = ln tan<br />

.<br />

<br />

π φ<br />

4 + 2 φ<br />

No acotada en y: se suele cortar a<br />

altas latitu<strong>de</strong>s.<br />

Cuanto más cerca <strong>de</strong> los polos, más<br />

se distorsiona el mapa (observar<br />

como se amplía la distancia en<br />

proyección entre paralelos<br />

equidistantes en la realidad). 29 / 67<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Cilíndrica, trasversal, tangente, ortográfica.<br />

Típicamente usada para representar trazas <strong>de</strong> satélites.<br />

Ecuaciones matemáticas:<br />

x = λ − λ0, y = φ.<br />

Acotada en y. Por tanto, no<br />

conforme.<br />

Tampoco es equiareal.<br />

Su sencillez la hace popular en<br />

representaciones generadas por<br />

or<strong>de</strong>nador.<br />

30 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyección estereográfica.<br />

Útil para estudiar las proximida<strong>de</strong>s <strong>de</strong><br />

un punto, p.ej. el Polo.<br />

Conforme.<br />

Plana, normal, tangente, estereográfica.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyección <strong>de</strong> Lambert.<br />

Utilizada en navegación aérea.<br />

Cónica, normal, secante<br />

y estereográfica.<br />

Las lineas rectas aproximan rutas<br />

ortodrómicas (ver más a<strong>de</strong>lante).<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Ecuaciones matemáticas:<br />

x = cos φ sen(λ − λ0),<br />

y = cos φ0 sen φ − sen φ0 cos φ cos(λ − λ0).<br />

No acotada: se suele cortar a<br />

puntos cercanos al antipodal <strong>de</strong>l<br />

centro <strong>de</strong> la proyección.<br />

Útil para estudiar las proximida<strong>de</strong>s<br />

<strong>de</strong> un punto.<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Ecuaciones matemáticas:<br />

31 / 67<br />

x = ρ sen(n(λ − λ0)), y = ρ0 − ρ cos(n(λ − λ0)),<br />

ln(cos φ don<strong>de</strong>: n =<br />

1 sec φ2 )<br />

ln(tan(π/4−φ2 /2) cot(π/4−φ1 /2)) ,<br />

ρ = F cot n (π/4 + φ/2), ρ0 = F cot n (π/4 + φ0/2),<br />

F = 1/n cos φ1 tan n (π/4 + φ1/2).<br />

No acotada se suele reducir a una<br />

zona <strong>de</strong> interés.<br />

2 paralelos automecoicos (φ1, φ2).<br />

Suelen ser locales y no globales.<br />

32 / 67


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyección azimutal equidistante.<br />

En el emblema <strong>de</strong> la ONU.<br />

Azimutal, escenográfica,<br />

tangente, normal.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Trayectorias más usuales<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Ecuaciones matemáticas:<br />

x = c cos φ sen(λ − λ0),<br />

sen c<br />

y = c<br />

sen c [cos φ0 sen φ − sen φ0 cos φ cos(λ − λ0)], don<strong>de</strong><br />

cos c = sen φ0 sen φ − cos φ0 cos φ cos(λ − λ0).<br />

Acotada: convierte el punto antipodal en<br />

una circunferencia limítrofe.<br />

Sólo libre <strong>de</strong> distorsión en torno al punto<br />

central.<br />

Todas las distancias medidas <strong>de</strong>s<strong>de</strong> el<br />

punto central son verda<strong>de</strong>ras (líneas<br />

automecoicas).<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Dado un mapa, un origen y un <strong>de</strong>stino, se plantea el problema<br />

<strong>de</strong> encontrar el camino más apropiado para ir <strong>de</strong> uno a otro.<br />

En la realidad, esta elección <strong>de</strong>l camino (que se plasma en el<br />

plan <strong>de</strong> vuelo) está sujeta a numerosas restricciones. A día <strong>de</strong><br />

hoy, se vuela entre “waypoints”.<br />

A<strong>de</strong>más habría que tener en cuenta los vientos.<br />

No obstante, en esta lección vamos a simplificar el problema y<br />

vamos a suponer que en principio cualquier camino es volable.<br />

A<strong>de</strong>más supondremos que la Tierra es una esfera <strong>de</strong> radio Re.<br />

Veremos dos posibilida<strong>de</strong>s:<br />

El camino más corto: trayectoria ortodrómica.<br />

El camino más simple <strong>de</strong> volar: trayectoria loxodrómica.<br />

33 / 67<br />

34 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Trayectorias ortodrómicas. Círculos máximos<br />

Una trayectoria ortodrómica entre dos puntos <strong>de</strong> la Tierra es<br />

el camino más corto entre dichos puntos.<br />

Po<strong>de</strong>mos traducir el problema a términos matemáticos,<br />

consi<strong>de</strong>rando un mo<strong>de</strong>lo <strong>de</strong> Tierra esférica.<br />

Dados dos puntos PA y PB en la esfera, dados como (φA,λA)<br />

y (φB,λB), <strong>de</strong> todas las curva sobre la esfera que unen dichos<br />

puntos, ¿cuál es la <strong>de</strong> mínima distancia?<br />

Si estuvieramos en el plano, la respuesta es una línea recta.<br />

En una superficie con curvatura, dicha curva se <strong>de</strong>nomina<br />

geodésica y en general no es una recta.<br />

La geometría diferencial da unas ecuaciones para hallar la<br />

geodésica en función <strong>de</strong> la primera forma diferencial, los<br />

símbolos <strong>de</strong> Christoffel, etc...<br />

Para el caso <strong>de</strong> la esfera, la solución es simple y sólo requiere<br />

el uso <strong>de</strong> geometría elemental.<br />

Círculos máximos<br />

!<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

35 / 67<br />

En una esfera, un “círculo mayor” (gran<br />

círculo, círculo máximo) viene dado por la<br />

intersección <strong>de</strong> un plano que pasa por el<br />

centro <strong>de</strong> la esfera con la esfera.<br />

Las “rectas esféricas” (geodésicas) son<br />

los círculos mayores. Obsérvese que<br />

cualesquiera dos rectas esféricas cortan<br />

siempre en dos puntos; por tanto, no<br />

existen paralelas en geometría esférica.<br />

El problema queda reducido a:<br />

Dados dos puntos, <strong>de</strong>terminar el círculo mayor que contiene a<br />

ambos. ¿Es dicho círculo único?<br />

Medir la distancia sobre dicho círculo: dará la distancia entre<br />

los dos puntos.<br />

36 / 67


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Círculo máximo entre dos puntos<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Dados dos puntos PA = (φA, λA), PB = (φB, λB), se dice que<br />

PA y PB son antipodales si φB = −φA y λB = 180 o + λA.<br />

Si PA y PB NO son antipodales, existe un único círculo<br />

máximo que contenga a ambos. La ortodrómica será el arco<br />

más corto que los una.<br />

Si PA y PB son antipodales, existen infinitos círculos máximos<br />

que los unen; cualquier semicircunferencia <strong>de</strong> dichos círculos<br />

máximos es una ortodrómica. ¿Por qué? ¿Cuál es por tanto la<br />

distancia entre dos puntos antipodales (en millas náuticas)?<br />

¿Son los meridianos ortodrómicas?<br />

¿Son los paralelos ortodrómicas?<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Cálculo <strong>de</strong> la trayectoria ortodrómica. Rumbo<br />

Recor<strong>de</strong>mos que en una esfera,<br />

r = Re [cos φ cos λ cos φ sen λ sen φ].<br />

Recor<strong>de</strong>mos a<strong>de</strong>más los vectores que <strong>de</strong>finen la base local en<br />

coor<strong>de</strong>nadas curvilíneas:<br />

⎡<br />

er = ⎣<br />

cos φ cos λ<br />

cos φ sen λ<br />

sen φ<br />

⎤<br />

⎡<br />

⎦ , eφ = ⎣<br />

− sen φ cos λ<br />

− sen φ sen λ<br />

cos φ<br />

⎤<br />

⎡<br />

⎦ , eλ = ⎣<br />

− sen λ<br />

cos λ<br />

0<br />

37 / 67<br />

Físicamente e r apunta hacia el cénit, e φ hacia el Norte y e λ<br />

hacia el Este.<br />

Dada una curva cualquiera en la esfera, se <strong>de</strong>fine el rumbo<br />

(también llamado azimut) en un punto <strong>de</strong> la curva como el<br />

ángulo que forma el vector e φ con el vector tangente <strong>de</strong> dicha<br />

curva e t, medido en el sentido <strong>de</strong> las agujas <strong>de</strong>l reloj.<br />

¿Qué significado físico tienen los rumbos 0 o , 90 o , 180 o y 270 o ?<br />

En general el rumbo cambiará según el punto <strong>de</strong> la curva y el<br />

sentido en que se recorra. 38 / 67<br />

⎤<br />

⎦ .<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Cálculo <strong>de</strong> la trayectoria ortodrómica<br />

Escribamos los vectores <strong>de</strong> los puntos:<br />

⎡<br />

⎤<br />

r A = Re ⎣<br />

cos φA cos λA<br />

cos φA sen λA<br />

sen φA<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

⎡<br />

⎦ , r B = Re ⎣<br />

cos φB cos λB<br />

cos φB sen λB<br />

sen φB<br />

Geométricamente, se pue<strong>de</strong> ver que el arco que abarca la<br />

ortodrómica es el ángulo α formado por los vectores.<br />

Por tanto:<br />

r A · r B = r Ar B cos α,<br />

y se llega a:<br />

cos α = sen φA sen φB + cos φA cos φB cos(λB − λA)<br />

¿Cuál sería la ecuación implícita que verificarían todos los<br />

puntos <strong>de</strong> la ortodrómica?<br />

Una vez se tiene α, dA,B = αRe.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Cálculo <strong>de</strong>l rumbo en la ortodrómica I<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

¿Cómo calcular el rumbo <strong>de</strong>l que habría que partir <strong>de</strong>s<strong>de</strong> A<br />

para recorrer la ortodrómica? Recor<strong>de</strong>mos que el rumbo sería<br />

el ángulo entre el vector e φ en A y la tangente e t en A.<br />

En primer lugar, se tiene que el vector normal al plano que<br />

<strong>de</strong>fine la ortodrómica será:<br />

n = r A × r B<br />

Por otro lado, e t será perpendicular tanto a n como a e r en<br />

A. Por tanto:<br />

e t(A) = n × e r (A) = (r A × r B) × e r (A)<br />

Usando la i<strong>de</strong>ntidad: a × (b × c) = (a · c)b − (a · b)c, se llega<br />

a:<br />

e t(A) = −e r (A) × (r A × r B) = (e r (A) · r A)r B − (e r (A) · r B)r A<br />

= Re (r B − cos αr A)<br />

⎤<br />

⎦ .<br />

39 / 67<br />

40 / 67


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Cálculo <strong>de</strong>l rumbo en la ortodrómica II<br />

El módulo <strong>de</strong> dicho vector e t es:<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

et(A) =<br />

=<br />

Re (r B − cos αr A) <br />

<br />

Re (r B − cos αr A) · (r B − cos αr<br />

<br />

A)<br />

= Re R2 e + cos2 αR2 e − 2R2 e cos2 α = R 2 e sen α<br />

Por tanto el vector e t normalizado es:<br />

e ∗ t (A) = e r (B) − cos αe r (A)<br />

sen α<br />

El rumbo χ(A) se encontrará <strong>de</strong><br />

cos χ(A) = e φ(A)·e ∗ t (A) = e φ(A) · e r (B) − cos αe φ(A) · e r (A)<br />

sen α<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Cálculo <strong>de</strong>l rumbo en la ortodrómica III<br />

Luego finalmente:<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

cos χ(A) = e φ(A) · e r (B)<br />

sen α<br />

Sustituyendo el valor <strong>de</strong> los vectores, se llega a:<br />

cos χ(A) = cos φA sen φB − cos φB sen φA cos(λB − λA)<br />

sen α<br />

¿Es el rumbo constante en todos los puntos <strong>de</strong> la<br />

ortodrómica?<br />

¿Cómo se resolvería el problema inverso? (Dado un punto<br />

inicial, un rumbo inicial y una distancia a volar, <strong>de</strong>terminar el<br />

punto al que se llega siguiendo una ortodrómica).<br />

¿Cuál es el rumbo en el caso antipodal?<br />

41 / 67<br />

42 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Trayectorias loxodrómicas<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

En la práctica, un piloto no pue<strong>de</strong> volar una ruta ortodrómica<br />

porque el rumbo <strong>de</strong> la trayectoria se modifica continuamente.<br />

La trayectoria más fácil <strong>de</strong> volar es una que mantenga el<br />

rumbo constante.<br />

Una trayectoria loxodrómica entre dos puntos <strong>de</strong> la Tierra es<br />

el camino más corto entre dichos puntos tal que el rumbo <strong>de</strong><br />

dicho camino es constante.<br />

Por tanto, son fáciles <strong>de</strong> volar para un piloto humano.<br />

Una trayectoria ortodrómica será más corta, pero no volable;<br />

por tanto se pue<strong>de</strong> aproximar por varios segmentos<br />

loxodrómicos.<br />

¿Son los meridianos loxodrómicas?<br />

¿Son los paralelos loxodrómicas?<br />

¿Son las loxodrómicas curvas cerradas?<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Cálculo <strong>de</strong> la loxodrómica I<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

En primer lugar resolvamos el problema inverso: dado un<br />

rumbo χ y un punto inicial, ¿qué curva se obtiene si se vuela<br />

con dicho rumbo constante?<br />

Supongamos que <strong>de</strong>scribimos la curva sobre la esfera con una<br />

ecuación <strong>de</strong>l tipo φ = φ(λ).<br />

Ejercicio: probar que se llega a una ecuación diferencial<br />

φ ′<br />

cos φ<br />

= 1<br />

tan χ .<br />

Integrando llegamos a la siguiente ecuación:<br />

<br />

tan (π/4 − φA/2)<br />

ln<br />

=<br />

tan (π/4 − φ/2)<br />

λ − λA<br />

tan χ<br />

¿Cuál sería la distancia entre dos puntos <strong>de</strong> una loxodrómica?<br />

Recordar:<br />

λ<br />

d = etdλ λA<br />

43 / 67<br />

<br />

Se llega a: d = Re 1 + tan2 χ(φ − φA). 44 / 67


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Cálculo <strong>de</strong> la loxodrómica II<br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Ya po<strong>de</strong>mos resolver el problema directo: dados dos puntos A<br />

y B, hallar la loxodrómica que los une y la distancia<br />

loxodrómica que los separa.<br />

En primer lugar hallar el rumbo <strong>de</strong> la ecuación:<br />

<br />

tan (π/4 − φA/2)<br />

ln<br />

=<br />

tan (π/4 − φB/2)<br />

λB − λA<br />

tan χ<br />

En segundo lugar calcular la distancia <strong>de</strong>:<br />

d = Re 1 + tan2 χ(φB − φA).<br />

Tener cuidado con los casos especiales!!<br />

En una proyección <strong>de</strong> Mercator las loxodrómicas son rectas.<br />

Trayectorias ejemplo<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Proyecciones. Mapas y Cartas<br />

Trayectorias ortodrómicas y loxodrómicas<br />

Estudiemos las trayectorias entre Sevilla (λ = 5 o 59 ′ W,<br />

φ = 37 o 24 ′ N) y las ciuda<strong>de</strong>s:<br />

Madrid (λ = 4 o 1 ′ W, φ = 40 o 46 ′ N).<br />

Nueva York (λ = 73 o 58 ′ W, φ = 40 o 47 ′ N).<br />

Melbourne (λ = 144 o 58 ′ E, φ = 37 o 49 ′ S).<br />

Los resultados obtenidos fueron los siguientes:<br />

45 / 67<br />

Ciudad Distancia (ort., km) Rumbo inicial (grados, ort) Distancia (lox., km) Rumbo (lox., grados)<br />

Madrid 410.0943 23.78 410.1023 24.38<br />

NY 5716.03 296.26 5864.08 273.67<br />

Melbourne 17427.04 100 17601.17 118.3<br />

Si numéricamente se calculan los mismos casos sobre el<br />

elipsoi<strong>de</strong> WGS84, se obtienen los siguientes resultados:<br />

Ciudad Distancia (ort., km) Rumbo inicial (grados, ort) Distancia (lox., km) Rumbo (lox., grados)<br />

Madrid 410.64 23.86 410.65 24.47<br />

NY 5742.7 296.26 5891.5 273.65<br />

Melbourne 17469 99.86 17644 118.16<br />

46 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Trayectorias ejemplo: Sevilla-Madrid<br />

56.7*,8)0179-)(4<br />

@83A60179-)(4<br />

!&<br />

!&("<br />

!"<br />

!"("<br />

:9,6)963*/-<br />

;6


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Trayectorias ejemplo: Sevilla-Melbourne<br />

56-7)+8(/079,(34<br />

5,+)+8(/079,(34<br />

?82@6/079,(34<br />

&'!<br />

&!!<br />

'!<br />

!<br />

:6;6(962).,<br />


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Sistema <strong>de</strong> Ejes Tierra (ECEF)<br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

Ligado íntimamente a la Tierra, rota con ella.<br />

Util para <strong>referencia</strong>r posiciones terrestres.<br />

El plano Oxy contiene al Ecuador y el plano Oxz al Meridiano<br />

<strong>de</strong> Greenwich.<br />

La forma <strong>de</strong> la Tierra se asimila a un elipsoi<strong>de</strong> <strong>de</strong> revolución<br />

(Elipsoi<strong>de</strong> Internacional WGS84) alre<strong>de</strong>dor <strong>de</strong>l eje Oz (<strong>de</strong><br />

rotación <strong>de</strong> la Tierra).<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Sistema Topocéntrico<br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

Ligado íntimamente a la Tierra,<br />

con origen en el don<strong>de</strong> se<br />

encuentre el observador (E).<br />

Se usa para tomar medidas<br />

<strong>de</strong>s<strong>de</strong> Tierra.<br />

El plano Exy es tangente al Elipsoi<strong>de</strong> Internacional WGS84 en<br />

la superficie, la dirección Ex apunta al Este, la dirección Ey al<br />

Norte, y la Ez sigue la vertical local “hacia arriba” (cénit). La<br />

dirección local “hacia abajo” se <strong>de</strong>nomina nadir.<br />

Las observaciones se componen <strong>de</strong> tres medidas: r o ρ<br />

(distancia al objeto); A, azimut; y h, la altura o elevación<br />

sobre el plano horizontal.<br />

53 / 67<br />

54 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

Sistema <strong>de</strong> ejes horizonte local (LLS,NED)<br />

42 APPLIED MATHEMATICS IN INTEGRATED NAVIGATION SYSTEMS<br />

Fig. 3.1 ECEF coordinate frame with z axis along Earth's rotation axis.<br />

Earth-Centered, Earth-Fixed Frame<br />

The Earth-centered, Earth-fixed (ECEF) frame is fixed within the Earth and its<br />

rotation, and it is centered at the Earth's center. Axis <strong>de</strong>finitions in current use vary.<br />

Shown in Figs. 3.1, 3.2, and 3.3 are illustrations of three possible ECEF frames.<br />

In the first frame, shown in Fig. 3.1, the z axis is parallel to and aligned with the<br />

direction of the Earth's rotation. In the equatorial plane, the x axis locates the<br />

Greenwich meridian and the y axis completes the right-hand system. In Fig. 3.2,<br />

the y axis is parallel to the direction of the Earth's rotation. In the equatorial plane,<br />

the z axis locates the siguiente Greenwich meridian transparencia).<br />

and the x axis completes the righthand<br />

system. In the third frame, Fig. 3.3, the x axis is parallel to the direction<br />

of the Earth's rotation. The z axis locates the Greenwich meridian and the y axis<br />

completes the right-hand system.<br />

Earth-Centered Inertial Frame<br />

In each of these figures, the corresponding Earth-centered inertial <strong>Geo<strong>de</strong>sia</strong> (ECI) frame is<br />

established by the direction of the Earth's rotation. This inertial frame is fixed to an<br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Cartografía</strong><br />

inertial reference. The further specification of the inertial reference is not necessary <strong>Tiempos</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

for the following <strong>de</strong>velopments; however, if, for example, navigation aids are based<br />

on stellar updates, then the inertial reference would have to be specified.<br />

Local Geo<strong>de</strong>tic Frame<br />

Also shown in Figs. 3.1,3.2, and 3.3 are local geo<strong>de</strong>tic (geographic) frames that<br />

are usually associated with the ECEF frame indicated.<br />

Llamada en inglés LLS=Local Level<br />

System o NED=North East Down.<br />

También “ejes geodéticos o<br />

geodésicos locales”.<br />

Es un sistema local centrado en un<br />

punto que pue<strong>de</strong> o no estar en la<br />

superficie <strong>de</strong> la Tierra.<br />

Por tanto cambia al moverse el<br />

punto.<br />

Está <strong>de</strong>finida respecto al elipsoi<strong>de</strong>: la dirección Norte es eφ, la<br />

dirección Este es eλ y la dirección abajo es −eh. Es el sistema <strong>de</strong> <strong>referencia</strong> fundamental usado en navegación,<br />

aunque a veces es sustituido por el <strong>de</strong> azimut errante (ver<br />

Sistema <strong>de</strong> <strong>referencia</strong> <strong>de</strong> azimut <strong>de</strong> <strong>de</strong>riva<br />

Llamada en inglés “Wan<strong>de</strong>r<br />

azimuth frame”.<br />

55 / 67<br />

Se usa frecuentemente en<br />

navegación en vez <strong>de</strong>l sistema<br />

<strong>de</strong> <strong>referencia</strong> horizonte local<br />

<strong>de</strong>bido a que, en las<br />

proximida<strong>de</strong>s <strong>de</strong> los polos, dicho<br />

sistema está mal <strong>de</strong>finido y<br />

ocasiona problemas numéricos.<br />

Se rota un ángulo α respecto a la dirección N/E. Dicho<br />

ángulo y su variación se pue<strong>de</strong> <strong>de</strong>finir por el diseñador <strong>de</strong>l<br />

sistema <strong>de</strong> navegación.<br />

Con α = ˙α = 0 recuperamos el sistema <strong>de</strong> ejes horizonte local.<br />

Típicamente se <strong>de</strong>fine ˙α = ˙ λ sin φ.<br />

56 / 67


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

Sistema <strong>de</strong> <strong>referencia</strong> ejes cuerpo (BFS)<br />

Llamada en inglés BFS=Body Fixed System.<br />

Se utiliza para <strong>de</strong>finir la actitud (orientación) <strong>de</strong> la aeronave,<br />

respecto el sistema <strong>de</strong> ejes <strong>de</strong> navegación (NED o wan<strong>de</strong>r<br />

azimuth). 57 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

Sistema <strong>de</strong> <strong>referencia</strong> ejes cuerpo (BFS)<br />

Los ejes están <strong>de</strong>finidos como en la<br />

figura.<br />

El centro <strong>de</strong>l sistema <strong>de</strong> <strong>referencia</strong>,<br />

en el centro <strong>de</strong> masas <strong>de</strong>l avión.<br />

El eje xb contenido en el plano <strong>de</strong><br />

simetría <strong>de</strong>l avión, hacia el morro.<br />

El ángulo rotado en torno a xb es ϕ<br />

(alabeo o roll).<br />

El eje zb contenido en el plano <strong>de</strong> simetría <strong>de</strong>l avión, hacia<br />

abajo. El ángulo rotado en torno a zb es ψ (guiñada o yaw).<br />

El eje yb completa el triedro (dirección aproximada <strong>de</strong>l ala<br />

<strong>de</strong>recha). El ángulo rotado en torno a yb es θ (cabeceo o<br />

pitch).<br />

58 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

Relación entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Dado un sistema <strong>de</strong> <strong>referencia</strong> A y un sistema <strong>de</strong> <strong>referencia</strong> B,<br />

para pasar <strong>de</strong> uno a otro habrá que tener en cuenta dos<br />

hechos:<br />

Cuando no coinci<strong>de</strong>n los orígenes <strong>de</strong> A y B, habrá que realizar<br />

una translación: r A = r B + r BA.<br />

Cuando A y B están rotados entre sí, habrá que realizar una<br />

rotación: r A = C A B r B , don<strong>de</strong> C A B será la matriz <strong>de</strong>l cambio <strong>de</strong><br />

base entre A y B (ortogonal).<br />

A<strong>de</strong>más, a la hora <strong>de</strong> estudiar <strong>de</strong>rivadas, hay que tener en<br />

cuenta que la <strong>de</strong>rivada tomada en dos sistema <strong>de</strong> <strong>referencia</strong><br />

distintos cambia si dichos sistemas rotan uno en relación al<br />

otro con velocidad angular ω B/A. Lo estudiaremos más<br />

a<strong>de</strong>lante.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Algunas <strong>de</strong>finiciones <strong>de</strong> interés<br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

Velocidad inercial: es la <strong>de</strong>rivada <strong>de</strong> la posición, tomada en el<br />

sistema <strong>de</strong> <strong>referencia</strong> inercial, es <strong>de</strong>cir, v i = ˙r i .<br />

Velocidad respecto a Tierra: es la <strong>de</strong>rivada <strong>de</strong> la posición,<br />

tomada en el sistema <strong>de</strong> <strong>referencia</strong> ejes Tierra, es <strong>de</strong>cir,<br />

v e = ˙r e .<br />

Obsérvese que ambas <strong>de</strong>finiciones no coinci<strong>de</strong>n puesto que la<br />

Tierra rota; a<strong>de</strong>más v e = C e<br />

i v i porque las <strong>de</strong>rivadas no están<br />

tomadas en el mismo sistema <strong>de</strong> <strong>referencia</strong>. Más a<strong>de</strong>lante<br />

veremos como están relacionadas ambas cantida<strong>de</strong>s.<br />

Velocidad en los ejes <strong>de</strong> navegación: es la velocidad respecto a<br />

Tierra v e tomada en el sistema <strong>de</strong> <strong>referencia</strong> <strong>de</strong> navegación,<br />

es <strong>de</strong>cir, v n = C n e v e . Obsérvese que v n = ˙r n = 0!<br />

59 / 67<br />

60 / 67


<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Algunas <strong>de</strong>finiciones <strong>de</strong> interés<br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

Ésta velocidad v n es la velocidad “percibida” en el avión.<br />

Cuando n es el sistema <strong>de</strong> <strong>referencia</strong> horizonte local, esta<br />

velocidad se suele <strong>de</strong>scomponer en:<br />

Módulo: velocidad respecto a Tierra, a veces llamada Vg . Sería<br />

la velocidad real <strong>de</strong>l avión respecto al suelo.<br />

Ángulo formado entre v n y el plano horizonte local: ángulo <strong>de</strong><br />

trayectoria γ (flight path angle).<br />

Ángulo formado entre la proyección <strong>de</strong> v n en el plano horizonte<br />

local y la dirección Norte: ángulo <strong>de</strong> rumbo χ (heading angle).<br />

Hay que tener en cuenta que el ángulo <strong>de</strong> rumbo χ y el <strong>de</strong><br />

guiñada ψ pue<strong>de</strong>n no coincidir, especialmente en presencia <strong>de</strong><br />

viento.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Relación entre ECEF y ECI.<br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

Para encontrar C e<br />

i , hay que tener en cuenta que la Tierra gira<br />

con velocidad angular ωi/e = [0 0 ωE ] T , es <strong>de</strong>cir, ambos<br />

sistemas <strong>de</strong> <strong>referencia</strong> estarán rotados una cantidad<br />

θE = θE0 + ωE t. Luego:<br />

Por tanto:<br />

C e<br />

i =<br />

Don<strong>de</strong> c = cos y s = sen.<br />

ECI θE<br />

−→z i ECEF<br />

⎡<br />

⎣<br />

cθE sθE 0<br />

−sθE cθE 0<br />

0 0 1<br />

⎤<br />

⎦<br />

61 / 67<br />

62 / 67<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Relación entre ECI y LLS.<br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

Para encontrar C g e (don<strong>de</strong> g hace <strong>referencia</strong> al carácter<br />

geodésico <strong>de</strong> LLS), hay que tener en cuenta la posición (λ, φ)<br />

y realizar las siguientes operaciones:<br />

Rotar λ grados en torno a z e .<br />

Rotar −φ grados en torno al nuevo eje y.<br />

El sistema resultante tiene x en la dirección −z y z en la<br />

dirección x. Por tanto girar -90 grados adicionales.<br />

Por tanto:<br />

C S<br />

e<br />

=<br />

2<br />

4<br />

ECEF λ −φ<br />

−→ S −→<br />

cλ sλ 0<br />

−sλ cλ 0<br />

0 0 1<br />

2<br />

C g<br />

e = C g S′ S<br />

S ′ CS Ce = 4<br />

z e<br />

3<br />

5 C S′<br />

S = 4<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

y S S ′ −90<br />

−→<br />

y S<br />

2<br />

′ LLS<br />

cφ 0 sφ<br />

0 1 0<br />

−sφ 0 cφ<br />

−sφcλ −sφsλ cφ<br />

−sλ cλ 0<br />

−cφcλ −cφsλ −sφ<br />

3<br />

5<br />

3<br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

Relación entre LLS y azimut errante (n).<br />

5 C g<br />

S ′ =<br />

2<br />

4<br />

0 0 1<br />

0 1 0<br />

−1 0 0<br />

Para encontrar C n g , hay que tener en cuenta que la rotación <strong>de</strong><br />

ángulo α en torno al eje z. Por tanto:<br />

Por tanto:<br />

C n g =<br />

LLS α<br />

−→ z WA<br />

⎡<br />

⎣<br />

cα sα 0<br />

−sα cα 0<br />

0 0 1<br />

⎤<br />

⎦<br />

3<br />

5<br />

63 / 67<br />

64 / 67


Fig. 2.3 Single rotation in three-axis coordinate frame.<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

A vector's components <strong>de</strong>scribed in one frame can be <strong>de</strong>scribed in <strong>Cartografía</strong> another frame<br />

<strong>Tiempos</strong><br />

of arbitrary orientation with respect to the original <strong>Sistemas</strong> frame <strong>de</strong> <strong>referencia</strong>. by a transformation <strong>Tiempos</strong> matrix<br />

composed of three sequential rotations (Euler angles) starting from the original<br />

frame's axes. These rotations are illustrated in Fig. 2.4. In this figure, the primes<br />

are used to represent Relación the corresponding entre transformed n yaxis. BFS The final y frame corresponds<br />

to the triple primed x axes. Written in vector form, the transformation is<br />

Para encontrar C b n hay que tener en cuenta los ángulos <strong>de</strong><br />

where the transformation DCM, c:, transforms the components of the r vector<br />

from the x frame to the y frame. Euler (ψ, θ, ϕ).<br />

Se llega a:<br />

Fig. 2.4 Three rotations in three-axis coordinate frame.<br />

2<br />

C b<br />

n = C b S′ S<br />

S ′ CS Cn = 4<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

Las operaciones son:<br />

Rotar ψ grados en torno a z n .<br />

Rotar θ grados en torno al nuevo eje y.<br />

Rotar ϕ grados en torno al nuevo eje x.<br />

n ψ θ<br />

−→ S −→<br />

z n<br />

y S<br />

S ′ ϕ<br />

−→ BFS<br />

′<br />

x S<br />

cθcψ −cϕsψ + sϕsθcψ sϕsψ + cϕsθcψ<br />

cθsψ cϕcψ + sϕsθsψ −sϕcψ + cϕsθsψ<br />

−sθ sϕcθ cϕcθ<br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

<strong>Tiempos</strong> <strong>de</strong> interés en Navegación Aérea<br />

Tiempo Universal Coordinado (UTC):<br />

Medido por relojes atómicos a lo largo <strong>de</strong>l mundo.<br />

Cada cierto tiempo (a lo largo <strong>de</strong> años) se aña<strong>de</strong>n o restan<br />

segundos para compensar la pequeña irregularidad <strong>de</strong> la<br />

rotación <strong>de</strong> la Tierra.<br />

El huso horario se <strong>de</strong>fine como UTC±n. A<strong>de</strong>más hay que tener<br />

en cuenta el cambio <strong>de</strong> horario <strong>de</strong> verano. Por ejemplo, Sevilla<br />

es UTC+1, y en verano UTC+2.<br />

A efectos prácticos UTC coinci<strong>de</strong> con el viejo GMT.<br />

Tiempo GPS (GPST):<br />

Sirve <strong>de</strong> <strong>referencia</strong> para las aplicaciones relacionadas con GPS.<br />

Medido en los relojes atómicos a bordo <strong>de</strong> los Navstar.<br />

No se aña<strong>de</strong>n ni restan segundos: no coinci<strong>de</strong> con UTC (difiere<br />

en segundos).<br />

3<br />

5<br />

65 / 67<br />

66 / 67<br />

Husos horarios<br />

<strong>Geo<strong>de</strong>sia</strong><br />

<strong>Cartografía</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong>. <strong>Tiempos</strong><br />

<strong>Sistemas</strong> <strong>de</strong> <strong>referencia</strong><br />

<strong>Tiempos</strong><br />

67 / 67


Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Navegación Aérea<br />

Tema 2: Conceptos Básicos <strong>de</strong> Navegación Aérea.<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Historia <strong>de</strong> la navegación: La estrella Polar<br />

En tiempos antiguos, la navegación (fundamentalmente<br />

marítima) se realizaba fundamentalmente <strong>de</strong> dos formas:<br />

navegación visual: basada en puntos <strong>de</strong> <strong>referencia</strong> conocidos.<br />

navegación astronómica: basada en la observación <strong>de</strong><br />

fenómenos celestes.<br />

La estrella polar (Polaris) es un punto <strong>de</strong> <strong>referencia</strong><br />

fijo en el cielo <strong>de</strong>l Hemisferio Norte; está casi<br />

alineada con el eje <strong>de</strong> rotación <strong>de</strong> la Tierra. Se<br />

localiza encontrando primero la constelación <strong>de</strong> la<br />

Osa Mayor.<br />

Por tanto, su elevación en el cielo sobre el horizonte<br />

(hPOLARIS) es exactamente igual a la latitud (φ) <strong>de</strong>l<br />

observador: φ = hPOLARIS.<br />

2 / 28<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Historia <strong>de</strong> la navegación: El Sol<br />

De día o con el cielo nublado, no es posible <strong>de</strong>terminar<br />

hPOLARIS. Si es posible ver el Sol, entonces se pue<strong>de</strong> usar la<br />

elevación en el cielo <strong>de</strong>l Sol, al mediodía: hSUN.<br />

El mediodía local está <strong>de</strong>terminado cuando el Sol alcanza su<br />

máxima elevación en el cielo. En ese instante pasa por el<br />

meridiano <strong>de</strong>l observador.<br />

Se <strong>de</strong>be conocer un dato llamado la <strong>de</strong>clinación <strong>de</strong>l<br />

Sol, δSUN (es la “latitud geocéntrica <strong>de</strong>l Sol”) . Esta<br />

<strong>de</strong>clinación <strong>de</strong>pen<strong>de</strong> <strong>de</strong>l día <strong>de</strong>l año y se pue<strong>de</strong><br />

encontrar en tablas o calcularse.<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Entonces: φ = 90 o − hSUN + δSUN.<br />

Historia <strong>de</strong> la navegación: El hemisferio Sur<br />

En el hemisferio Sur, <strong>de</strong> noche, no se pue<strong>de</strong> ver la estrella<br />

Polaris, ni existe ninguna estrella alineada con el eje <strong>de</strong><br />

rotación <strong>de</strong> la Tierra hacia el Sur.<br />

Se emplea una constelación (“la cruz”) cuyo “brazo<br />

mayor” apunta en dirección al Polo Sur celeste.<br />

A una distancia <strong>de</strong> 4.5 veces dicho brazo se<br />

encuentra el Polo Sur celeste. Su elevación es −φ.<br />

Otra alternativa es usar el “Puntero <strong>de</strong> la cruz”, dos<br />

estrellas cercanas a la Cruz, como se muestra en la<br />

figura.<br />

3 / 28<br />

4 / 28


Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Historia <strong>de</strong> la navegación: Instrumentos<br />

En todas las situaciones anteriores, es necesario medir la<br />

elevación <strong>de</strong> un objeto celeste en el cielo.<br />

Para ello se usaban diversos instrumentos astronómicos.<br />

Astrolabio: media circunferencia (ant. siglo X).<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Cuadrante: un cuarto <strong>de</strong> circunferencia (siglo XII).<br />

Sextante: un sexto <strong>de</strong> circunferencia, con mecanismo<br />

más sofisticado (<strong>de</strong> forma que no sea necesario,<br />

p.ej., mirar directamente al Sol) y mayor precisión<br />

(siglo XVIII).<br />

Historia <strong>de</strong> la navegación: Navegación a estima<br />

Hallar la latitud mediante los métodos anteriormente <strong>de</strong>scritos<br />

no es suficiente para encontrar la posición sobre la Tierra.<br />

No obstante, conocida una estimación <strong>de</strong> la posición inicial<br />

(fix), <strong>de</strong>l rumbo, y <strong>de</strong> la velocidad, y midiendo el tiempo, es<br />

posible pre<strong>de</strong>cir la trayectoria.<br />

En los barcos, para pre<strong>de</strong>cir la velocidad, se utilizaba<br />

la llamada “corre<strong>de</strong>ra”: formada por un lastre<br />

(barquilla), una carrete y un cordón marcado con<br />

nudos, separados 15.43 metros (1 mn/120).<br />

Lanzando la barquilla al agua y contando el número<br />

<strong>de</strong> nudos en 30 segundos, se estima la velocidad.<br />

5 / 28<br />

Conocida la velocidad y el rumbo, se pue<strong>de</strong> estimar<br />

(por ejemplo en una carta tipo Mercator) la<br />

trayectoria recorrida por el barco, durante un tiempo<br />

dado (medido por ejemplo con un reloj <strong>de</strong> arena),<br />

siguiendo la ruta loxodrómica.<br />

Problema: los errores (<strong>de</strong>riva) crecen con t. 6 / 28<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Historia <strong>de</strong> la navegación: El problema <strong>de</strong> la longitud I<br />

Con los métodos anteriormente <strong>de</strong>scritos se pue<strong>de</strong> conseguir<br />

una navegación “cruda” (<strong>de</strong> hecho se llegó a América), pero<br />

no es posible localizar con precisión la situación <strong>de</strong> un barco<br />

en medio <strong>de</strong> los océanos.<br />

Para hacerlo es necesario hallar la longitud. La solución<br />

teórica <strong>de</strong> este problema era ya conocida en el siglo XVI.<br />

1 Observar una estrella <strong>de</strong> movimiento conocido o el<br />

Sol al mediodía (mediante p.ej. un sextante).<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

2 Medir el tiempo <strong>de</strong> observación (mediante un<br />

cronómetro).<br />

3 Comparar con la posición <strong>de</strong> dicho cuerpo estelar en<br />

un lugar conocido (obtenida <strong>de</strong> tablas <strong>de</strong><br />

efeméri<strong>de</strong>s).<br />

4 Resolver el triángulo astronómico (usando<br />

trigonometría elemental).<br />

Historia <strong>de</strong> la navegación: El problema <strong>de</strong> la longitud II<br />

Por ejemplo, si para un día dado se <strong>de</strong>termina la hora t a la<br />

que es el mediodía local, y se conoce la hora t0 en la que es<br />

mediodía local, dicho día, en Greenwich: λ ≈ (t0 − t)15 o ,<br />

don<strong>de</strong> los tiempos están medidos en horas y con el mismo<br />

reloj.<br />

El problema es tecnológico: ¿cómo medir el tiempo con<br />

precisión a bordo <strong>de</strong> un barco que navega durante meses?<br />

Los mejores cronómetros <strong>de</strong>l siglo XVI tenían al<br />

menos 10 minutos <strong>de</strong> error al día.<br />

El problema fue tan importante que varios países<br />

(España en 1598, Gran Bretaña en 1714)<br />

convocaron concursos internacionales.<br />

Finalmente John Harrison (1730) resolvió el<br />

problema para Inglaterra inventando un reloj que<br />

cometía un error <strong>de</strong> segundos al día.<br />

7 / 28<br />

Su mejor reloj viajó a Jamaica <strong>de</strong>s<strong>de</strong> Inglaterra<br />

cometiendo sólo 5 segundos <strong>de</strong> error en 1764. 8 / 28


Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Historia <strong>de</strong> la navegación: La era mo<strong>de</strong>rna<br />

El nacimiento <strong>de</strong> la aeronáutica ha <strong>de</strong>mandado una gran<br />

mejora <strong>de</strong> los métodos <strong>de</strong> navegación, que ha <strong>de</strong> tener en<br />

cuenta las 3 dimensiones.<br />

En la primera mita <strong>de</strong>l siglo XX nacen las radioayudas: ADF,<br />

VOR, ILS...<br />

En la segunda mitad <strong>de</strong>l siglo XX:<br />

Los avances en computación hacen posible la navegación<br />

inercial.<br />

La conquista <strong>de</strong>l espacio hace posible la navegación por<br />

satélite: Transit, GPS...<br />

Últimos avances: sensores inerciales <strong>de</strong> bajo coste, GPS<br />

diferencial, futuro sistema GALILEO...<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Tipos <strong>de</strong> navegación<br />

Navegación. <strong>Sistemas</strong> <strong>de</strong> navegación.<br />

Navegación: Conjunto <strong>de</strong> técnicas para <strong>de</strong>splazarse entre dos<br />

puntos conocidos, origen y <strong>de</strong>stino, siguiendo una cierta<br />

trayectoria.<br />

<strong>Sistemas</strong> <strong>de</strong> navegación: permiten obtener la posición,<br />

velocidad, actitud y tiempo en cualquier instante. PVAT:<br />

9 / 28<br />

P: posición, dada como x e = [x e y e z e ] T , (λ, φ, h)...<br />

V: velocidad, dada como V n g o (Vg , γ, χ)...<br />

A: actitud, dada por los ángulos <strong>de</strong> Euler (ψ, θ, ϕ) u<br />

otras representaciones.<br />

T: tiempo (UTC).<br />

10 / 28<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Errores <strong>de</strong> navegación.<br />

Tipos <strong>de</strong> navegación<br />

Un sistema <strong>de</strong> navegación no sólo tiene que proporcionar<br />

como salida el dato actual <strong>de</strong> PVAT. Puesto que la estimación<br />

<strong>de</strong>l PVAT nunca es perfecta, también es necesario conocer<br />

una estimación <strong>de</strong>l error cometido.<br />

Típicamente se visualiza para cada instante el error como una<br />

región <strong>de</strong> incertidumbre (típicamente un elipsoi<strong>de</strong>) en cuyo<br />

centro se encuentra la estimación actual <strong>de</strong> la posición <strong>de</strong>l<br />

avión.<br />

El error cometido en la dirección <strong>de</strong>l movimiento se llama ATE<br />

(along-track error).<br />

El error cometido en la dirección perpendicular al movimiento<br />

se llama CTE/XTE (cross-track error).<br />

El error cometido en la dirección vertical se llama VE (vertical<br />

error).<br />

Uno <strong>de</strong> los objetivos <strong>de</strong> la navegación es minimizar la<br />

incertidumbre en posición, es <strong>de</strong>cir, minimizar el tamaño <strong>de</strong>l<br />

elipsoi<strong>de</strong> <strong>de</strong> incertidumbre.<br />

11 / 28<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Tipos <strong>de</strong> Navegación<br />

Tipos <strong>de</strong> navegación<br />

Los sistemas <strong>de</strong> navegación se pue<strong>de</strong>n dividir en dos gran<strong>de</strong>s<br />

familias:<br />

Navegación autónoma: Aquella que emplea dispositivos<br />

internos <strong>de</strong> la aeronave sin necesidad <strong>de</strong> emplear sistemas<br />

externos. Por tanto no son vulnerables a fallos en<br />

comunicaciones, ni <strong>de</strong>pen<strong>de</strong>n <strong>de</strong> la disponibilidad <strong>de</strong> otros<br />

sistemas ajenos. Ello los hace muy <strong>de</strong>seables, especialmente en<br />

aeronaves militares. Dos ejemplos son la antigua navegación a<br />

estima y la navegación inercial (que no es sino un tipo<br />

sofisticado <strong>de</strong> navegación a estima).<br />

Navegación por posicionamiento: Emplea medidas externas<br />

como <strong>referencia</strong> para localizar la posición. Por ejemplo,<br />

navegación visual (basada en puntos <strong>de</strong> <strong>referencia</strong> visuales),<br />

navegación astronómica (basada en la observación <strong>de</strong> cuerpos<br />

celestes), navegación basada en radioayudas (basada en<br />

señales <strong>de</strong> radio recibidas), navegación por satélite...<br />

En realidad, ambos tipos <strong>de</strong> navegación son complementarios<br />

y la ten<strong>de</strong>ncia mo<strong>de</strong>rna es a integrarlos.<br />

12 / 28


Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Navegación integrada<br />

Tipos <strong>de</strong> navegación<br />

La navegación integrada es aquella que emplea la información<br />

proporcionada por todos los diferentes sensores y sistemas <strong>de</strong><br />

navegación para obtener la mejor estimación PVAT posible.<br />

La navegación autónoma (p.ej. inercial) proporciona una<br />

estimación continua (alto ancho <strong>de</strong> banda), integrando las<br />

ecuaciones <strong>de</strong>l movimiento. Pero se <strong>de</strong>grada con el tiempo<br />

(errores no acotados).<br />

La navegación por posicionamiento proporciona una<br />

estimación cada cierto tiempo (bajo ancho <strong>de</strong> banda), pero<br />

con error acotado.<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

La actitud <strong>de</strong> la aeronave<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

La actitud <strong>de</strong> la aeronave es su orientación respecto al sistema<br />

<strong>de</strong> <strong>referencia</strong> <strong>de</strong> navegación (típicamente el sdr horizonte local<br />

o el <strong>de</strong> azimut errante).<br />

En realidad, es suficiente conocer la orientación <strong>de</strong> un sistema<br />

<strong>de</strong> <strong>referencia</strong> solidario a la aeronave (los ejes cuerpo).<br />

Los ángulos <strong>de</strong> Euler cabeceo, guiñada y alabeo son la<br />

representación clásica, pero no la única; existen otras<br />

representaciones con diferentes ventajas e inconvenientes.<br />

Estudiaremos cuatro representaciones diferentes:<br />

Matriz <strong>de</strong> cosenos directores.<br />

Ángulos <strong>de</strong> Euler.<br />

Ángulo y eje <strong>de</strong> Euler.<br />

Cuaterniones.<br />

Nota: La posición (φ, λ) o (φ, λ, α) también se pue<strong>de</strong><br />

consi<strong>de</strong>rar una “orientación” <strong>de</strong>l sistema <strong>de</strong> <strong>referencia</strong> <strong>de</strong><br />

navegación respecto al ECEF.<br />

13 / 28<br />

14 / 28<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Matriz <strong>de</strong> cosenos directores (DCM) I<br />

Dado un sistema <strong>de</strong> <strong>referencia</strong> S (<strong>de</strong>terminado por una base<br />

<strong>de</strong> vectores unitarios (e x, e y , e z) y otro S’ (<strong>de</strong>terminado por<br />

una base <strong>de</strong> vectores unitarios (e x ′, e y ′, e z ′), la orientación <strong>de</strong><br />

S respecto a S’ está totalmente <strong>de</strong>terminada por la matriz <strong>de</strong><br />

cambio <strong>de</strong> base C S′<br />

S , que para un vector genérico v permite<br />

cambiar <strong>de</strong> base: v S′<br />

= C S′<br />

S v S . Denotemos:<br />

C S′<br />

S =<br />

2<br />

4 c11 c12 c13<br />

c21 c22 c23<br />

c31 c32 c33<br />

Obsérvese: eS′ x = C S′<br />

S eS x = C S′<br />

S [1 0 0]T = [c11 c21 c31] T .<br />

Luego: ex ′ · ex = (eS′ x ′ )T eS′ x = [1 0 0][c11 c21 c31] T = c11.<br />

Igualmente:<br />

c21 = e y ′ · e x , c31 = e z ′ · e x<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

c12 = e x ′ · e y , c22 = e y ′ · e y , c32 = e z ′ · e y<br />

c13 = e x ′ · e z , c23 = e y ′ · e z , c32 = e z ′ · e z<br />

3<br />

5<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Matriz <strong>de</strong> cosenos directores (DCM) II<br />

Por tanto:<br />

2<br />

C S′<br />

S = 4<br />

e x ′ · e x e x ′ · e y e x ′ · e z<br />

e y ′ · e x e y ′ · e y e y ′ · e z<br />

e z ′ · e x e z ′ · e y e z ′ · e z<br />

Obsérvese que razonando igualmente:<br />

C S<br />

S ′ =<br />

2<br />

6<br />

4<br />

e x ′ · e x e y ′ · e x e z ′ · e x<br />

e x ′ · e y e y ′ · e y e z ′ · e y<br />

e x ′ · e z e y ′ · e z e z ′ · e z<br />

3<br />

3<br />

5<br />

7<br />

5 = (C S′<br />

S )T<br />

Y por tanto, puesto que C S S′<br />

S ′ = (CS )−1 , obtenemos que<br />

C S S′<br />

S ′ es ortogonal, es <strong>de</strong>cir: (CS )−1 = (C S′<br />

S )T . También se<br />

justifica el nombre “matriz <strong>de</strong> cosenos directores”.<br />

Otra propiedad es <strong>de</strong>t(C S S ′) = 1. Esto se <strong>de</strong>be a que<br />

1 = <strong>de</strong>t(Id) = <strong>de</strong>t((C S S ′)(C S S ′)−1 ) = <strong>de</strong>t((C S S ′)(C S S ′)T ) =<br />

<br />

S <strong>de</strong>t(CS ′) 2 S . Por tanto <strong>de</strong>t(CS ′) = ±1. El signo +<br />

correspon<strong>de</strong> a los sistemas <strong>de</strong> <strong>referencia</strong> que son triedros<br />

“a <strong>de</strong>rechas”.<br />

15 / 28<br />

16 / 28


Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Matriz <strong>de</strong> cosenos directores (DCM) III<br />

Es una representación <strong>de</strong> la actitud con 9 parámetros. Estos<br />

parámetros son <strong>de</strong>pendientes entre sí, es <strong>de</strong>cir, las entradas <strong>de</strong><br />

la matriz C no pue<strong>de</strong>n ser cualesquiera (la matriz ha <strong>de</strong> ser<br />

ortogonal y con <strong>de</strong>terminante +1).<br />

Supongamos que la actitud <strong>de</strong> S2 respecto a S1 viene dada<br />

por C S2<br />

S1 y que la actitud <strong>de</strong> S3 respecto a S2 viene dada por<br />

C S3<br />

S2 . La actitud <strong>de</strong> S3 respecto a S1 viene dada por<br />

C S3<br />

S1<br />

= C S3<br />

S2<br />

C S2<br />

S1<br />

. Por tanto la “composición” <strong>de</strong> actitu<strong>de</strong>s viene<br />

dada por un simple producto matricial.<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Ángulos <strong>de</strong> Euler I<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

En general una actitud se pue<strong>de</strong> <strong>de</strong>scribir mediante tres<br />

rotaciones, en ejes no consecutivos.<br />

Por ejemplo, la rotación clásica:<br />

n ψ θ<br />

−→ S −→<br />

z n<br />

Existen otras posibilida<strong>de</strong>s:<br />

z S<br />

y S<br />

S ′ ϕ<br />

−→ BFS<br />

′<br />

n θ1 θ2<br />

−→ S −→<br />

xn y S S ′ θ2<br />

Ω i<br />

−→ BFS n −→ S −→<br />

′ zn x S<br />

xS S ′ ω<br />

zS −→ BFS<br />

′<br />

Existen hasta 12 posibles secuencias <strong>de</strong> ángulos <strong>de</strong> Euler para<br />

representar la actitud.<br />

El número <strong>de</strong> parámetros <strong>de</strong> cada secuencia es siempre 3.<br />

Se pue<strong>de</strong> obtener la DCM a partir <strong>de</strong> los ángulos <strong>de</strong> Euler<br />

mediante multiplicación <strong>de</strong> matricies <strong>de</strong> rotación elementales.<br />

Por ejemplo: C b n (ψ, θ, ϕ) = C b S<br />

′(ϕ)C S′<br />

S (θ)C S n (ψ).<br />

17 / 28<br />

18 / 28<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Ángulos <strong>de</strong> Euler II<br />

Como ya vimos, para el caso (ψ, θ, ϕ):<br />

2<br />

C b<br />

n = 4<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

cθcψ cθsψ −sθ<br />

−cϕsψ + sϕsθcψ cϕcψ + sϕsθsψ sϕcθ<br />

sϕsψ + cϕsθcψ −sϕcψ + cϕsθsψ cϕcθ<br />

Obsérvese que (180 o + ψ, 180 o − θ, 180 o + ϕ) es la misma<br />

actitud que (ψ, θ, ϕ). Por ello se suelen limitar los<br />

ángulos, típicamente θ ∈ [−90 o , 90 o ].<br />

n ψ<br />

−→ z n<br />

θ<br />

S −→ S<br />

y S<br />

′ ϕ<br />

−→ BFS<br />

xS ′<br />

Para obtener los ángulos <strong>de</strong> la DCM:<br />

1 θ = − arc sen c13.<br />

2 Con cos ψ = c11/ cos θ, sen ψ = c12/ cos θ, obtener ψ.<br />

3 Con sen ϕ = c23/ cos θ, cos ϕ = c33/ cos θ, obtener ϕ.<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Ángulos <strong>de</strong> Euler III<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Su mayor ventaja es su significado físico.<br />

No obstante, hay que tener cuidado a la hora <strong>de</strong> componer<br />

dos actitu<strong>de</strong>s.<br />

Supongamos que la actitud <strong>de</strong> S2 respecto a S1 viene dada<br />

por (ψ1, θ1, ϕ1) y que la actitud <strong>de</strong> S3 respecto a S2 viene<br />

dada por (ψ2, θ2, ϕ2). Denotemos como (ψ3, θ3, ϕ3) la actitud<br />

<strong>de</strong> S3 respecto a S1. En general: ψ3 = ψ1 + ψ2, θ3 = θ1 + θ2,<br />

ϕ3 = ϕ1 + ϕ2.<br />

Para obtener (ψ3, θ3, ϕ3) hay que calcular los ángulos <strong>de</strong> Euler<br />

a partir <strong>de</strong> C S3<br />

S1<br />

= C S2<br />

S1 (ψ1, θ1, ϕ1)C S3<br />

S2 (ψ2, θ2, ϕ2).<br />

Por tanto es complicado operar con ángulos <strong>de</strong> Euler.<br />

3<br />

5<br />

19 / 28<br />

20 / 28


Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Ángulo y eje <strong>de</strong> Euler I<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Teorema <strong>de</strong> Euler: “el movimiento más general posible <strong>de</strong> un<br />

sólido con un punto fijo es una rotación alre<strong>de</strong>dor <strong>de</strong> un único<br />

eje”.<br />

Nota: De momento consi<strong>de</strong>ramos la actitud en un instante <strong>de</strong><br />

tiempo concreto, es <strong>de</strong>cir, no estudiamos cuando hay una<br />

rotación que cambia con el tiempo.<br />

Denominemos a un vector unitario en la dirección <strong>de</strong> dicho eje<br />

(Eje <strong>de</strong> Euler) como e S/S ′ y a la magnitud <strong>de</strong> la rotación<br />

( Ángulo <strong>de</strong> Euler) como θ.<br />

Por tanto eS/S ′ = 1 y si escribimos eS′ S/S ′ = [ex ey ez] T , se<br />

tiene que e2 x + e2 y + e2 z = 1.<br />

Dado un vector v = [vx vy vz] T <strong>de</strong>finimos el operador v ×<br />

como:<br />

2<br />

v × = 4<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Ángulo y eje <strong>de</strong> Euler II<br />

0 −vz vy<br />

vz 0 −vx<br />

−vy vx 0<br />

3<br />

5<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

El operador v × sirve para escribir fácilmente el producto<br />

escalar v × w, para cualquier vector w, en un sistema <strong>de</strong><br />

<strong>referencia</strong> dado S: (v × w) S = v S ×<br />

w S .<br />

Por tanto la actitud con el ángulo y eje <strong>de</strong> Euler queda<br />

representada con los parámetros (eS′ S/S ′, θ). ¿Cómo se pue<strong>de</strong><br />

pasar <strong>de</strong> estos parámetros a la DCM y viceversa?<br />

Se tiene que<br />

C S′<br />

S<br />

S′<br />

= cos θId + (1 − cos θ)eS′ S/S ′(e S/S ′) T − sen θ<br />

Ésta es la llamada fórmula <strong>de</strong> Euler-Rodrigues.<br />

Por otro lado, dada C S′<br />

S , se tiene que:<br />

cos θ =<br />

<br />

e S′<br />

S/S ′<br />

×<br />

=<br />

S′ Tr(CS ) − 1<br />

2<br />

1<br />

2 sen θ<br />

<br />

(C S′<br />

S )T − C S′<br />

<br />

S<br />

<br />

eS′ S/S ′<br />

×<br />

.<br />

21 / 28<br />

22 / 28<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Ángulo y eje <strong>de</strong> Euler III<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Por tanto se representa la actitud con cuatro parámetros: tres<br />

componentes <strong>de</strong> un vector unitario y un ángulo. Estos<br />

parámetros tienen un claro significado físico.<br />

Obsérvese que la actitud dada por (eS′ S/S ′, θ) y por<br />

(−eS′ S/S ′, −θ) es exactamente la misma. Para evitar ésta<br />

ambigüedad, se restringe θ al intervalo [0, 180o ].<br />

La actitud inversa (la <strong>de</strong> S respecto a S ′ ) vendrá dada por<br />

(eS S ′ /S , θ′ ). Obsérvese que eS S ′ /S = eS′<br />

S/S ′ y θ ′ = −θ.<br />

Finalmente si la actitud <strong>de</strong> S2 respecto a S1 viene dada por<br />

(e S2<br />

S1/S2 , θ1) y que la actitud <strong>de</strong> S3 respecto a S2 viene dada<br />

por (e S3<br />

S2/S3 , θ2), si <strong>de</strong>notamos como (e S3<br />

S1/S3 , θ3) la actitud <strong>de</strong><br />

S3 respecto a S1, viene dada por:<br />

cos θ3 = − cos θ1 cos θ2 + sen θ1 sen θ2(e S1 /S 2 · e S2 /S 3 )<br />

e S 3<br />

S 1 /S 3<br />

=<br />

1<br />

sen θ3<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Cuaterniones<br />

“<br />

”<br />

sen θ1 cos θ2e S1 /S + cos θ1 sen θ2e<br />

2 S2 /S + sen θ1 sen θ2(e<br />

3 S1 /S × e<br />

2 S2 /S )<br />

3<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Los cuaterniones son una creación <strong>de</strong> Hamilton (siglo XIX),<br />

que los consi<strong>de</strong>raba su mayor invento; pensó serían como el<br />

“lenguaje universal” <strong>de</strong> la física. Pero fueron sustituidos<br />

pronto por los vectores (Gibbs) y las matrices (Cayley).<br />

Recor<strong>de</strong>mos que un número complejo z es como un “vector<br />

2-D”, que se pue<strong>de</strong> escribir como z = x + iy. Los números<br />

complejos <strong>de</strong> módulo unidad se pue<strong>de</strong>n usar para representar<br />

una rotación 2-D, ya que en el caso <strong>de</strong> que |z| = 1, se pue<strong>de</strong><br />

escribir z = e iθ , y en tal caso representa una rotación 2-D <strong>de</strong><br />

ángulo θ.<br />

Los cuaterniones son una extensión <strong>de</strong> los números complejos<br />

a “4 dimensiones”. Escribimos un cuaternión q como:<br />

q = q0 + iq1 + jq2 + kq3.<br />

En ocasiones q0 se <strong>de</strong>nomina la “parte escalar” <strong>de</strong> q y se<br />

<strong>de</strong>fine q = [q1 q2 q3] T como la “parte vectorial” <strong>de</strong> q.<br />

Algunos autores escriben q4 en vez <strong>de</strong> q0.<br />

23 / 28<br />

24 / 28


Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Álgebra <strong>de</strong> cuaterniones I<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Para po<strong>de</strong>r enten<strong>de</strong>r los cuaterniones es importante conocer<br />

su álgebra, es <strong>de</strong>cir, como se opera con cuaterniones.<br />

Suma: la suma es componente a componente, es <strong>de</strong>cir, dado<br />

q = q0 + iq1 + jq2 + kq3 y q ′ = q ′ 0 + iq′ 1 + jq′ 2 + kq′ 3 , se tiene<br />

que q ′′ = q + q ′ = q ′′<br />

viene dado por las<br />

0<br />

+ iq′′<br />

1<br />

+ jq′′<br />

2<br />

+ kq′′<br />

3<br />

fórmulas:<br />

q ′′<br />

0 = q0 + q ′ 0 , q′′ 1 = q1 + q ′ 1 , q′′ 2 = q2 + q ′ 2 , q′′ 3 = q3 + q ′ 3 .<br />

Producto: el producto es componente a componente,<br />

conociendo las siguientes reglas <strong>de</strong> multiplicación:<br />

i · i = −1, i · j = k, i · k = −j, j · i = −k, j · j = −1, j · k = i,<br />

k · i = j, k · j = −i, k · k = −1.<br />

Se tiene la fórmula <strong>de</strong> Hamilton: i · j · k = −1.<br />

Obsérvese que en general qq ′ = q ′ q: La multiplicación no es<br />

conmutativa!<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Álgebra <strong>de</strong> cuaterniones II<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Forma matricial <strong>de</strong>l producto: Es posible escribir el producto<br />

q ′′ = q ′ q en forma matricial.<br />

⎡<br />

⎢<br />

⎣<br />

q ′′<br />

0<br />

q ′′<br />

1<br />

q ′′<br />

2<br />

q ′′<br />

3<br />

⎤<br />

⎥<br />

⎦ =<br />

⎡<br />

⎢<br />

⎣<br />

q ′ 0 −q′ 1 −q′ 2 −q′ 3<br />

q ′ 1 q ′ 0 −q′ 3 q ′ 2<br />

q ′ 2 q ′ 3 q ′ 0 −q′ 1<br />

q ′ 3 −q′ 2 q ′ 1 q ′ 0<br />

⎤ ⎡<br />

⎥ ⎢<br />

⎥ ⎢<br />

⎦ ⎣<br />

Forma “vectorial” <strong>de</strong>l producto: q ′′<br />

0 = q′ 0 q0 − q ′T q,<br />

q ′′ = q0q ′ + q ′ 0 q + q′ × q.<br />

Conjugado: Como para los números complejos, dado<br />

q = q0 + iq1 + jq2 + kq3 se <strong>de</strong>fine el conjugado <strong>de</strong> q como<br />

q ∗ = q0 − iq1 − jq2 − kq3.<br />

Módulo: Se <strong>de</strong>fine el módulo <strong>de</strong> q = q0 + iq1 + jq2 + kq3<br />

como |q| 2 = qq ∗ = q 2 0 + q2 1 + q2 2 + q2 3<br />

División: Se <strong>de</strong>fine la división usando el conjugado:<br />

q ′ /q = q ′ /q · q ∗ /q ∗ = (q ′ q ∗ )/|q| 2 .<br />

q0<br />

q1<br />

q2<br />

q3<br />

⎤<br />

⎥<br />

⎦<br />

25 / 28<br />

26 / 28<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Representación <strong>de</strong> la actitud mediante cuaterniones I<br />

Dada la actitud representada mediante el eje y ángulo <strong>de</strong><br />

Euler, e y θ, se “codifica” dicha actitud en forma <strong>de</strong><br />

cuaterniones mediante:<br />

q0 = cos θ/2, q = sen θ/2e.<br />

Obsérvese que si un cuaternión q representa una actitud,<br />

entonces |q| = 1.<br />

Recor<strong>de</strong>mos el operador q × :<br />

2<br />

q × = 4<br />

0 −q3 q2<br />

q3 0 −q1<br />

−q2 q1 0<br />

Para pasar <strong>de</strong> la√DCM C a cuaterniones, se utilizan las<br />

1+Tr(C)<br />

fórmulas: q0 = y q 2<br />

× = 1<br />

<br />

T C − C .<br />

4q0<br />

Para pasar <strong>de</strong> cuaterniones a DCM se utiliza la fórmula <strong>de</strong><br />

Euler-Rodrigues para cuaterniones:<br />

C = q2 0 − qT q Id + 2qqT − 2q0q × .<br />

Introducción histórica<br />

Navegación. Definición y tipos <strong>de</strong> navegación<br />

La actitud <strong>de</strong> la aeronave. Formas <strong>de</strong> representación<br />

3<br />

5<br />

Matriz <strong>de</strong> cosenos directores<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Representación <strong>de</strong> la actitud mediante cuaterniones II<br />

Fórmula <strong>de</strong> Euler-Rodrigues en forma matricial:<br />

2<br />

C(q) = 4<br />

q 2 0 + q2 1 − q2 2 − q2 3 2(q1q2 + q0q3) 2(q1q3 − q0q2)<br />

2(q1q2 − q0q3) q 2 0 − q2 1 + q2 2 − q2 3 2(q2q3 + q0q1)<br />

2(q1q3 + q0q2) 2(q2q3 − q0q1) q 2 0 − q2 1 − q2 2 + q2 3<br />

Los cuaterniones son una representación <strong>de</strong> la actitud que<br />

requiere 4 parámetros, con la relación |q| = 1.<br />

Tienen la <strong>de</strong>sventaja <strong>de</strong> ser una representación<br />

matemática sin sentido físico.<br />

Para pasar <strong>de</strong> la DCM a cuaterniones y viceversa no es<br />

necesario usar fórmulas trigonométricas.<br />

Si qS ′ S representa la actitud <strong>de</strong> S’ respecto a S y qS ′′ S ′<br />

representa la actitud <strong>de</strong> S” respecto a S’, entonces qS ′′ S,<br />

la actitud <strong>de</strong> S” respecto a S, se calcula como<br />

qS ′′ S = qS ′ S · qS ′′ S ′ (al revés que la DCM).<br />

3<br />

5<br />

27 / 28<br />

28 / 28


Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

Navegación Aérea<br />

Tema 3: Ecuaciones <strong>de</strong> la navegación.<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Para el caso <strong>de</strong> la posición, las ecuaciones cinemáticas<br />

relacionan el vector posición con el vector velocidad, mientras<br />

que las ecuaciones dinámicas relacionan el vector velocidad<br />

con el vector fuerza.<br />

Para el caso <strong>de</strong> la actitud, las ecuaciones diferenciales<br />

cinemáticas (EDC) relacionan la representación <strong>de</strong> la actitud<br />

(DCM, ángulos <strong>de</strong> Euler, cuaterniones) con la velocidad<br />

angular ω. Típicamente estas ecuaciones son no-lineales.<br />

En el sistema <strong>de</strong> navegación inercial, los giróscopos nos darán<br />

ω, y habrá que utilizar las EDC, es <strong>de</strong>cir, integrar las<br />

ecuaciones, para calcular la actitud.<br />

Por tanto es importante conocer las diferentes EDC para las<br />

diferentes representaciones, para ver cuál es la más ventajosa<br />

<strong>de</strong>s<strong>de</strong> un punto <strong>de</strong> vista computacional.<br />

2 / 28<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

DCM para ángulos pequeños I<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Supongamos que tenemos dos sistemas <strong>de</strong> <strong>referencia</strong> A y B,<br />

relacionados <strong>de</strong> la siguiente forma:<br />

xA S1<br />

dθ2 dθ3<br />

−→ S2 −→<br />

y S1 zS2 A dθ1<br />

−→<br />

don<strong>de</strong> suponemos que dθi son ángulos pequeños, <strong>de</strong> forma<br />

que po<strong>de</strong>mos aproximar cos dθi 1 y sen dθi dθi.<br />

Si escribimos las matrices <strong>de</strong> rotación teniendo en cuenta la<br />

aproximación anterior, obtenemos:<br />

2<br />

C S1 = 4<br />

A<br />

1 0 0<br />

0 1 dθ1<br />

0 −dθ1 1<br />

3<br />

2<br />

5 , C S2 = 4<br />

S1 1 0 −dθ2<br />

0 1 0<br />

dθ2 0 1<br />

B<br />

3<br />

2<br />

5 , C B<br />

S = 4<br />

2<br />

1 dθ3 0<br />

−dθ3 1 0<br />

0 0 1<br />

Si escribimos C B A = C B S2 S1 C C S2 S1 A y <strong>de</strong>spreciamos todos los<br />

productos dobles <strong>de</strong> ángulos, es <strong>de</strong>cir, dθidθj 0,<br />

obtenemos:<br />

2<br />

C B<br />

A = 4<br />

1 dθ3 −dθ2<br />

−dθ3 1 dθ1<br />

dθ2 −dθ1 1<br />

3<br />

2<br />

5 = Id − 4<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

DCM para ángulos pequeños II<br />

0 −dθ3 dθ2<br />

dθ3 0 −dθ1<br />

−dθ2 dθ1 0<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

En la anterior transparencia, se ha <strong>de</strong>finido<br />

dθ = [dθ1 dθ2 dθ3] T y la matriz<br />

⎡<br />

dθ × = ⎣<br />

0 −dθ3 dθ2<br />

dθ3 0 −dθ1<br />

−dθ2 dθ1 0<br />

3<br />

5 = Id − dθ × ,<br />

que es la matriz antisimétrica que se emplea para efectuar el<br />

producto vectorial.<br />

Obsérvese que bajo estas hipótesis (ángulos pequeños) no<br />

importa el or<strong>de</strong>n <strong>de</strong> las rotaciones y los ángulos se suman.<br />

⎤<br />

⎦ ,<br />

3<br />

5 .<br />

3 / 28<br />

4 / 28


Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC para la DCM I<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Supongamos que quiero calcular la actitud <strong>de</strong> B respecto a A,<br />

(t), sabiendo que B gira con respecto a<br />

mediante la DCM C B A<br />

A con una velocidad angular ωB B/A .<br />

Por <strong>de</strong>finición: d<br />

dt<br />

Suponiendo A fijo, entonces po<strong>de</strong>mos imaginar que es B<br />

quien se mueve en el tiempo, y por tanto podríamos escribir<br />

B = B(t) y por tanto C B B(t)<br />

A (t) = CA .<br />

Usando este razonamiento,<br />

C B(t)<br />

. Por tanto:<br />

C B A<br />

(t + dt) = C B(t+dt)<br />

A<br />

dt C B A = C B A (t+dt)−C B A (t)<br />

= C B(t+dt)<br />

B(t)<br />

A −→ B(t) −→ B(t + dt)<br />

En el tiempo dt, el sistema <strong>de</strong> <strong>referencia</strong> B habrá girado<br />

respecto a sí mismo un ángulo muy pequeño en cada eje; por<br />

lo que hemos visto en la anterior transparencia, por tanto,<br />

= Id − dθ B × B<br />

, don<strong>de</strong> dθ es como antes se <strong>de</strong>finió.<br />

C B(t+dt)<br />

B(t)<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC para la DCM II<br />

Siguiendo el razonamiento: d<br />

A<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

dt C B A = C B A (t+dt)−C B A (t)<br />

dt<br />

C B(t+dt)<br />

C B(t)<br />

B A (t)−C B A (t)<br />

dt = (Id−(dθB ) × )C B A (t)−C B A (t)<br />

dt<br />

La matriz (dθB ) ×<br />

dθ B ×<br />

dt<br />

⎡<br />

= ⎣<br />

dt<br />

se escribiría<br />

0 − dθ3<br />

dθ3<br />

dt<br />

dt<br />

0<br />

dθ2<br />

dt<br />

− dθ1<br />

dt<br />

0<br />

⎤ ⎡<br />

⎦ = ⎣<br />

− dθ2<br />

dt<br />

dθ1<br />

dt<br />

=<br />

= − (dθB ) ×<br />

dt C B A (t)<br />

0 −ω3 ω2<br />

ω3 0 −ω1<br />

−ω2 ω1 0<br />

don<strong>de</strong> ω B B/A = [ω1 ω2 ω3] T ya que dθ B representaba el<br />

ángulo girado por B en un dt, y por <strong>de</strong>finición <strong>de</strong> velocidad<br />

angular. Se tiene entonces:<br />

<br />

ω B ⎡<br />

⎤<br />

0 −ω3 ω2<br />

×<br />

B/A = ⎣ ω3 0 −ω1 ⎦ ,<br />

−ω2 ω1 0<br />

Por tanto: d<br />

dt C B A = C<br />

˙B<br />

<br />

A = − ωB ×<br />

B/A<br />

⎤<br />

⎦ ,<br />

5 / 28<br />

C B A . 6 / 28<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC para la DCM III<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

¿Qué suce<strong>de</strong> si lo que conocemos es ωA B/A ? Tenemos que<br />

<br />

estudiar como se transforman estos operadores ωB ×<br />

B/A al<br />

cambiar <strong>de</strong> sistema <strong>de</strong> <strong>referencia</strong>.<br />

Obsérvese que si z = v × w, se tiene que en el sdr B,<br />

zB = v B ×<br />

w B . Por otro lado en el sdr A, se tendrá que<br />

zA = v A ×<br />

w A .<br />

La primera expresión también se pue<strong>de</strong> escribir:<br />

zB = C B A zA = C B <br />

A v A × <br />

w A = C B<br />

A v A ×<br />

C A<br />

B w B , y puesto<br />

que<br />

<br />

esta expresión tiene que ser igual a la anterior:<br />

v B × <br />

= C B<br />

A v A ×<br />

C A<br />

B .<br />

Sustituyendo esto en la ecuación cinemática: C<br />

˙B<br />

A =<br />

<br />

− ωB ×<br />

B/A C B A = −C B <br />

A ωA ×<br />

B/A C A B C B A = −C B <br />

A ωA ×<br />

B/A<br />

Finalmente puesto que ωB/A = −ω<br />

˙<br />

A/B: C B A = C B <br />

A ωA ×<br />

A/B<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC para la DCM IV<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Otra variación: trasponiendo ambos miembros <strong>de</strong><br />

˙<br />

C B A<br />

= −<br />

<br />

ω B B/A<br />

×<br />

C B A<br />

llegamos a ˙<br />

C A B = C A B<br />

<br />

ω B B/A<br />

En general, la EDC es una ecuación diferencial matricial, que<br />

habrá que resolver componente a componente: nueve<br />

ecuaciones diferenciales acopladas.<br />

El principal problema <strong>de</strong> resolver numéricamente esta ecuación<br />

es garantizar que la matriz resultante <strong>de</strong> integrar sea<br />

ortogonal. Obsérvese que en teoría la ecuación diferencial<br />

respeta la ortogonalidad: I = (C B A )(C B A )T , <strong>de</strong>rivando:<br />

d<br />

dt (C B A )<br />

<br />

<br />

= − ω B B/A<br />

<br />

= − ω B B/A<br />

(C B A )T + C B d<br />

A<br />

dt (C B A )T<br />

×<br />

C B A (C B A )T + C B A C A B<br />

× ×<br />

+<br />

<br />

ω B B/A<br />

= 0<br />

×<br />

<br />

ω B ×<br />

B/A<br />

7 / 28<br />

8 / 28


Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

La ecuación <strong>de</strong> Coriolis<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

La EDC <strong>de</strong> la DCM nos permite <strong>de</strong>mostrar la ecuación <strong>de</strong><br />

Coriolis que luego será útil: d<br />

dt vA<br />

= d<br />

dt vB<br />

+ ωB/A × v<br />

Si escribimos (mecanizamos) esta ecuación en el sistema <strong>de</strong><br />

<strong>referencia</strong> B: C B A ˙ v A = ˙v B <br />

+ ωB ×<br />

B/A v B , don<strong>de</strong> el punto<br />

quiere <strong>de</strong>cir <strong>de</strong>rivada en el mismo sistema <strong>de</strong> <strong>referencia</strong> don<strong>de</strong><br />

está escrito.<br />

En efecto:<br />

C B A ˙ v A = C B d<br />

A<br />

dt (C A B v B )<br />

= ˙v B + C B A ˙<br />

C A B<br />

B<br />

v<br />

<br />

= ˙v B + C B A C A B ω B B/A<br />

×<br />

= ˙v B +<br />

<br />

ω B B/A<br />

Esta ecuación será utilizada con mucha frecuencia en este<br />

tema.<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC para los ángulos <strong>de</strong> Euler I<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

v B<br />

×<br />

Partimos <strong>de</strong> la <strong>de</strong>finición <strong>de</strong> los ángulos <strong>de</strong> Euler:<br />

n ψ θ<br />

−→ S −→<br />

z n<br />

y S<br />

S ′ ϕ<br />

−→ b<br />

′<br />

La velocidad angular tiene la propiedad <strong>de</strong> que<br />

ω b/n = ω b/S ′ + ω S ′ /S + ω S/n.<br />

Si mecanizamos esta ecuación en b:<br />

ω b b/n = ωb b/S ′ + ω b S ′ /S + ωb S/n<br />

Por otro lado está claro que:<br />

ω b b/S ′ = [ ˙ϕ 0 0] T , ω S′<br />

S ′ /S = [0 ˙θ 0] T , ω S S/n = [0 0 ˙ψ] T .<br />

Luego: ωb b/n = ωb b/S ′ + C b S′<br />

S ′ωS ′ /S + C b S ωS S/n y puesto que<br />

, po<strong>de</strong>mos escribir:<br />

C b S = C b S′<br />

S ′CS ω b b/n = ωb b/S ′ + C b S<br />

′ω S′<br />

S ′ /S + C b S<br />

x S<br />

′C S′<br />

S ωS S/n<br />

v B<br />

9 / 28<br />

10 / 28<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC para los ángulos <strong>de</strong> Euler II<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Desarrollando esta ecuación:<br />

ω b b/n =<br />

⎡ ⎤<br />

˙ϕ<br />

⎡<br />

1 0 0<br />

⎤ ⎡ ⎤<br />

0<br />

⎣ 0 ⎦ + ⎣ 0 cϕ sϕ ⎦ ⎣ ˙θ ⎦<br />

0<br />

⎡<br />

1 0<br />

0 −sϕ cϕ<br />

⎤ ⎡<br />

0 cθ 0<br />

0<br />

⎤ ⎡<br />

−sθ 0<br />

+ ⎣ 0 cϕ sϕ ⎦ ⎣ 0 1 0 ⎦ ⎣ 0<br />

=<br />

0 −sϕ cϕ<br />

⎡ ⎤ ⎡<br />

˙ϕ 0<br />

⎣ 0 ⎦ + ⎣ cϕ<br />

sθ 0 cθ ˙ψ<br />

0<br />

˙ θ<br />

⎤ ⎡<br />

−sθ ˙ψ<br />

⎦ + ⎣ sϕcθ<br />

−sϕ ˙θ<br />

˙ ⎤<br />

ψ ⎦<br />

=<br />

⎡<br />

1<br />

⎣ 0<br />

0<br />

cϕ<br />

cϕcθ ˙ψ<br />

⎤ ⎡ ⎤<br />

−sθ ˙ϕ<br />

sϕcθ ⎦ ⎣ ˙θ ⎦<br />

0 −sϕ cϕcθ ˙ψ<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC para los ángulos <strong>de</strong> Euler III<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Obsérvese que lo que realmente se quiere es una expresión<br />

para las <strong>de</strong>rivadas <strong>de</strong> los ángulos en función <strong>de</strong><br />

ωb b/n = [ω1 ω2 ω3] T , y por tanto hay que invertir la matriz:<br />

⎡ ⎤ ⎡<br />

⎤−1<br />

⎡<br />

ω1<br />

⎤<br />

⎣<br />

˙ϕ<br />

˙θ<br />

˙ψ<br />

⎦ =<br />

⎣<br />

= 1<br />

cθ<br />

1 0 −sθ<br />

0 cϕ sϕcθ<br />

0 −sϕ cϕcθ<br />

⎡<br />

⎣<br />

⎦<br />

⎣<br />

cθ sθsϕ sθcϕ<br />

0 cϕcθ −sϕcθ<br />

0 sϕ cϕ<br />

ω2<br />

ω3<br />

⎤ ⎡<br />

⎦ ⎣<br />

⎦<br />

ω1<br />

ω2<br />

ω3<br />

⎤<br />

⎦<br />

⎤<br />

⎦<br />

11 / 28<br />

Obsérvese que se trata <strong>de</strong> 3 ecuaciones diferenciales no<br />

lineales, con multitud <strong>de</strong> funciones trigonométricas.<br />

Posee una singularidad para θ = ±90 o . En realidad los<br />

ángulos <strong>de</strong> Euler no están bien <strong>de</strong>finidos para esta situación.<br />

Ésta singularidad es el motivo por el que no se suelen usar en<br />

sistemas <strong>de</strong> navegación inercial. 12 / 28


Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC para el eje y ángulo <strong>de</strong> Euler<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

La representación en forma <strong>de</strong> eje y ángulo <strong>de</strong> Euler, (eb b/n , θ),<br />

tiene las siguientes EDC:<br />

Para el ángulo <strong>de</strong> Euler: ˙ θ = (e b b/n )T ω b b/n<br />

Para el eje <strong>de</strong> Euler:<br />

˙e b b/n<br />

= 1<br />

2<br />

e b ×<br />

b/n +<br />

1<br />

<br />

Id − e<br />

tan θ/2<br />

b b/n (eb <br />

b/n<br />

)T ω b b/n<br />

Son cuatro ecuaciones diferenciales, no lineales.<br />

Poseen una singularidad para θ = 0.<br />

En la práctica no se utilizan directamente; las usamos para<br />

hallar las EDC para los cuaterniones.<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC para cuaterniones I<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Recor<strong>de</strong>mos la <strong>de</strong>finición <strong>de</strong> cuaterniones en función <strong>de</strong> ángulo<br />

y eje <strong>de</strong> Euler:<br />

q0 = cos θ/2, q = sen θ/2e b b/n .<br />

Derivando en la ecuación <strong>de</strong> q0 y sustituyendo la EDC <strong>de</strong> θ,<br />

obtenemos:<br />

˙q0 = − 1<br />

2 sen θ/2 ˙θ = − 1<br />

Derivando en la ecuación <strong>de</strong> q:<br />

2 sen θ/2(eb b/n )T ω b b/n<br />

˙q = 1<br />

2 cos θ/2eb b/n ˙θ + sen θ/2˙e b b/n<br />

Sustituyendo las EDC <strong>de</strong> ángulo y eje <strong>de</strong> Euler:<br />

= − 1<br />

2 qT ω b b/n<br />

13 / 28<br />

˙q = 1<br />

2 cos θ/2eb b/n (eb b/n )T ω b b/n<br />

+ 1<br />

sen θ/2 e<br />

2 b × 1<br />

<br />

b/n + Id − e<br />

tan θ/2<br />

b b/n (eb <br />

b/n<br />

)T ω b b/n<br />

= 1 ×<br />

q + q0Id<br />

2<br />

ω b b/n 14 / 28<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC para cuaterniones II<br />

DCM<br />

Ángulos <strong>de</strong> Euler<br />

Cuaterniones<br />

Po<strong>de</strong>mos escribir esta ecuación en forma matricial:<br />

⎡<br />

q0<br />

d ⎢ q1 ⎢<br />

dt ⎣<br />

⎤ ⎡<br />

−q1<br />

⎥<br />

1 ⎢ q0<br />

⎦ = ⎢<br />

2 ⎣<br />

−q2<br />

−q3<br />

−q3<br />

q2<br />

⎤<br />

⎡<br />

ωx ⎥ ⎣ ωy ⎦<br />

⎤<br />

⎦<br />

q2<br />

q3<br />

don<strong>de</strong> ω b b/n = [ωx ωy ωz] T .<br />

q3 q0 −q1<br />

−q2 q1 q0<br />

Son cuatro ecuaciones diferenciales, bilineales, sin<br />

singularida<strong>de</strong>s.<br />

No es necesario realizar ningún tipo <strong>de</strong> operación<br />

trigonométrica (senos o cosenos), todo son multiplicaciones<br />

matriciales.<br />

Por estas razones, la representación mediante cuaterniones es<br />

la representación <strong>de</strong> actitud más usada.<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

ωz<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

Las ecuaciones fundamentales <strong>de</strong> la navegación son las<br />

ecuaciones <strong>de</strong>l movimiento <strong>de</strong> la aeronave, expresada en ejes<br />

<strong>de</strong> navegación.<br />

Puesto que en navegación es necesario <strong>de</strong>terminar 9 variables<br />

(3 <strong>de</strong> posición, 3 <strong>de</strong> actitud, y 3 <strong>de</strong> velocidad), serán<br />

necesarias 9 ecuaciones dadas como 3 conjuntos <strong>de</strong> 3<br />

ecuaciones diferenciales.<br />

El primer conjunto <strong>de</strong> ecuaciones es la EDC <strong>de</strong> la actitud, que<br />

ya hemos visto.<br />

Queda <strong>de</strong>terminar el conjunto <strong>de</strong> ecuaciones que verifica la<br />

posición y el conjunto <strong>de</strong> ecuaciones que verifica la velocidad.<br />

La llamada “ecuación fundamental <strong>de</strong> la navegación” (FEN)<br />

es la ecuación vectorial <strong>de</strong> la velocidad.<br />

15 / 28<br />

16 / 28


Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

Ecuación Fundamental <strong>de</strong> la Navegación I<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

La segunda ley <strong>de</strong> Newton aplicada al centro <strong>de</strong> masas <strong>de</strong>l<br />

avión y expresada en el sistema <strong>de</strong> <strong>referencia</strong> inercial es:<br />

m d<br />

dt v i = F = F i NG + mG i , don<strong>de</strong> se <strong>de</strong>sprecia la variación<br />

<strong>de</strong> masa <strong>de</strong>l avión.<br />

Hemos separado las fuerzas en gravitatorias (G) y no<br />

gravitatorias (F NG ).<br />

Es <strong>de</strong>cir: d<br />

dt v i = 1<br />

m F i NG + G i .<br />

La <strong>de</strong>finición <strong>de</strong> v i es v i = d<br />

dt r i .<br />

Por otro lado, en el sistema <strong>de</strong> ejes Tierra, tenemos que<br />

v e = d<br />

dt r e .<br />

Por tanto: v e = d<br />

<br />

dt C e<br />

i r i = C˙ e<br />

Usando la EDC C˙ e<br />

<br />

i = − ωe ×<br />

e/i C e<br />

i llegamos a:<br />

v e <br />

= − ωe ×<br />

e/i C e<br />

i r i + C e<br />

i v i .<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

i r i + C e<br />

i d<br />

dt r i = C˙ e<br />

i r i + C e<br />

i v i .<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

Ecuación Fundamental <strong>de</strong> la Navegación II<br />

ω e e/i<br />

17 / 28<br />

Igualmente, asumiendo la rotación <strong>de</strong> la Tierra constante:<br />

d<br />

dt v e <br />

= − ωe ×<br />

˙<br />

e/i C e<br />

i r i <br />

− ωe ×<br />

e/i C e ˙<br />

i r i + ˙ C e<br />

i v i + C e ˙<br />

i v i .<br />

Por tanto:<br />

d<br />

dt v e <br />

= ω e × <br />

e/i ω e ×<br />

e/i C e<br />

i r i <br />

− ω e ×<br />

e/i C e<br />

i v i <br />

− ω e ×<br />

e/i C e<br />

i v i<br />

+C e ˙<br />

i v i<br />

<br />

= ω e × <br />

e/i ω e ×<br />

e/i r e <br />

− 2 ω e ×<br />

e/i C e<br />

i v i + C e ˙<br />

i v i<br />

Puesto que v e ×<br />

= − C e<br />

i r i + C e<br />

i v i , se tiene que<br />

C e<br />

i v i = v e +<br />

<br />

ω e e/i<br />

×<br />

r e . Por tanto:<br />

d<br />

dt v e =<br />

<br />

ω e × <br />

e/i ω e ×<br />

e/i r e <br />

− 2 ω e ×<br />

e/i v e + C e ˙<br />

i v i<br />

El primer término representa la aceleración centrífuga acent y<br />

el segundo la <strong>de</strong> Coriolis, luego ae <br />

cent = ωe × <br />

e/i ωe e/i<br />

×<br />

r e . 18 / 28<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

Ecuación Fundamental <strong>de</strong> la Navegación III<br />

Sustituyendo la Ley <strong>de</strong> Newton en la ecuación antes obtenida:<br />

d<br />

dt v e = a e <br />

cent − 2 ω e ×<br />

e/i v e + C e<br />

<br />

1<br />

i<br />

m F i =<br />

<br />

i<br />

NG + G<br />

a e <br />

cent − 2 ω e ×<br />

e/i v e + 1<br />

e<br />

+ G<br />

m F e NG<br />

Finalmente recor<strong>de</strong>mos que la aceleración <strong>de</strong>l geopotencial se<br />

<strong>de</strong>finía como g = G + acent, llegamos a:<br />

d<br />

dt v e <br />

= −2 ω e ×<br />

e/i v e + 1<br />

m F e e<br />

NG + g<br />

Finalmente, en ejes navegación n y puesto que v n = C n e v e :<br />

d<br />

dt v n = ˙<br />

= −<br />

C n e v e + C n e<br />

<br />

ω n n/e<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

d e<br />

v<br />

dt<br />

×<br />

C n e v e + C n e<br />

<br />

−2 ω e ×<br />

e/i v e + 1<br />

m F e <br />

e<br />

NG + g<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

Ecuación Fundamental <strong>de</strong> la Navegación IV<br />

Es <strong>de</strong>cir:<br />

d<br />

dt v n = −<br />

Y puesto que v e = C e n v n :<br />

<br />

ω n ×<br />

n/e v n − 2C n <br />

e ω e ×<br />

e/i v e + 1<br />

m F n NG<br />

+ g n<br />

d<br />

dt v n =<br />

<br />

− ω n ×<br />

n/e v n − 2C n <br />

e ω e ×<br />

e/i C e n v n + 1<br />

m F n n<br />

NG + g<br />

Recor<strong>de</strong>mos que para el “operador producto vectorial”, se<br />

cumple que C a <br />

b zb ×<br />

C b<br />

a = (za ) × . Por tanto la FEN queda:<br />

d<br />

dt v n <br />

= − ω n ×<br />

n/e v n <br />

− 2 ω n ×<br />

e/i v n + 1<br />

m F n n<br />

NG + g<br />

<br />

= − ω n n/e + 2ωn ×<br />

e/i v n + 1<br />

n<br />

+ g<br />

m F n NG<br />

La FEN es una ecuación totalmente expresada<br />

(“mecanizada”) en ejes n. v n es lo que se quiere estimar.<br />

Observemos no obstante que son necesarios ω n n/e y ωn e/i .<br />

19 / 28<br />

20 / 28


Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong>s<br />

Necesitamos obtener valores para ω n n/e y ωn e/i .<br />

En primer lugar consi<strong>de</strong>remos el caso simple <strong>de</strong> que α = 0,<br />

por tanto g = n.<br />

Recor<strong>de</strong>mos las matrices <strong>de</strong> transformación:<br />

C e<br />

i =<br />

2<br />

4 cω E t sω E t 0<br />

−sω E t cω E t 0<br />

0 0 1<br />

3<br />

2<br />

5 , C g<br />

e = 4<br />

Recor<strong>de</strong>mos que ω e e/i = [0 0 ωE ] T .<br />

Por tanto:<br />

ω g<br />

e/i = C g e ω e e/i =<br />

⎡<br />

⎣<br />

−sφcλ −sφsλ cφ<br />

−sλ cλ 0<br />

−cφcλ −cφsλ −sφ<br />

ωE cφ<br />

0<br />

−ωE sφ<br />

Por otro lado siguiendo el procedimiento con el que se hallaron<br />

las DCM para ángulos <strong>de</strong> Euler, llegamos a ω g<br />

g/e =<br />

⎡<br />

˙λcφ<br />

⎣ − ˙φ<br />

− ˙ ⎤<br />

⎦<br />

λsφ<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

⎤<br />

⎦<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong>s con<br />

ángulo <strong>de</strong> <strong>de</strong>riva<br />

Si ahora α = 0, recor<strong>de</strong>mos la matriz <strong>de</strong> transformación:<br />

C n<br />

g =<br />

Por tanto: ω n e/i = C n g ω g<br />

e/i =<br />

2<br />

4<br />

cα sα 0<br />

−sα cα 0<br />

0 0 1<br />

⎡<br />

⎣<br />

Igualmente ω n g/e = C n g ω g<br />

g/e =<br />

Finalmente<br />

ω n n/e = ωn g/e + ωn n/g = ωn g/e +<br />

3<br />

5<br />

⎤<br />

ωE cφcα<br />

−ωE cφsα ⎦<br />

−ωE sφ<br />

⎡<br />

˙λcφcα −<br />

⎣<br />

˙ φsα<br />

− ˙λcφsα − ˙φcα<br />

− ˙λsφ<br />

⎡<br />

⎣<br />

0<br />

0<br />

˙α<br />

⎤<br />

⎡<br />

⎦ = ⎣<br />

⎤<br />

⎦<br />

3<br />

5<br />

˙λcφcα − ˙φsα<br />

− ˙λcφsα − ˙φcα<br />

− ˙ λsφ + ˙α<br />

⎤<br />

⎦<br />

21 / 28<br />

22 / 28<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Posición I<br />

Necesitamos obtener ecuaciones para λ, φ y h; también para<br />

α, si se usa un ángulo <strong>de</strong> <strong>de</strong>riva.<br />

En primer lugar para simplificar consi<strong>de</strong>remos el caso más<br />

simple posible: no hay ángulo <strong>de</strong> <strong>de</strong>riva (α = 0 luego n = g) y<br />

la Tierra es esférica <strong>de</strong> radio Re.<br />

En tal caso, se tiene: r˙e = v e . Expresado en ejes g:<br />

r e = C e g r g . El valor <strong>de</strong> r g = [0 0 − (Re + h)] T .<br />

Se tiene: v g = C g e v e = C g e ˙ r e = C g ˙ e C e g r g + C g e C e g ˙<br />

−C g e<br />

<br />

ω e e/g<br />

×<br />

C e g r g + ˙<br />

r g =<br />

<br />

ω g<br />

g/e<br />

×<br />

r g + r˙g r g =<br />

Por otro lado v g = [vx vy vz] T = [vN vE vD] T . La ecuación<br />

matricial queda:<br />

2<br />

4 v N<br />

v E<br />

v D<br />

3<br />

2<br />

5 = 4<br />

0 ˙λsφ − ˙φ<br />

− ˙ λsφ 0 − ˙ λcφ<br />

˙φ ˙ λcφ 0<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC <strong>de</strong> la Posición II<br />

Desarrollando:<br />

Es <strong>de</strong>cir:<br />

3 2<br />

5 4<br />

0<br />

0<br />

−Re − h<br />

3<br />

2<br />

5 + 4<br />

0<br />

0<br />

− ˙ h<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

v N = ˙ φ(Re + h)<br />

v E = ˙ λcφ(Re + h)<br />

v D = − ˙ h<br />

˙φ =<br />

˙λ =<br />

v N<br />

Re + h<br />

vE ˙h = −v D<br />

cφ(Re + h)<br />

Éstas ecuaciones me permiten obtener la posición conocida la<br />

velocidad en todo instante. Obsérvese que son singulares en<br />

φ = ±90 o .<br />

Por ese motivo se introduce el azimuth <strong>de</strong>⎡<strong>de</strong>riva. Sustituyendo en ω g<br />

g/e obtenemos: ωg<br />

g/e =<br />

⎢<br />

⎣<br />

3<br />

5<br />

vE<br />

Re+h<br />

− vN<br />

Re+h<br />

− vE tan φ<br />

Re+h<br />

⎤<br />

⎥<br />

⎦<br />

23 / 28<br />

24 / 28


Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC <strong>de</strong> la Posición: caso elipsoidal<br />

En el caso elipsoidal se tiene<br />

˙φ =<br />

˙λ =<br />

˙h = −v D<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

vN RM + h<br />

vE cφ(RN + h)<br />

Don<strong>de</strong> RN y RM son respectivamente los radios locales <strong>de</strong><br />

curvatura normal (<strong>de</strong> un paralelo) y meridional (<strong>de</strong>l<br />

meridiano), que fueron <strong>de</strong>finidos en el primer tema; dichos<br />

radios <strong>de</strong>pen<strong>de</strong>n <strong>de</strong> la latitud en la que se encuentre el avión.<br />

Y por tanto: ω g<br />

g/e =<br />

⎡<br />

vE<br />

RN+h<br />

⎢<br />

⎣ − vN<br />

RM+h<br />

− vE<br />

⎤<br />

⎥<br />

⎦<br />

tan φ<br />

RN+h<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

EDC <strong>de</strong> la Posición con Azimuth <strong>de</strong> Deriva I<br />

Trabajamos con tierra esférica. Si α = 0 entonces n = g y la<br />

única ecuación que se mantiene es ˙h = −vD, mientras que el<br />

resto <strong>de</strong> las ecuaciones cambian.<br />

Si escribimos v n = [vx vy vD] T y ω n n/e = [ρx ρy ρz] T ,<br />

siguiendo el mismo procedimiento <strong>de</strong> antes hallamos:<br />

v n <br />

= ωn ×<br />

n/e r n + r˙n La ecuación matricial queda:<br />

2<br />

4 vx<br />

vy<br />

v D<br />

3<br />

2<br />

5 = 4<br />

0 −ρz ρy<br />

ρz 0 −ρx<br />

−ρy ρx 0<br />

3 2<br />

5 4<br />

0<br />

0<br />

−Re − h<br />

3<br />

2<br />

5 + 4<br />

don<strong>de</strong> recor<strong>de</strong>mos que ya calculamos ρx = ˙λcφcα − ˙φsα,<br />

ρy = − ˙λcφsα − ˙φcα, ρz = − ˙λsφ + ˙α.<br />

Se llega a:<br />

vx<br />

vy<br />

=<br />

=<br />

v D = − ˙h<br />

“ ”<br />

˙λcφsα + ˙φcα (Re + h)<br />

“ ”<br />

˙λcφcα − ˙φsα (Re + h)<br />

0<br />

0<br />

− ˙ h<br />

3<br />

5<br />

25 / 28<br />

26 / 28<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

EDC <strong>de</strong> la Posición con Azimuth <strong>de</strong> Deriva II<br />

Despejando ˙φ y ˙λ:<br />

˙φ =<br />

˙λ =<br />

˙h = −V D<br />

vx cos α − vy sen α<br />

Re + h<br />

vx sen α + vy cos α<br />

cos φ(Re + h)<br />

Usando estas <strong>de</strong>finiciones en ωn n/e<br />

ω n n/e =<br />

2<br />

˙λcφcα −<br />

4<br />

˙ φsα<br />

− ˙ λcφsα − ˙ 2<br />

3<br />

vy<br />

6<br />

Re +h<br />

φcα 5 = 6<br />

−<br />

4<br />

− ˙λsφ + ˙α<br />

vx<br />

3<br />

7<br />

Re +h<br />

5<br />

vx sen α+vy cos α<br />

− tanφ + ˙α<br />

cos φ(Re +h)<br />

pue<strong>de</strong> elegir como se quiera.<br />

Se suele fijar por <strong>de</strong>finición ˙α = ˙λsφ =<br />

<strong>de</strong> don<strong>de</strong>: ωn n/e =<br />

⎡ vy<br />

Re+h<br />

⎣ − vx<br />

⎤<br />

⎦<br />

Re+h ,<br />

0<br />

se llega a:<br />

, don<strong>de</strong> ˙α se<br />

vx sen α+vy cos α<br />

cos φ(Re+h) tanφ,<br />

Obsérvese que ha <strong>de</strong>saparecido la singularidad en ω n n/e<br />

costa <strong>de</strong> un grado <strong>de</strong> libertad adicional, α).<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

! (a<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

EDC <strong>de</strong> la Posición con Azimuth <strong>de</strong> Deriva III<br />

Usando α se mantiene la singularidad a la hora <strong>de</strong> calcular λ,<br />

pero al menos se pue<strong>de</strong> seguir computando ωn n/e , que es<br />

necesaria para po<strong>de</strong>r calcular v n .<br />

Interpretación física: Ésta <strong>de</strong>finición <strong>de</strong> α equivale a tener una<br />

plataforma a bordo, a la que se permite girar en las<br />

direcciones x n y y n pero se le impi<strong>de</strong> girar en z n . El ángulo<br />

que forma una dirección fija <strong>de</strong> la plataforma con el N sería α.<br />

Observación: puesto que la posición viene dada por los<br />

ángulos (φ, λ, α), se pue<strong>de</strong> tratar como una “actitud”, C n e .<br />

En tal caso las ecuaciones cinemáticas <strong>de</strong> la posición podrían<br />

darse como EDC <strong>de</strong> actitud, por ejemplo ˙<br />

C n e = −<br />

<br />

ω n n/e<br />

×<br />

C n e<br />

27 / 28<br />

o incluso tratarse como cuaterniones.<br />

Así eliminamos totalmente la singularidad, y po<strong>de</strong>mos<br />

sobrevolar cualquier punto <strong>de</strong>l planeta.<br />

En cualquier caso habría que añadir la ecuación para la<br />

altitud, ˙h = −vD. 28 / 28


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Navegación Aérea<br />

Tema 4: Sistema <strong>de</strong> navegación autónomo. Navegación inercial.<br />

Errores.<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

La navegación autónoma es aquella que no <strong>de</strong>pen<strong>de</strong> <strong>de</strong><br />

medidas externas y por tanto no es susceptible a interferencias<br />

(acci<strong>de</strong>ntales o provocadas) ni a manipulación o error externo.<br />

El ejemplo más temprano es la navegación a estima que ya se<br />

vio en la introducción histórica. En aviación se emplea la<br />

navegación inercial.<br />

El objeto <strong>de</strong> la navegación inercial es <strong>de</strong>terminar la posición,<br />

velocidad y actitud <strong>de</strong> la aeronave, con la mayor precisión<br />

posible, a paritr <strong>de</strong> las medidas <strong>de</strong> la IMU (Inertial<br />

Measurement Unit).<br />

La IMU se compone <strong>de</strong> sensores inerciales: giróscopos y<br />

acelerómetros.<br />

Para la navegación inercial, a<strong>de</strong>más <strong>de</strong> la IMU, es necesaria<br />

una estimación inicial (fix) <strong>de</strong> posición, velocidad y actitud.<br />

2 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Historia <strong>de</strong> la navegación inercial I<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

Históricamente la navegación inercial no nace hasta el siglo<br />

XX.<br />

Sus antece<strong>de</strong>ntes se encuentran en la navegación a estima (ya<br />

estudiada) y en la invención <strong>de</strong> los primeros giróscopos.<br />

Los giróscopos se inventaron en el siglo XIX; fue Leon Focault<br />

quien les dio su nombre, popularizándolo gracias a un<br />

experimento (fracasado) en el que los usó para tratar <strong>de</strong><br />

<strong>de</strong>mostrar la rotación <strong>de</strong> la Tierra.<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Historia <strong>de</strong> la navegación inercial II<br />

Un giróscopo mantiene su eje <strong>de</strong> rotación (en el<br />

espacio inercial) frente a perturbaciones. Este efecto<br />

se conoce como rigi<strong>de</strong>z giroscópica.<br />

Dichas perturbaciones generan un movimiento <strong>de</strong><br />

precesión y nutación, que se pue<strong>de</strong> medir.<br />

Por ejemplo, al forzar la rotación <strong>de</strong> un giróscopo en<br />

un eje distinto a su eje <strong>de</strong> giro, se produce un efecto<br />

que permite estimar la velocidad <strong>de</strong> rotación.<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

3 / 49<br />

Por tanto los giróscopos tienen un eje en torno<br />

al cual giran permanentemente, otro eje en el<br />

cual se <strong>de</strong>tectan perturbaciones y otro eje en el<br />

cual se mi<strong>de</strong>n dichas perturbaciones.<br />

Las plataformas giroestabilizadas se basan en<br />

este fenómeno, son plataformas insensibles a<br />

perturbaciones que permiten diversas<br />

aplicaciones, como por ejemplo emplear una<br />

cámara <strong>de</strong> televisión en un helicóptero.<br />

Otra aplicación <strong>de</strong>l efecto es el girocompás o<br />

brújula giroscópica, que permite encontrar el<br />

Norte geográfico.<br />

Mo<strong>de</strong>rnamente, se emplean giróscopos no<br />

mecánicos, más sofisticados que emplean<br />

diversos efectos físicos.<br />

4 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Historia <strong>de</strong> la navegación inercial III<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Historia <strong>de</strong> la navegación inercial IV<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

En la II Guerra Mundial, se emplearon<br />

giróscopos y acelerómetros por primera vez,<br />

para guiar misiles V-2.<br />

La invención <strong>de</strong> este sistema <strong>de</strong> guiado se <strong>de</strong>be<br />

a un estadouni<strong>de</strong>nse, Robert Goddard.<br />

Tras la guerra, hubo un rápido <strong>de</strong>sarrollo. Los<br />

primeros sistemas <strong>de</strong> navegación inercial<br />

consistían en una triada <strong>de</strong> acelerómetros y<br />

giróscopos montados en una plataforma, capaz<br />

<strong>de</strong> rotar y orientarse con libertad.<br />

Se diseña la plataforma <strong>de</strong> manera que siempre<br />

mantenga su orientación respecto a un sistema<br />

<strong>de</strong> <strong>referencia</strong> dado (g o n).<br />

Por tanto medimos directamente an NG y C n b .<br />

Estos sistemas a veces se llaman<br />

semianalíticos.<br />

5 / 49<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

Éstos sistemas son funcionales en cualquier sitio <strong>de</strong> la<br />

Tierra: tierra, aire, océanos, bajo el agua...<br />

Con navegación inercial el submarino USS Nautilus<br />

cruzó bajo el hielo y pasó por el polo Norte en 1958.<br />

Sin embargo es muy costoso, contiene elementos mecánicos<br />

que se <strong>de</strong>sgastan, requiere una perfecta alineación inicial<br />

(lenta), y presenta problemas <strong>de</strong> bloqueo <strong>de</strong> los gimbals<br />

(gimbal lock) si se alinean los ejes <strong>de</strong> rotación.<br />

El sistema inercial más sofisticado que se creó fue el<br />

AIRS-Advanced Inertial Reference Sphere, que consiste en<br />

una esfera hueca con un fluido don<strong>de</strong> flota otra esfera con<br />

giróscopos y acelerómetros.<br />

Mantiene (mediante inyección <strong>de</strong> chorros) siempre una <strong>referencia</strong><br />

inercial, con lo que se mi<strong>de</strong> a i NG<br />

(que se pue<strong>de</strong> integrar<br />

. Por esto se llama geométrico o analítico.<br />

directamente) y C b<br />

i<br />

Su coste era enorme, pero se obtiene una gran precisión, con una<br />

<strong>de</strong>riva <strong>de</strong> 105 grados por hora (1,15o por año). Se usó en misiles<br />

balísticos y en bombar<strong>de</strong>ros.<br />

6 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Historia <strong>de</strong> la navegación inercial V<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

En 1956 se patenta la i<strong>de</strong>a <strong>de</strong>l INS “strapdown”, es <strong>de</strong>cir, fijo<br />

(fijado al cuerpo).<br />

En éste caso los sensores inerciales mi<strong>de</strong>n las magnitu<strong>de</strong>s en<br />

ejes cuerpo, es <strong>de</strong>cir, ωb b/i y ab NG . Éste tipo se sistema INS se<br />

<strong>de</strong>nomina “analítico” o <strong>de</strong> plataforma analítica, porque<br />

realmente no existe una plataforma y todo se realiza mediante<br />

cálculo numérico.<br />

Requiere el uso <strong>de</strong> or<strong>de</strong>nadores <strong>de</strong> gran capacidad <strong>de</strong> cómputo<br />

y <strong>de</strong> sensores precisos (por las vibraciones). Eso sólo fue<br />

posible a partir <strong>de</strong> los 70.<br />

Hoy en día es el único que se usa en la práctica.<br />

A<strong>de</strong>más, gracias a la navegación integrada (complementar el<br />

INS con otros sistemas como el GPS) se pue<strong>de</strong>n emplear<br />

sensores <strong>de</strong> baja calidad, con lo que el coste se ha abaratado<br />

enormemente.<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

La IMU: sensores inerciales.<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

Una IMU consta <strong>de</strong> giróscopos y acelerómetros. Estos<br />

dispositivos han sido estudiados en otras asignaturas.<br />

Un mo<strong>de</strong>lo típico <strong>de</strong> medida sería: ˆm = (1 + σ)m + b + ξ,<br />

don<strong>de</strong> ˆm es la medida obtenida <strong>de</strong>l valor real m, σ es el factor<br />

<strong>de</strong> escala, b es el sesgo y ξ es ruido <strong>de</strong> medida. Estos valores<br />

se pue<strong>de</strong>n calibrar pero están sujetos a variaciones.<br />

Las principales características <strong>de</strong> estos dispositivos son:<br />

Ancho <strong>de</strong> banda: <strong>de</strong>termina la frecuencia máxima <strong>de</strong><br />

aceleración o giro que son capaces <strong>de</strong> <strong>de</strong>tectar. Se asimila a la<br />

“velocidad” máxima con la que se toman medidas.<br />

Rango <strong>de</strong> medición.<br />

Supervivencia a choques.<br />

Ruido (en unida<strong>de</strong>s <strong>de</strong> medida por √ Hz). Mi<strong>de</strong> ξ. Se pue<strong>de</strong><br />

usar para calcular como se <strong>de</strong>grada la medida acumulada.<br />

Inestabilidad <strong>de</strong>l sesgo (en unida<strong>de</strong>s <strong>de</strong> medida). Mi<strong>de</strong> el ruido<br />

aleatorio que entra en b.<br />

Inestabilidad <strong>de</strong>l factor <strong>de</strong> escala (en porcentaje). Mi<strong>de</strong> el ruido<br />

aleatorio que entra en χ.<br />

7 / 49<br />

8 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Acelerómetros.<br />

Precisiones típicas <strong>de</strong> acelerómetros:<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Giróscopos<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

Precisiones típicas <strong>de</strong> giróscopos (RLG=Ring Laser Gyro,<br />

FOG=Fibre Optic Gyro, MEMS=Micro-Electro-Mechanical<br />

Systems).<br />

9 / 49<br />

10 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Los acelerómetros y la gravedad I<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

Un acelerómetro no pue<strong>de</strong> medir g.<br />

Principio <strong>de</strong> funcionamiento <strong>de</strong> un acelerómetro: medir el<br />

<strong>de</strong>splazamiento <strong>de</strong> una masa testigo. Ejemplo con muelle:<br />

Se cumple que m¨x = F − kx, don<strong>de</strong> k es la constante <strong>de</strong>l<br />

muelle y F la fuerza en la dirección <strong>de</strong>l eje. Puesto que<br />

F = ma, don<strong>de</strong> a es la aceleración en la dirección <strong>de</strong>l eje, se<br />

tiene que a = k/m · x + ¨x.<br />

Suponiendo que a es aproximadamente constante, x tien<strong>de</strong> a<br />

una posición <strong>de</strong> equilibrio que cumple a = k/m · x, y por<br />

tanto a es proporcional a x.<br />

Otros acelerómetros más sofisticados no requieren esperar a<br />

que se llegue al estado <strong>de</strong> equilibrio, por ejemplo compensando<br />

F con una fuerza contraria para que nunca se <strong>de</strong>splace x.<br />

11 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Los acelerómetros y la gravedad II<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

¿Qué suce<strong>de</strong> si el eje está en la misma dirección <strong>de</strong> la<br />

gravedad?<br />

Supongamos que el objeto está en caída libre. Para aplicar la<br />

Ley <strong>de</strong> Newton tenemos que estar en un sistema <strong>de</strong> <strong>referencia</strong><br />

inercial, pero puesto que el objeto está en caída libre, tenemos<br />

que tener en cuenta que el sistema <strong>de</strong> <strong>referencia</strong> fijo en el<br />

cuerpo es no inercial!<br />

Por tanto: m(¨x − g) = F − kx. Por otro lado<br />

F = m(aNG − g). Por tanto, en el equilibrio: aNG = k/m · x.<br />

12 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Los acelerómetros y la gravedad III<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

¿Es cierto pues que un acelerómetro no pue<strong>de</strong> medir la<br />

gravedad?<br />

Es cierto que un acelerómetro no pue<strong>de</strong> medir g directamente.<br />

En estado <strong>de</strong> caída libre en cualquier punto <strong>de</strong> la atmósfera (o<br />

en la Luna) sentiría la misma aceleración: cero.<br />

Sin embargo, en reposo sobre la superficie <strong>de</strong> la Tierra (por<br />

ejemplo un acelerómetro sobre una mesa), existe una fuerza<br />

<strong>de</strong> reacción R = −g, es <strong>de</strong>cir, R = g (apunta “hacia arriba”).<br />

Por tanto aNG = g y se tiene g = k/m · x. Es por tanto una<br />

medida “indirecta” <strong>de</strong> la gravedad.<br />

La <strong>de</strong>finición correcta <strong>de</strong> acelerómetro es “un dispositivo que<br />

mi<strong>de</strong> <strong>de</strong>sviaciones <strong>de</strong>l estado <strong>de</strong> caída libre”.<br />

Obsérvese que la aceleración <strong>de</strong>bida al geopotencial<br />

(añadiendo la rotación <strong>de</strong> la Tierra) tiene exactamente el<br />

mismo carácter que la gravitatoria y por tanto no se pue<strong>de</strong><br />

medir (directamente).<br />

13 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Mecanización en ejes n I<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

En este tema supondremos, para simplificar, que n = g, y que<br />

la Tierra es esférica.<br />

Mecanizar las ecuaciones quiere <strong>de</strong>cir escribirlas en el sistema<br />

<strong>de</strong> <strong>referencia</strong> apropiado y <strong>de</strong> forma que se puedan calcular a<br />

partir <strong>de</strong> las entradas.<br />

Partimos <strong>de</strong> las ecuaciones fundamentales <strong>de</strong> la navegación:<br />

Velocidad: d<br />

dt v n <br />

= − ωn n/e + 2ωn ×<br />

e/i v n + an n<br />

NG + g<br />

<br />

Actitud: C˙ b<br />

n = − ωb ×<br />

b/n C b n<br />

Posición:<br />

˙φ =<br />

˙λ =<br />

v N<br />

Re + h<br />

vE ˙h = −v D<br />

cφ(Re + h)<br />

Don<strong>de</strong> sabemos a<strong>de</strong>más que: ω e e/i = [ωE cφ 0 − ωE sφ] T y<br />

ω n n/e<br />

= [ vE<br />

Re+h<br />

− vN<br />

Re+h − vE tan φ<br />

Re+h ]T .<br />

14 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Mecanización en ejes n II<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

También disponemos <strong>de</strong> un mo<strong>de</strong>lo <strong>de</strong> gravedad:<br />

g n [0 0 g(h)] T , don<strong>de</strong> g(h) = µe<br />

(Re+h) 2 .<br />

A<strong>de</strong>más nuestra IMU nos proporcionará las medidas <strong>de</strong> los<br />

. Obsérvese que éstas no son las<br />

sensores inerciales: ab NG y ωb b/i<br />

magnitu<strong>de</strong>s que aparecen en las ecuaciones fundamentales <strong>de</strong><br />

la navegación: necesitamos an NG y ωb b/n .<br />

Se tiene que an NG = C n b ab NG = (C b n ) T ab NG .<br />

Y se tiene que<br />

ωb b/n = ωb b/i − ωb e/i − ωb n/e = ωb b/i − C b <br />

n ωn e/i + ωn <br />

n/e .<br />

Recor<strong>de</strong>mos<br />

<br />

que por tanto:<br />

ωb × <br />

b/n = ωb ×<br />

b/i − C b <br />

n ωn e/i + ωn ×<br />

n/e (C b n ) T<br />

Por tanto las ecuaciones fundamentales <strong>de</strong> la navegación <strong>de</strong><br />

velocidad y actitud se modifican:<br />

Velocidad: d<br />

dt v n <br />

= − ωn n/e + 2ωn ×<br />

e/i v n + (C b n ) T ab n<br />

NG + g<br />

<br />

Actitud: C˙ b<br />

n = − ωb ×<br />

b/i C b n + C b <br />

n ωn e/i + ωn ×<br />

n/e<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Mecanización en ejes n III<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

Ya disponemos pues <strong>de</strong> todo lo que necesitamos y po<strong>de</strong>mos<br />

esquematizarlo en el siguiente diagrama <strong>de</strong> bloques:<br />

IMU<br />

+<br />

-. # /<br />

+<br />

# +() *<br />

Calculo<br />

velocidad<br />

+<br />

, %<br />

Calculo<br />

Actitud<br />

# *<br />

%<br />

# 0<br />

%<br />

%('<br />

# * "<br />

%<br />

# &<br />

%<br />

'()<br />

Calculo<br />

posicion<br />

Mo<strong>de</strong>lo<br />

gravitatorio<br />

Calculo <strong>de</strong><br />

vel. angulares<br />

" !"#"$ !<br />

15 / 49<br />

16 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Mecanización en ejes e<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

En ocasiones, por motivos <strong>de</strong> integración INS-GPS, conviene<br />

mecanizar las ecuaciones en los ejes e (en los que trabaja el<br />

GPS).<br />

Se llega a las siguientes ecuaciones para velocidad y posición:<br />

Velocidad: d<br />

dt v e <br />

= −2 ωe ×<br />

e/i v e + ae NG + g e =<br />

<br />

−2 ωe ×<br />

e/i v e + (C n e ) T (C b n ) T ab e<br />

NG + g<br />

Posición: d<br />

dt r e = v e .<br />

Habría que escribir C n e en función <strong>de</strong> r e y v e , escribir un<br />

mo<strong>de</strong>lo <strong>de</strong> g e , y escribir la ecuación <strong>de</strong> la actitud, y se llegaría<br />

a un esquema similar al anterior.<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Alineamiento inicial I<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

Supongamos que tenemos el avión en reposo en un<br />

aeropuerto, y es necesario inicializar el INS con un “fix”.<br />

¿Cómo se haría?<br />

Evi<strong>de</strong>ntemente, se tiene que φ, λ y h son las <strong>de</strong>l aeropuerto, o<br />

incluso con mayor precisión, las tomadas <strong>de</strong> un sistema GPS.<br />

Puesto el avión está en reposo, v n = 0.<br />

Queda encontrar el valor inicial <strong>de</strong> actitud, es <strong>de</strong>cir,<br />

C b n (t = 0). Para ello se usa la medida obtenida <strong>de</strong> giróscopos<br />

y acelerómetros (en reposo).<br />

De la ecuación fundamental <strong>de</strong> la navegación se tiene:<br />

<br />

0 = − ωn n/e + 2ωn ×<br />

e/i 0 + an NG + g n , luego an NG = −g n y<br />

por tanto ab NG = C b n an NG = −C b n g n .<br />

Por otro lado es claro que ωb b/n = ωb b/i − ωb e/i − ωb n/e y<br />

evi<strong>de</strong>ntemente ωb b/n = 0 y ωb n/e = 0.<br />

Por tanto:ωb b/i = ωb e/i = C b n ωn e/i .<br />

17 / 49<br />

18 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Alineamiento inicial II<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

Tenemos por tanto dos ecuaciones: a b NG = −C b n g n y<br />

ω b b/i = C b n ω n e/i . Llamando a las medidas x b 1 = ab NG y<br />

x b 2 = ωb b/i<br />

x n 2 = ωn e/i<br />

, y <strong>de</strong>notando los mo<strong>de</strong>los como y n<br />

, se tiene que<br />

x n 1 = C b n (0)y b<br />

1 , x n 2 = C b n (0)y b<br />

2<br />

1 = −g n y<br />

Tendríamos 6 medidas (las componentes <strong>de</strong> dos vectores) para<br />

9 grados <strong>de</strong> libertad (las entradas <strong>de</strong> la matriz).<br />

Es necesario pues “generar” una medida adicional<br />

in<strong>de</strong>pendiente.<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Alineamiento inicial III<br />

La IMU: sensores inerciales<br />

Mecanización en ejes n y en ejes e<br />

Alineamiento inicial<br />

Llamemos x 3 = x 1 × x 2. Obsérvese que este vector se pue<strong>de</strong><br />

escribir como x b ×<br />

1 x b<br />

2 en el sistema <strong>de</strong> <strong>referencia</strong> b, don<strong>de</strong> X<br />

es la matriz antisimétrica que representa el producto vectorial.<br />

Por otro lado se tiene que x b <br />

×<br />

1 = C b<br />

n (0) y n<br />

×<br />

C<br />

1<br />

n b (0). Por<br />

<br />

tanto x b 3 = x b ×<br />

1 x b<br />

2 = C b n (0) y n<br />

×<br />

C<br />

1<br />

n b (0)C b n (0)y n<br />

2 =<br />

C b <br />

n (0) y n<br />

×<br />

y<br />

1<br />

n<br />

2 . Por tanto <strong>de</strong>notando y 3 = y 1 × y , se tiene<br />

2<br />

que x b 3 = C b n (0)y n<br />

3 .<br />

Escribiendo la matriz A como la matriz cuyas columnas son<br />

x b 1 , x b 2 y x b 3 , y la matriz B como la matriz cuyas columnas son<br />

y n,<br />

y n<br />

19 / 49<br />

y y n<br />

1 2 3 , se tiene: A = C b n (0)B y por tanto C b n (0) = AB−1 .<br />

No se han tenido en cuenta los errores <strong>de</strong> medida: C b n (0)<br />

probablemente no saldría ortonormal (habría que emplear un<br />

algoritmo más sofisticado que tuviera en cuenta los errores <strong>de</strong><br />

medida).<br />

20 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Errores en navegación inercial.<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Si conociéramos con total precisión las condiciones iniciales, el<br />

mo<strong>de</strong>lo <strong>de</strong> gravedad fuera perfecto, y los sensores inerciales no<br />

cometieran errores <strong>de</strong> medida, entonces la navegación inercial<br />

sería totalmente exacta.<br />

No obstante, ésto no es así, y cada uno <strong>de</strong> los términos<br />

mencionados contiene errores.<br />

Errores en condiciones iniciales.<br />

Errores en el mo<strong>de</strong>lo <strong>de</strong> gravedad δg n .<br />

Errores en los sensores inerciales. Para simplificar los<br />

agruparemos en un único valor: δa b NG , δωb b/i .<br />

La navegación inercial realiza integración <strong>de</strong> ecuaciones<br />

diferenciales, luego éstos errores se van acumulando.<br />

Es importante tener un mo<strong>de</strong>lo <strong>de</strong>l error para saber como<br />

crece, para cuantificarlo, para aplicar medidas que permitan<br />

disminuirlo (como integración con otros sensores), para<br />

<strong>de</strong>scubrir que sensores son más críticos (análisis <strong>de</strong><br />

sensibilidad), etc... 21 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Variables <strong>de</strong> error.<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

En general, para una variable cualquiera <strong>de</strong> navegación x, se<br />

<strong>de</strong>nota con ˆx el valor estimado con el INS.<br />

Puesto que este valor no será exacto se <strong>de</strong>fine el error como<br />

δx = x − ˆx.<br />

Error en posición: las variables <strong>de</strong> posición son φ, λ y h. Las<br />

variables estimadas serán ˆφ, ˆλ, ˆh. Definimos el error en<br />

posición δp como δp = [δφ δλ δh] T = [φ − ˆφ λ − ˆλ h − ˆh] T .<br />

Error en velocidad: igualmente se <strong>de</strong>fine δv n = v n − ˆv n , don<strong>de</strong><br />

ˆv n es la velocidad calculada por el INS.<br />

Para la actitud, ¿cómo <strong>de</strong>finir un error en la matriz <strong>de</strong> actitud<br />

δC b n ?<br />

Lo que se hace es suponer que el INS estima una actitud <strong>de</strong><br />

los ejes cuerpo b que <strong>de</strong>notaremos por ˆb.<br />

22 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Error <strong>de</strong> actitud.<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Por tanto, realmente Ĉ b n = C ˆb n , don<strong>de</strong> se tiene que:<br />

n (ψ,θ,ϕ)<br />

−→ b δφx<br />

−→<br />

xb S1<br />

δφy δφz<br />

−→ S2 −→<br />

y S1 zS2 Por tanto Ĉ b n = C ˆ b n = C ˆ b b C b n .<br />

Suponiendo que los errores δφ = [δφx δφy δφz] T son<br />

pequeños, se vio que C ˆ b b = Id − δφ × , don<strong>de</strong> como siempre:<br />

⎡<br />

δφ × = ⎣<br />

ˆb<br />

0 −δφz δφy<br />

δφz 0 δφx<br />

−δφy δφx 0<br />

Por tanto, se encuentra el error en la matriz <strong>de</strong> actitud como<br />

δC b n = C b n −Ĉ b n = C b n −C ˆb b C b n = C b n −(Id−δφ × )C b n = δφ × C b n .<br />

También<br />

δC b n = δφ × C b n = δφ × C b ˆb C ˆ b n = δφ × (Id + δφ × )Ĉ b n δφ × Ĉ b n .<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Ecuaciones <strong>de</strong> propagación <strong>de</strong>l error<br />

⎤<br />

⎦<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Se quiere estudiar como evoluciona el error <strong>de</strong>l INS con el<br />

tiempo. Para ello, es necesario encontrar el mo<strong>de</strong>lo <strong>de</strong><br />

propagación <strong>de</strong>l error.<br />

Éste mo<strong>de</strong>lo se encuentra directamente <strong>de</strong> las ecuaciones <strong>de</strong><br />

la navegación inercial, suponiendo que los errores son<br />

pequeños, con lo que las ecuaciones se pue<strong>de</strong>n linealizar.<br />

Por ejemplo, supongamos que x es una variable que el INS<br />

estima como ˆx. La ecuación que verifica x será ˙x = f (x). El<br />

INS lo que hará será calcular ˆx a partir <strong>de</strong> ˙ˆx = f (ˆx). Por<br />

tanto: δ ˙x = ˙x − ˙ˆx = f (x) − f (ˆx) = f (ˆx + δx) − f (ˆx).<br />

Desarrollando esta expresión en serie <strong>de</strong> Taylor y quedándonos<br />

el término constante y el lineal: f (ˆx + δx) f (ˆx) + ∂f<br />

∂x |x=ˆxδx.<br />

Por tanto llegamos a la siguiente expresión: δ ˙x = ∂f<br />

∂x |x=ˆxδx,<br />

que es aproximada y sólo sirve para δx pequeño.<br />

23 / 49<br />

24 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Propagación <strong>de</strong>l error en posición I<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Se tiene que las ecuaciones <strong>de</strong> la posición son:<br />

˙φ =<br />

˙λ =<br />

Por tanto el INS calculará:<br />

v N<br />

Re + h<br />

vE ˙h = −v D<br />

˙ˆφ =<br />

˙ˆλ =<br />

cφ(Re + h)<br />

ˆv N<br />

Re + ˆ h<br />

˙ˆh = −ˆv D<br />

ˆv E<br />

c ˆφ(Re + ˆh)<br />

Aplicando la teoría antes <strong>de</strong>sarrollada, por ejemplo, para h:<br />

˙δh = ˙h − ˙ˆh = −vD + ˆvD = −δvD. Como la ecuación ya era<br />

lineal no hubo que linealizar.<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Propagación <strong>de</strong>l error en posición II<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Para la latitud: δ ˙φ = ˙φ − ˙ˆφ = vN ˆvN ˆvN+δvN ˆvN<br />

Re+h − = −<br />

Re+ˆh Re+ˆh+δh Re+ˆh .<br />

Desarrollando en serie <strong>de</strong> Taylor y quedándonos hasta el<br />

término lineal: ˆvN+δvN<br />

Re+ ˆ h+δh<br />

= ˆvN<br />

Re+ ˆ h<br />

Por tanto: δ ˙ φ = 1<br />

Re+ˆh δvN − ˆvN δh.<br />

(Re+ˆh) 2<br />

Operando igualmente con la longitud:<br />

δ ˙λ =<br />

1 +<br />

Re+ ˆ h δvN − ˆvN<br />

(Re+ ˆ δh<br />

h) 2<br />

1<br />

c ˆφ(Re+ˆh) δvE<br />

ˆvE −<br />

c ˆφ(Re+ˆh) 2 δh + ˆvE tan ˆφ<br />

c ˆφ(Re+ˆh) δφ<br />

Poniéndolo todo en una matriz:<br />

δ ˙p = d<br />

2<br />

4<br />

dt<br />

δφ<br />

2<br />

3<br />

0 0 −<br />

6<br />

δλ 5 6<br />

= 6<br />

δh<br />

4<br />

ˆv N<br />

(Re + ˆ h) 2<br />

1 0 0<br />

Re +ˆh<br />

ˆv E tan ˆφ<br />

ˆv<br />

c ˆφ(Re<br />

0 − E<br />

+ˆh)<br />

c ˆφ(Re +ˆh) 2 2<br />

3<br />

6<br />

7 6<br />

7 6<br />

0 1<br />

c ˆφ(Re<br />

0<br />

7 6<br />

+ˆh) 5 6<br />

4<br />

0 0 0 0 0 −1<br />

δφ<br />

δλ<br />

δh<br />

δv N<br />

δv E<br />

δv D<br />

3<br />

7<br />

5<br />

25 / 49<br />

26 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Propagación <strong>de</strong>l error en posición III<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

El resultado se pue<strong>de</strong> escribir abreviadamente como<br />

δ ˙p = Cppδp + Cpvδv n , don<strong>de</strong>:<br />

Cpp =<br />

Cpv =<br />

⎡<br />

⎢<br />

⎣<br />

⎡<br />

⎢<br />

⎣<br />

0 0 − ˆvN<br />

(Re+ ˆ h) 2<br />

ˆvE tan ˆ φ<br />

c ˆ φ(Re+ ˆ h)<br />

1<br />

Re+ ˆ h<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Errores en velocidad angular<br />

0<br />

− 1 tan ˆ φ<br />

Re+ ˆ h δvE − ˆvE tan ˆ φ<br />

0 − ˆvE<br />

c ˆ φ(Re+ ˆ h) 2<br />

0 0 0<br />

0 0<br />

1<br />

c ˆφ(Re+ˆh)<br />

0<br />

0 0 −1<br />

⎤<br />

⎥<br />

⎦<br />

⎤<br />

⎥<br />

⎦ ,<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Para repetir el procedimiento con las ecuaciones <strong>de</strong> velocidad<br />

y actitud necesitamos antes encontrar el error en ωn e/i y en<br />

ωn n/e que <strong>de</strong>notaremos como δωn e/i y δωn n/e .<br />

En primer lugar se tiene que:<br />

ˆω n e/i =<br />

⎡<br />

ωE c<br />

⎣<br />

ˆ φ<br />

0<br />

−ωE s ˆ ⎤<br />

⎦ → δω<br />

φ<br />

n e/i =<br />

⎡<br />

−ωE s<br />

⎣<br />

ˆ φ<br />

0<br />

−ωE c ˆ ⎤<br />

⎦ δφ<br />

φ<br />

Por otro lado: ˆω n n/e =<br />

⎡<br />

ˆvE<br />

⎢ Re+<br />

⎢<br />

⎣<br />

ˆ h<br />

− ˆvN<br />

Re+ ˆ h<br />

− ˆvE<br />

⎤<br />

⎥<br />

⎦ , por tanto:<br />

tan ˆφ<br />

Re+ˆh<br />

δωn n/e =<br />

⎡<br />

1<br />

Re+<br />

⎢<br />

⎣<br />

ˆ h δvE − ˆvE<br />

(Re+ ˆ δh<br />

h) 2<br />

− 1<br />

Re+ˆh δvN + ˆvN<br />

⎤<br />

⎥<br />

δh ⎥<br />

(Re+ˆh) 2 ⎦<br />

δφ<br />

(Re+ ˆ h) 2 δh − ˆvE(1+tan2 ˆ φ)<br />

Re+ ˆ h<br />

27 / 49<br />

28 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Propagación <strong>de</strong>l error en velocidad I<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Las ecuaciones <strong>de</strong> la velocidad que calcula el INS serán:<br />

d<br />

dt ˆv n <br />

= − ˆω n n/e + 2ˆωn ×<br />

e/i ˆv n + (Ĉ b n ) T â b n<br />

NG + ˆg<br />

Por tanto las ecuaciones <strong>de</strong>l error serán:<br />

d<br />

dt δv n =<br />

<br />

− δω n n/e + 2δωn ×<br />

e/i ˆv n <br />

− ˆω n n/e + 2ˆωn ×<br />

e/i δv n<br />

+(δC b n ) T â b NG + (Ĉ b n ) T δa b n<br />

NG + δg<br />

Recor<strong>de</strong>mos que δC b n = δφ × Ĉ b n . Los otros términos los hemos<br />

calculado, excepto δab NG (el error en los acelerómetros) y δg n<br />

(el error en el mo<strong>de</strong>lo gravitatorio).<br />

Puesto que<br />

g n ⎡<br />

0<br />

⎣ 0<br />

µe<br />

(Re+h) 2<br />

⎤<br />

⎦ → δg n ⎡<br />

0<br />

⎢<br />

= ⎣ 0<br />

− 2µe<br />

(Re+ˆh) 3<br />

⎤<br />

⎥<br />

⎦ δh + δG n , don<strong>de</strong><br />

δG n son errores en el mo<strong>de</strong>lado gravitatorio.<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Propagación <strong>de</strong>l error en velocidad II<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Por tanto podremos escribir, como en el caso <strong>de</strong> la posición,<br />

δ ˙v n = Cvpδp + Cvvδv n + Cvφδφ + Caδa b NG + δG n .<br />

Es una ecuación lineal en los errores, don<strong>de</strong> las matrices están<br />

<strong>de</strong>finidas en función <strong>de</strong> la estimación <strong>de</strong>l INS, y con dos<br />

términos forzantes: el error en los acelerómetros δab NG y el<br />

error en el mo<strong>de</strong>lo gravitatorio δG n .<br />

29 / 49<br />

30 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Propagación <strong>de</strong>l error en actitud I<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Finalmente, calculamos el error en actitud.<br />

Recor<strong>de</strong>mos que δC b n = δφ × Ĉ b n , por tanto se tiene que<br />

δ ˙ C b n = δ ˙ φ × Ĉ b n + δφ × ˙<br />

Ĉ b n = δ ˙φ × Ĉ b n − δφ ×<br />

<br />

ˆω b ×<br />

b/n Ĉ b<br />

n .<br />

Por otro lado ˙ Ĉ b <br />

n = − ˆω b ×<br />

b/n Ĉ b<br />

n , y por tanto<br />

δ ˙C b <br />

n = − δωb × <br />

b/n Ĉ b<br />

n − ˆω b ×<br />

b/n δφ × C b n .<br />

De don<strong>de</strong> llegamos a δ ˙ φ × Ĉ b n − δφ ×<br />

<br />

ˆω b ×<br />

b/n Ĉ b<br />

n =<br />

<br />

− δωb × <br />

b/n Ĉ b<br />

n − ˆω b ×<br />

b/n δφ × Ĉ b n , o lo que es lo mismo:<br />

δ ˙φ × <br />

= −<br />

ˆω b × <br />

b/n − ˆω b ×<br />

b/n δφ × .<br />

<br />

δωb ×<br />

b/n + δφ ×<br />

Usando la i<strong>de</strong>ntidad a × (b × c) + c × (b × a) + b × (c × a) = 0<br />

llegamos a a × (b × c) − b × (a × c) = (b × a) × c. Esto<br />

implica que a × b × c − b × a × c = (b × a) × c, por lo que<br />

a × b × − b × a × = (b × a) × .<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Propagación <strong>de</strong>l error en actitud II<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Es <strong>de</strong>cir, finalmente: δφ × <br />

= − δωb × <br />

b/n + δφ × ˆω b ×<br />

b/n . De<br />

don<strong>de</strong>: δ ˙φ = −δωb b/n + δφ× ˆω b b/n .<br />

Como por otro lado, ˆω b b/n = ˆωb b/i − Ĉ b <br />

n ˆω n e/i + ˆωn <br />

n/e , se<br />

obtiene que<br />

δωb b/n = δωb b/i − δC b <br />

n ˆω n e/i + ˆωn <br />

n/e − Ĉ b <br />

n δωn e/i + δωn <br />

n/e .<br />

Por tanto finalmente la ecuación <strong>de</strong>l error <strong>de</strong> actitud queda:<br />

δ ˙φ = −δω b b/i + δφ× Ĉ b <br />

n ˆω n e/i + ˆωn <br />

n/e − Ĉ b <br />

n δω n e/i + δωn <br />

n/e<br />

<br />

+δφ × ˆω b b/i − δφ× Ĉ b n<br />

= −δω b b/i − Ĉ b n<br />

ˆω n e/i + ˆωn n/e<br />

<br />

δω n e/i − δωn <br />

n/e + δφ × ˆω b b/i<br />

31 / 49<br />

32 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Propagación <strong>de</strong>l error <strong>de</strong>l INS.<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Por tanto podremos escribir, como antes,<br />

δ ˙φ = Cφpδp + Cφv δv n + Cφφδφ − δωb b/i .<br />

Es una ecuación lineal en los errores, don<strong>de</strong> las matrices están<br />

<strong>de</strong>finidas en función <strong>de</strong> la estimación <strong>de</strong>l INS, y con un<br />

términos forzante: el error en los giróscopos δωb b/i .<br />

Si ponemos todos los errores juntos, llegamos a:<br />

d<br />

dt<br />

⎡<br />

⎣<br />

δp<br />

δv n<br />

δφ<br />

⎤<br />

⎡<br />

⎦ = ⎣<br />

Cpp Cpv 0<br />

Cvp Cvv Cvφ<br />

Cφp Cφv Cφφ<br />

⎤ ⎡<br />

⎦ ⎣<br />

δp<br />

δv n<br />

δφ<br />

⎡<br />

⎤<br />

⎡<br />

⎦+ ⎣<br />

Caδab NG<br />

−δωb b/i<br />

⎤<br />

0<br />

n<br />

+ δG ⎦<br />

δp<br />

A<strong>de</strong>más estarán las condiciones iniciales: ⎣ δv n ⎦ (t = 0).<br />

δφ<br />

Éste es el mo<strong>de</strong>lo <strong>de</strong> propagación <strong>de</strong>l error <strong>de</strong>l INS. Puesto<br />

que el término forzante es <strong>de</strong>sconocido (y se mo<strong>de</strong>la mediante<br />

la estadística) es una ecuación diferencial estocástica.<br />

33 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

⎤<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Ecuación <strong>de</strong>l error en el canal vertical I<br />

Si trabajamos sólo con el error en h y VD, y <strong>de</strong>spreciamos<br />

todos los términos excepto el gravitatorio, llegamos a la<br />

siguiente ecuación:<br />

δ ˙ h = −δVD<br />

δ ˙VD −2<br />

µe<br />

δh.<br />

(Re + ˆh) 3<br />

Por otro lado po<strong>de</strong>mos aproximar en el <strong>de</strong>nominador<br />

Re + ˆ h Re. Teniendo en cuenta que la aceleración <strong>de</strong> la<br />

gravedad al nivel <strong>de</strong>l mar g0 = µe<br />

R 2 e<br />

δ ˙h = −δVD<br />

δ ˙ VD − 2g0<br />

δh.<br />

Re<br />

, tendríamos las ecuaciones:<br />

Escribiéndolo como una única ecuación para δh: δ ¨ h = 2g0<br />

Re δh.<br />

34 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Variables <strong>de</strong> error. Error en actitud<br />

Mo<strong>de</strong>lo <strong>de</strong> propagación linealizado<br />

El canal vertical<br />

Ecuación <strong>de</strong>l error en el canal vertical II<br />

La solución <strong>de</strong> la ecuación diferencial es:<br />

q<br />

2g0<br />

Re t + C2e −<br />

q<br />

2g0<br />

δh = C1e<br />

Re t , don<strong>de</strong> las constantes son función<br />

<strong>de</strong> las condiciones iniciales <strong>de</strong> altura y velocidad vertical.<br />

Éstas ecuaciones son inestables! El primer término crece hasta<br />

el infinito.<br />

Físicamente, lo que suce<strong>de</strong> es lo siguiente: si hay un error <strong>de</strong><br />

altitud, p.ej. el INS piensa que el avión está más alto <strong>de</strong> lo<br />

que realmente está, el mo<strong>de</strong>lo <strong>de</strong> gravedad predice que la<br />

gravedad es menor <strong>de</strong> lo que es, con lo que el INS predice que<br />

el avión se eleva, es <strong>de</strong>cir, el error inicial se amplifica!<br />

Éste resultado se mantiene si no se <strong>de</strong>sprecian los términos<br />

que no se han consi<strong>de</strong>rado. Por tanto el canal vertical <strong>de</strong>l INS<br />

es inestable y no se pue<strong>de</strong> usar por sí sólo; empleando otras<br />

medidas (p.ej. barométricas) es posible compensar el canal<br />

vertical y obtener una medida fiable <strong>de</strong> la altura.<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Fuentes <strong>de</strong> Error<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

Hemos visto que las ecuaciones <strong>de</strong> propagación <strong>de</strong>l error son<br />

<strong>de</strong>l tipo δ ˙x = A(ˆx)δx + δɛ, don<strong>de</strong> δx son las variables <strong>de</strong><br />

navegación (posición, velocidad, actitud) y los δɛ las fuentes<br />

<strong>de</strong> error. Estas fuentes son:<br />

Errores en el mo<strong>de</strong>lo <strong>de</strong> gravedad δg n .<br />

Errores en los sensores inerciales δa b NG , δωb b/i .<br />

Aparte está el error en las condiciones iniciales δx(t0).<br />

Si discretizamos estas ecuaciones en el tiempo, podríamos<br />

escribir un mo<strong>de</strong>lo algo más sencillo:<br />

δx(tk+1) = A(tk)δx(tk) + δɛ(tk).<br />

¿Cómo se mo<strong>de</strong>lan los errores? ¿Cómo se interpretan las<br />

ecuaciones que contienen errores?<br />

Para respon<strong>de</strong>r a estas preguntas es necesario recordar<br />

algunos conceptos estadísticos.<br />

35 / 49<br />

36 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Descripción estadística <strong>de</strong>l error<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

Consi<strong>de</strong>remos por ejemplo el caso <strong>de</strong>l error <strong>de</strong> medida <strong>de</strong> un<br />

acelerómetro: ab NG = âbNG + δab NG , don<strong>de</strong> δab NG son errores <strong>de</strong><br />

medida.<br />

Una componente <strong>de</strong> δa b NG , por ejemplo δax, pue<strong>de</strong> tener el<br />

siguiente aspecto:<br />

Es imposible conocer el valor con exactitud.<br />

Se observa que cambia con el tiempo.<br />

Por tanto, se representan sus propieda<strong>de</strong>s usando la<br />

estadística.<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

Variables aleatorias continuas unidimensionales<br />

Sea una variable aleatoria X ∈ R continua.<br />

Recor<strong>de</strong>mos que la función <strong>de</strong> distribución F (x) es la<br />

probabilidad <strong>de</strong> que X ≤ x, que se escribe como<br />

F (x) = P(X ≤ x).<br />

La función <strong>de</strong> distribución se calcula mediante la función <strong>de</strong><br />

<strong>de</strong>nsidad f (x): F (x) = x<br />

−∞ f (y)dy.<br />

Se <strong>de</strong>fine el operador esperanza matemática actuando sobre la<br />

función g(x) como E[g(X )] = ∞<br />

−∞ g(y)f (y)dy. Se trata <strong>de</strong><br />

un operador lineal, <strong>de</strong> forma que<br />

E[α1g1(X ) + α2g2(X )] = α1E[g1(X )] + α2E[g2(X )]. Los dos<br />

casos importantes son:<br />

Media: m(X ) = E[X ] = ∞<br />

yf (y)dy.<br />

−∞<br />

Varianza: V (X ) = E[(X − m(X )) 2 ] = E[X 2 ] − (E[X ]) 2 .<br />

Desviación típica σ, la raíz cuadrada <strong>de</strong> la varianza,<br />

σ = V (X ).<br />

37 / 49<br />

38 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Distribución normal o gaussiana I<br />

f (x) = 1<br />

σ √ 2π Exp<br />

− (x−m)2<br />

2σ 2<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

Es la distribución más usada en estadística. Se escribe<br />

X ∼ N(m, σ2 ) y su función<strong>de</strong> <strong>de</strong>nsidad es<br />

.<br />

Intervalos <strong>de</strong> confianza: si X ∼ N(m, σ 2 ):<br />

Intervalo 1-σ: P(X ∈ [m − σ, m + σ]) = 68,3 %.<br />

Intervalo 2-σ: P(X ∈ [m − 2σ, m + 2σ]) = 95,45 %.<br />

Intervalo 3-σ: P(X ∈ [m − 3σ, m + 3σ]) = 99,74 %.<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Distribución normal o gaussiana II<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

El teorema central <strong>de</strong>l límite dice que la suma <strong>de</strong> variables<br />

aleatorias (con cualquier tipo <strong>de</strong> distribución) tien<strong>de</strong> en media<br />

a la normal. Puesto que los errores a gran escala provienen <strong>de</strong><br />

la suma y acumulación <strong>de</strong> muchos errores a pequeña escala,<br />

esto justifica el uso <strong>de</strong> la normal como mo<strong>de</strong>lo para errores.<br />

Una propiedad importante <strong>de</strong> la normal es que la suma <strong>de</strong><br />

normales es <strong>de</strong> nuevo normal, es <strong>de</strong>cir, si X ∼ N(mx, σ 2 x) e<br />

Y ∼ N(my , σ 2 y ) y son in<strong>de</strong>pendientes, entonces si Z = X + Y<br />

se tiene que Z ∼ N(mx + my , σ 2 x + σ 2 y ).<br />

Por tanto σz =<br />

<br />

σ 2 x + σ 2 y , es <strong>de</strong>cir, la <strong>de</strong>sviación típica <strong>de</strong> la<br />

suma <strong>de</strong> errores es la raíz cuadrada <strong>de</strong> la suma <strong>de</strong> los<br />

cuadrados <strong>de</strong> las <strong>de</strong>sviaciones típicas <strong>de</strong> los errores.<br />

Esta regla, conocida como Root-Sum-of-Squares (RSS) es<br />

muy importante.<br />

39 / 49<br />

40 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

Variables aleatorias continuas multidimensionales<br />

Sea una variable aleatoria X ∈ Rn continua multidimensional.<br />

Cada componente <strong>de</strong> X sigue una distribución unidimensional.<br />

Como en el caso unidimensional, se <strong>de</strong>fine una función <strong>de</strong><br />

distribución conjunta, que se calcula mediante la función <strong>de</strong><br />

<strong>de</strong>nsidad f (x).<br />

Igualmente E[g(X )] = <br />

Rn g(y)f (y)dy. Los dos casos<br />

importantes son:<br />

Media: m(X ) = E[X ] = <br />

Rn yf (y)dy.<br />

Matriz <strong>de</strong> covarianzas:<br />

Cov(X ) = E[(X − m(X ))(X − m(X )) T ] = Σ. Es una matriz<br />

simétrica y <strong>de</strong>finida positiva. Los valores <strong>de</strong> la diagonal<br />

representan la varianza <strong>de</strong> cada componente <strong>de</strong> X , mientras<br />

que los valores fuera <strong>de</strong> la diagonal la correlación entre dos<br />

componentes <strong>de</strong> X . Se tiene Σ = E[(X X T ] − m(X )m(X ) T .<br />

Por ejemplo, para n = 3 y escribiendo X = [X , Y , Z]:<br />

2<br />

6<br />

Σ = 4<br />

σ 2 x E[(X − mx )(Y − my )] E[(X − mx )(Z − mz )]<br />

E[(X − mx )(Y − my )] σ 2 y E[(Y − my )(Z − mz )]<br />

E[(X − mx )(Z − mz )] E[(Y − my )(Z − mz )] σ 2 z<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Distribución normal multivariante I<br />

3<br />

7<br />

5<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

Se escribe X ∼ Nn(m, Σ) y su función <strong>de</strong> <strong>de</strong>nsidad es<br />

1<br />

f (x) =<br />

Det(Σ)(2π) n/2 Exp − 1<br />

2 (x − m)T Σ−1 (x − m) .<br />

Los intervalos <strong>de</strong> confianza son ahora regiones <strong>de</strong> Rn ,<br />

<strong>de</strong>finidos por P(X ∈ Ω) = PΩ.<br />

La forma <strong>de</strong> estas regiones <strong>de</strong> confianza es <strong>de</strong> elipsoi<strong>de</strong>s,<br />

<strong>de</strong>scritos por la ecuación (x − m) T Σ−1 (x − m) = d 2 , don<strong>de</strong> d<br />

<strong>de</strong>pen<strong>de</strong> <strong>de</strong> PΩ. Cuanto mayores sean los valores <strong>de</strong> los<br />

autovalores <strong>de</strong> Σ, mayor será el elipsoi<strong>de</strong>. Las direcciones <strong>de</strong><br />

los ejes <strong>de</strong>l elipsoi<strong>de</strong> vendrán dados por los autovectores <strong>de</strong> Σ.<br />

41 / 49<br />

42 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

Distribución normal multivariante II<br />

Si por ejemplo <strong>de</strong>scribimos el error en posición en ejes cuerpo,<br />

δr b = [δx δy δz] T , como una normal multivariante con n = 3,<br />

<strong>de</strong> media cero (centrada en el avión) y con matriz <strong>de</strong><br />

covarianzas:<br />

2<br />

6<br />

Σ = 4<br />

σ 2 x 0 0<br />

0 σ 2 y 0<br />

0 0 σ 2 z<br />

Entonces σx representa la magnitud <strong>de</strong>l error ATE<br />

(along-track error), σy <strong>de</strong>l error XTE (cross-track error) y σz<br />

<strong>de</strong>l error VE (vertical error) y po<strong>de</strong>mos asimilar el movimiento<br />

<strong>de</strong>l avión al movimiento <strong>de</strong>l elipsoi<strong>de</strong>, que representa una<br />

región <strong>de</strong> incertidumbre don<strong>de</strong> se pue<strong>de</strong> encontrar el avión con<br />

gran probabilidad.<br />

Se verifica que si X ∼ Nn(m x, Σx) e Y ∼ Nn(m y , Σy ) y son<br />

in<strong>de</strong>pendientes, entonces si Z = X + Y resulta<br />

Z ∼ Nn(m x + m y , Σx + Σy ).<br />

Igualmente AX + b don<strong>de</strong> A y b son no-aleatorios verifica que<br />

AX + b ∼ Nn(Am x + b, AΣxA T ).<br />

43 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Procesos estocásticos.<br />

3<br />

7<br />

5<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

Un proceso estocástico o variable estocástica no es sino una<br />

variable aleatoria X (t) que cambia con el tiempo. Los errores<br />

<strong>de</strong> navegación serán este tipo <strong>de</strong> variables.<br />

Por tanto la media y la covarianza también varían con el<br />

tiempo: m(t), Σ(t).<br />

Para un proceso, se <strong>de</strong>fine la autocorrelación como<br />

R(t, τ) = E[X (t)X (τ) T ]. La autocorrelación permite conocer<br />

hasta que punto la historia pasada <strong>de</strong> X influye en su valor<br />

actual.<br />

Proceso gaussiano: Un proceso gaussiano verifica<br />

X (t) ∼ Nn(m(t), Σ(t)), es <strong>de</strong>cir, se distribuye como una<br />

normal multivariante cuya media y covarianza varían con el<br />

tiempo.<br />

44 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Ruido blanco.<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

Ruido blanco: Se <strong>de</strong>fine como ruido blanco un proceso ν(t)<br />

que verifica:<br />

E[ν(t)] = 0.<br />

E[ν(t)ν(t) T ] = σ 2 Id.<br />

R(t, τ) = E[ν(t)ν(τ) T ] = δ(t − τ)σ 2 Id, don<strong>de</strong> δ(x) vale 1 si<br />

x = 0 y 0 en cualquier otro caso.<br />

La última condición quiere <strong>de</strong>cir que el valor <strong>de</strong>l ruido blanco<br />

en un instante es in<strong>de</strong>pendiente <strong>de</strong> su valor en cualquier<br />

instante anterior.<br />

Ruido blanco gaussiano: Es un proceso que cumple las<br />

condiciones anteriores, y a<strong>de</strong>más es gaussiano.<br />

Un buen mo<strong>de</strong>lo para las fuentes <strong>de</strong> error (errores <strong>de</strong> medida,<br />

errores gravitatorios) es δɛ(tk) = b + Dν, don<strong>de</strong> ν es ruido<br />

blanco gaussiano. El valor <strong>de</strong> b dará la media <strong>de</strong>l error (sesgo,<br />

llamado bias en inglés).<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Propagación <strong>de</strong>l error.<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

45 / 49<br />

Si en las ecuaciones <strong>de</strong> propagación <strong>de</strong>l error<br />

δx(tk+1) = A(k)δx(tk) + δɛ(tk) sustituimos δɛ(tk) = b + Dν,<br />

obtenemos el siguiente mo<strong>de</strong>lo <strong>de</strong> propagación <strong>de</strong>l error:<br />

δx(tk+1) = A(k)δx(tk) + b + Dν.<br />

Observación: típicamente b también está sometido a un error<br />

variable, <strong>de</strong> forma que b(tk+1) = b(tk) + Dbν b. Para<br />

simplificar ignoramos esta variación.<br />

Se realizan las siguientes hipótesis:<br />

ν es ruido blanco gaussiano con varianza σ2 ν.<br />

Inicialmente, δx(t0) ∼ Nn(m0 , Σ0). Si se conocieran<br />

perfectamente, entonces Σ0 = 0.<br />

A<strong>de</strong>más se tiene la hipótesis <strong>de</strong> que δx(t0) y ν son<br />

in<strong>de</strong>pendientes.<br />

Bajo estas condiciones, se tiene que δx(tk) es un proceso<br />

gaussiano, es <strong>de</strong>cir, δx(tk) ∼ Nn(mk, Σk), don<strong>de</strong> la media y la<br />

covarianza verifican la siguiente evolución:<br />

Propagación <strong>de</strong> la media: mk+1 = Amk + b.<br />

Propagación <strong>de</strong> la covarianza: Σk+1 = AΣkAT + σ2 νDDT . 46 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Propagación <strong>de</strong>l error: ejemplo sencillo<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

Supongamos que tuviéramos una ecuación <strong>de</strong> propagación <strong>de</strong>l<br />

error en una dimensión (por ejemplo la posición en el eje x)<br />

dada simplemente por: δxk+1 = δxk + ν, don<strong>de</strong>:<br />

La variable temporal k representa minutos, es <strong>de</strong>cir, x6 es el<br />

error en posición pasados 6 minutos.<br />

ν es ruido blanco gaussiano <strong>de</strong> varianza σ 2 ν.<br />

Inicialmente, δx(t0) = 0.<br />

A<strong>de</strong>más δx(tk) y ν son in<strong>de</strong>pendientes.<br />

Entonces aplicando las fórmulas anteriores,<br />

δx(tk) ∼ N(mk, σk), don<strong>de</strong> la media y la varianza verifican:<br />

Propagación <strong>de</strong> la media: mk+1 = amk. Como m0 = 0, se<br />

tendrá mk = 0 para todo k.<br />

Propagación <strong>de</strong> la varianza: σ2 k+1 = σ2 k + σ2 nu. Como σ2 0 = 0, se<br />

tiene que σ2 k = kσ2 nu. Por tanto la varianza verifica σk = √ kσν.<br />

Si por ejemplo x son metros y el ruido blanco tiene σν = 0,1<br />

metros, entonces aunque inicialmente la posición se conoce<br />

sin error, pasada una hora σ60 = √ 60 · 0,1 = 0,77, es <strong>de</strong>cir un<br />

intervalo 2-σ sería δx ∈ [−1,55, 1,55]. 47 / 49<br />

Sistema <strong>de</strong> navegación autónomo: Navegación inercial.<br />

Errores en navegación inercial.<br />

Mo<strong>de</strong>los <strong>de</strong> Error<br />

Medida <strong>de</strong>l error en 2-D<br />

Breve recordatorio <strong>de</strong> estadística<br />

Procesos estocásticos. Ruido blanco. Propagación.<br />

Medidas <strong>de</strong>l error.<br />

Para el caso 2-D (por ejemplo posición sobre un mapa) y si el<br />

error está distribuido como X ∼ N2(0, Σ), las regiones <strong>de</strong><br />

confianza serían elipses:<br />

Dado Σ po<strong>de</strong>mos escribir Σ = Pdiag{σ1, σ2}P T don<strong>de</strong> P es<br />

una matriz con autovectores y σi los autovalores. Los<br />

autovectores dan la dirección <strong>de</strong> los ejes <strong>de</strong> la elipse y los<br />

autovalores son proporcionales a su magnitud (cuyo valor<br />

exacto <strong>de</strong>pen<strong>de</strong>rá <strong>de</strong>l grado <strong>de</strong> confianza <strong>de</strong>l intervalo).<br />

48 / 49


Sistema <strong>de</strong> navegación autónomo: Navegación inercial. Breve recordatorio <strong>de</strong> estadística<br />

Errores en navegación inercial. Procesos estocásticos. Ruido blanco. Propagación.<br />

Mo<strong>de</strong>los <strong>de</strong> Error !"#$$%&'$(")*'+%&*+","!-"<br />

Medidas <strong>de</strong>l error.<br />

"<br />

&'()"*+,"-#./0/#)."12("3#44(5"#6(2"0/7(8"0'("-#./0/#)."12(".9100(2(5"#6(2"1)"12(1"5:("0#"<br />

7(1.:2(7()0"(22#2.;"("0'(/2"(?:/-7()0@."199:219A;"#)013"-#./0/#)"(22#2.8"0'(".01)5125"(22#2."V!W"$2#7"0'("B)#=)"-#./0/#)"/)"0'("<br />

σx/3 ≤ σy ≤ 3σx, entonces 5/2(90/#)."#$"0'("9##25/)10("1T/."12("2(?:/2(5;""<br />

CEP 0,59(σx + σy ).<br />

"<br />

Otra medida comúnmenteOPK,"/."0'(".?:12("2##0"#$"0'("16(214("#$"0'(".?:12("(22#2."='/9'"/."5($/)(5"1."$#33#=.Q" usada (FAA) es el 2DRMS: círculo<br />

"<br />

! !<br />

OPK,"X" ! " " ! ! "<br />

que contiene <strong>de</strong>l 95 % al 98 % <strong>de</strong> los puntos. Se calcula<br />

!",01)5125"(22#2."V!W"#$"(.0/710(5"9##25/)10(."VT8"AW"#$"(19'"-#/)0"C(/)4"-#./0/#)(5"<br />

91)"C("-2(5/90(5"$2#7"0'("9#22(.-#)5/)4"612/1)9(."#)"0'("5/14#)13"#$"0'("<br />

DRMS = σ 9#612/1)9("7102/T;""<br />

2 x + σ2 y . Entonces el 2DRMS es el círculo <strong>de</strong>


Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Navegación Aérea<br />

Tema 5: Sistema <strong>de</strong> navegación por posicionamiento.<br />

Navegación por satélite.<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

Sistema <strong>de</strong> navegación por posicionamiento.<br />

La navegación por posicionamiento consiste en averiguar la<br />

localización geográfica con ayuda <strong>de</strong> señales o medidas<br />

exteriores.<br />

El ejemplo más temprano es la navegación astronómica que ya<br />

se vio en la introducción histórica. Dicho tipo <strong>de</strong> navegación<br />

aún se emplea, especialmente para vehículos espaciales y<br />

misiles balísticos.<br />

Actualmente la navegación por posicionamiento se realiza<br />

mediante radioayudas (por ejemplo VOR/DME, DME/DME),<br />

radar y/o sistemas <strong>de</strong> navegación por satélite (GNSS).<br />

A<strong>de</strong>más <strong>de</strong> la posición se pue<strong>de</strong> encontrar la velocidad<br />

estudiando el efecto Doppler en las señales. También pue<strong>de</strong><br />

ser posible hallar la actitud.<br />

Veremos en <strong>de</strong>talle la navegación DME/DME y GNSS, y su<br />

impacto en la navegación aérea hoy en día.<br />

2 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Fundamentos básicos.<br />

DME I<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

Los sistemas <strong>de</strong> posicionamiento que vamos a estudiar se<br />

basan en la recepción (y en el caso <strong>de</strong>l DME, emisión) <strong>de</strong><br />

señales respecto a un punto <strong>de</strong> <strong>referencia</strong> cuya localización es<br />

conocida (una estación, un satélite).<br />

Estudiando el tiempo <strong>de</strong> transmisión <strong>de</strong> dichas señales, se<br />

encuentra la distancia hasta el punto <strong>de</strong> <strong>referencia</strong>.<br />

Con dicha distancia se pue<strong>de</strong> construir un lugar geométrico <strong>de</strong><br />

puntos posibles don<strong>de</strong> pue<strong>de</strong> hallarse la aeronave.<br />

Dado el suficiente número <strong>de</strong> estaciones o satélites, se<br />

podrá hallar la posición <strong>de</strong> la aeronave como la intersección <strong>de</strong><br />

dichos lugares geométricos.<br />

La posición relativa <strong>de</strong> los puntos <strong>de</strong> <strong>referencia</strong> influirá en el<br />

error (DOP: Dilution of Precision).<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

DME=Distance Measurement Equipment.<br />

El sistema requiere un emisor/receptor en la<br />

aeronave y un transpon<strong>de</strong>r en la estación en<br />

tierra.<br />

El sistema en la aeronave interroga al<br />

transpon<strong>de</strong>r en tierra mediante una serie <strong>de</strong><br />

pares <strong>de</strong> pulsos. La estación respon<strong>de</strong> con una<br />

secuencia idéntica <strong>de</strong> pulsos con un cierto<br />

retraso específico (50 microsegundos).<br />

3 / 48<br />

La distancia se calcula simplemente midiendo el<br />

tiempo que tardan las señales en retornar tras<br />

su emisión; a dicho tiempo se le resta 50<br />

microsegundos y se divi<strong>de</strong> por 2. Dividiendo el<br />

resultado por la velocidad <strong>de</strong> la luz, se obtiene<br />

una buena estimación <strong>de</strong> la distancia a la<br />

estación en tierra. 4 / 48


DME II<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

La secuencia <strong>de</strong> pares <strong>de</strong> pulsos <strong>de</strong>pen<strong>de</strong> <strong>de</strong>l equipo <strong>de</strong>l avión,<br />

por lo que un mismo equipo <strong>de</strong> tierra pue<strong>de</strong> respon<strong>de</strong>r a<br />

múltiples equipos en el aire (hasta 100–200 aeronaves).<br />

La precisión típica <strong>de</strong> un DME está entre 185 m (0.1 nm) y<br />

926 m. (0.5nm) 2 − σ. Se pue<strong>de</strong>n obtener medidas casi<br />

continuamente (10 medidas por segundo). También se obtiene<br />

una estimación <strong>de</strong> la velocidad (proyectada en la dirección <strong>de</strong><br />

la estación) mediante el efecto Doppler.<br />

Obsérvese que la medida <strong>de</strong> distancia D es 3-D. Para obtener<br />

la distancia sobre el terreno, dG , si la altitud Alt es conocida:<br />

D 2 = d 2 G + Alt2 .<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Navegación DME/DME<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

Consi<strong>de</strong>remos el caso <strong>de</strong> dos DMEs. En principio existirá una<br />

ambigüedad que se pue<strong>de</strong> resolver conocidas medidas<br />

anteriores o con una tercera estación.<br />

Simplifiquemos y supongamos Tierra plana y las coor<strong>de</strong>nadas<br />

x, y que mi<strong>de</strong>n la posición <strong>de</strong> la aeronave; las coor<strong>de</strong>nadas<br />

x1, y1 y x2, y2 <strong>de</strong>terminan la posición <strong>de</strong> las estaciones.<br />

Se mi<strong>de</strong> la distancia a la primera estación ρ1 y a la segunda<br />

estación ρ2 (distancias sobre tierra).<br />

Las ecuaciones que hay que resolver para hallar la posición<br />

son:<br />

(x − x1) 2 + (y − y1) 2 = ρ1, (x − x2) 2 + (y − y2) 2 = ρ2.<br />

Éstas ecuaciones son sencillas <strong>de</strong> resolver. Pero si las<br />

distancias contienen error, ¿cómo <strong>de</strong>terminar el error final en<br />

la estimación <strong>de</strong> posición?<br />

5 / 48<br />

6 / 48<br />

User location<br />

In the presence of measurement errors, the range rings used to compute the<br />

user’s location will be in error and result in error in the computed position. The con-<br />

Navegación por posicionamiento<br />

cept of dilution of precision is theGNSS: i<strong>de</strong>aNavegación that the position por satéliteerror<br />

that results from mea-<br />

GPS: Otros conceptos<br />

surement errors <strong>de</strong>pends on the user/foghorn relative geometry. Graphically, these<br />

i<strong>de</strong>as are illustrated in Figure 7.5. Two geometries are indicated. In Figure 7.5(a),<br />

Errores en navegación Foghorn 2DME/DME<br />

Variation in range ring<br />

due to range errors:<br />

from foghorn 1<br />

from foghorn 2<br />

Foghorn 2<br />

Variation in range ring due to<br />

range errors:<br />

from foghorn 1<br />

from foghorn 2<br />

RNAV<br />

Variation in range ring due to<br />

range errors:<br />

from foghorn 1<br />

from foghorn 2<br />

User location<br />

Foghorn 2<br />

Foghorn 1<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

Sha<strong>de</strong>d region: Locations<br />

using data from Sha<strong>de</strong>d within region: Locations using data<br />

indicated error frombounds within indicated error bounds<br />

User location<br />

Figure 7.5 Relative geometry and dilution of precision: (a) geometry with low DOP, and (b)<br />

geometry with high DOP.<br />

(a)<br />

User location<br />

Los errores <strong>de</strong>pen<strong>de</strong>n <strong>de</strong> la posición relativa <strong>de</strong> las estaciones<br />

Foghorn 1<br />

DME con respecto al receptor.<br />

Si la linea que une al receptor con uno <strong>de</strong> los DME forma 90<br />

Foghorn 2<br />

grados con la linea que une al receptor con el otro DME, la<br />

Foghorn 1<br />

situación es óptima, como se (b) ve en la figura <strong>de</strong> la izquierda.<br />

Figure 7.5 Relative (a) geometry and dilution of precision: (a) geometry with low DOP, and (b)<br />

Si dichas geometry lineas with high forman DOP. un ángulo pequeño (por ejemplo si el<br />

receptor se encuentra aproximadamente entre las estaciones<br />

DME) la situación Sha<strong>de</strong>d region: es adversa, Locations using como data se muestra en la figura <strong>de</strong><br />

from within indicated error bounds<br />

la <strong>de</strong>recha.<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

RNAV=aRea NAVigation.<br />

7 / 48<br />

La navegación tradicional exige emplear<br />

radioayudas (típicamente VOR) como<br />

waypoints generando aerovías rígidas que<br />

no permiten explotar el espacio aéreo.<br />

Foghorn Los 1 sistemas <strong>de</strong> navegación actuales<br />

(b) permiten saber la posición <strong>de</strong> la aeronave<br />

con precisión, para cualquier ruta.<br />

RNAV es un procedimiento <strong>de</strong> navegación que permite diseñar<br />

una ruta arbitraria con waypoints virtuales, siempre que la<br />

ruta <strong>de</strong> la aeronave se encuentre en una zona don<strong>de</strong> los<br />

sistemas <strong>de</strong> navegación tengan la suficiente precisión.<br />

Dicha precisión se pue<strong>de</strong> especificar, <strong>de</strong> forma que una<br />

<strong>de</strong>terminada ruta o procedimiento RNAV sólo la pue<strong>de</strong>n<br />

realizar aviones con ciertas características y a<strong>de</strong>cuadamente<br />

equipados. Ésta especificación se <strong>de</strong>nomina RNP. 8 / 48


RNAV/RNP<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

RNP=Required Navigation Performance.<br />

Es un conjunto <strong>de</strong> estándares que especifican<br />

los requisitos mínimos que una aeronave y su<br />

sistema <strong>de</strong> navegación <strong>de</strong>ben cumplir para<br />

operar en un <strong>de</strong>terminado espacio aéreo.<br />

RNAV/RNP: permite diseñar rutas con menor<br />

separación que la tradicionalmente empleada, y<br />

por tanto una explotación eficiente <strong>de</strong>l espacio<br />

aéreo.<br />

RNAV/RNP es el futuro <strong>de</strong>l tráfico aéreo y requiere un amplio<br />

conocimiento <strong>de</strong> los sistemas <strong>de</strong> navegación utilizados.<br />

Ejemplificamos éstos conceptos para el caso DME-DME.<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Navegación RNAV DME/DME<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

9 / 48<br />

Los sistemas DME/DME están extendidos hoy<br />

en día y permiten suficiente cobertura para<br />

todas las operaciones en ruta en Europa.<br />

Permiten cumplir los requisitos RNAV si bien se<br />

reconoce que <strong>de</strong>bería aumentar el número <strong>de</strong><br />

estaciones para mejorar la precisión.<br />

Para po<strong>de</strong>r realizar navegación DME/DME los<br />

requisitos mínimos son 2 estaciones cumpliendo:<br />

Distancia menor <strong>de</strong> 200 nm y mayor <strong>de</strong> 1nm.<br />

Arco subtendido entre las dos estaciones<br />

situado entre 30 grados y 150 grados.<br />

Cuantas más estaciones estén disponibles,<br />

mayor precisión se podrá conseguir. En<br />

cualquier caso la precisión <strong>de</strong>pen<strong>de</strong>rá <strong>de</strong>l<br />

equipo.<br />

10 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Diseño <strong>de</strong> un RNAV in Europe procedimiento - Procedure Design Master Class I<br />

Estimated<br />

Flight Path<br />

SYSTEM ACCURACY<br />

HORIZONTAL VIEW<br />

Nominal Flight<br />

Path<br />

Estimated Position<br />

True Aircraft Flight Path<br />

FTT<br />

Eliane Belin<br />

ATT<br />

XTT <strong>de</strong>pends on FTT<br />

True Aircraft Position<br />

XTT<br />

Nominal Aircraft<br />

Position<br />

EUROCONTROL<br />

10<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

RNAV in Europe - Procedure Design Master Class<br />

WAYPOINT TOLERANCE<br />

Errores 2-D: ATT (along-track tolerance) y XTT (cross-track<br />

tolerance).<br />

Éstos son los errores que se requieren para diseñar<br />

procedimientos RNAV. Se fija un corredor <strong>de</strong> seguridad en<br />

torno a la trayectoria que respete estos errores máximos.<br />

Aparte <strong>de</strong> los errores proce<strong>de</strong>ntes <strong>de</strong>l DME, otros errores que<br />

juegan un papel son (FTT=error técnico <strong>de</strong> vuelo) y el error<br />

<strong>de</strong> cálculo (ST=system tolerance).<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Diseño <strong>de</strong> un procedimiento II<br />

ATT<br />

XTT<br />

Eliane Belin<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

Aunque el error <strong>de</strong>pen<strong>de</strong> <strong>de</strong> la posición relativa <strong>de</strong> los DMEs y<br />

el receptor, la norma editada por EUROCONTROL consi<strong>de</strong>ra<br />

el peor caso posible y evita complicar las fórmulas con la<br />

geometría <strong>de</strong>l problema.<br />

Según la norma, hay que calcular:<br />

d = 1,23 × √ Alt × 0,0125 + 0,25nm, con Alt en pies.<br />

Se toma ST = 0,25nm, y el valor <strong>de</strong> FTT será:<br />

En ruta: FTT = 2nm<br />

Acercamiento inicial e intermedio: FTT = 1nm.<br />

Despegue, acercamiento final FTT = 0,5nm.<br />

Si sólo hay 2 DMEs multiplicar d por 1,29.<br />

Los errores serán:<br />

XTT = d 2 + FTT 2 + ST 2 , ATT = d 2 + ST 2<br />

EUROCONTROL<br />

11<br />

11 / 48<br />

12 / 48


Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Diseño <strong>de</strong> un procedimiento III<br />

Fundamentos básicos<br />

Navegación DME-DME y el diseño <strong>de</strong> aerovías<br />

12,000 2.70 2.51 5.05<br />

Aparte se aña<strong>de</strong>n pequeños ”buffers”para aumentar la<br />

11,000 2.61 2.42 4.92<br />

seguridad <strong>de</strong> los procedimientos.<br />

Usando los valores <strong>de</strong> XTT y ATT se pue<strong>de</strong>n diseñar<br />

RNAV in Europe - Procedure Design Master Class<br />

EUROCONTROL<br />

procedimientos DESIGN OF PROTECTION RNAV.<br />

AREAS<br />

IAWP<br />

SECONDARY AREA<br />

PRIMARY AREA<br />

Eliane Belin<br />

IWP<br />

19<br />

Guidance Material for the Design of Terminal Procedures for DME/DME and GNSS Area Navigation<br />

2.3.4 The procedure <strong>de</strong>signer should choose the table based upon the worst case<br />

navaid availability for the waypoint in question. In other words, how many DME<br />

stations are within range and available for use at the lowest usable level at the<br />

waypoint. The XTT, ATT and !AW values at that level, for the appropriate<br />

phase of flight, should then be used for all containment area calculations<br />

associated with that waypoint. The en-route values are provi<strong>de</strong>d for use on<br />

arrival legs that are more than 25 NM from the IAWP.<br />

Altitu<strong>de</strong> En-route IAWP/IWP FAWP/MAWP/DWP<br />

(ft)<br />

XTT<br />

(NM)<br />

ATT<br />

(NM)<br />

!AW<br />

(NM)<br />

XTT<br />

(NM)<br />

ATT<br />

(NM)<br />

!AW<br />

(NM)<br />

15,000 For all altitu<strong>de</strong>s 2.94 2.76 5.41<br />

14,000 4.08 3.56 8.10 2.86 2.68 5.29<br />

13,000 2.78 2.60 5.17<br />

XTT<br />

(NM)<br />

ATT<br />

(NM)<br />

!AW<br />

(NM)<br />

10,000 2.53 2.32 4.79 2.37 2.32 4.06<br />

9,000 2.43 2.22 4.65 2.27 2.22 3.91<br />

8,000 2.34 2.11 4.50 2.17 2.11 3.75<br />

7,000 2.23 2.00 4.35 2.06 2.00 3.59<br />

6,000 2.13 1.88 4.19 1.94 1.88 3.41<br />

5,000 2.01 1.74 4.01 1.81 1.74 3.22<br />

4,000 1.88 1.60 3.83 1.67 1.60 3.01<br />

3,000 1.75 1.43 3.62 1.52 1.43 2.77<br />

2,000 1.59 1.24 3.38 1.33 1.24 2.50<br />

1,000 1.40 0.98 3.10 1.10 0.98 2.15<br />

500 0.95 0.81 1.92<br />

Table 2 - XTT, ATT and Semi-width Values (in NM) for DME/DME RNAV (Only 2 DMEs available)<br />

Altitu<strong>de</strong> En-route IAWP/IWP FAWP/MAWP/DWP<br />

(ft)<br />

XTT<br />

(NM)<br />

ATT<br />

(NM)<br />

!AW<br />

(NM)<br />

XTT<br />

(NM)<br />

ATT<br />

(NM)<br />

!AW<br />

(NM)<br />

XTT<br />

(NM)<br />

ATT<br />

(NM)<br />

!AW<br />

(NM)<br />

15,000 For all altitu<strong>de</strong>s 2.37 2.15 4.55<br />

14,000 3.40 2.67 7.10 2.31 2.08 4.47<br />

13,000 2.25 2.02 4.38<br />

12,000 2.19 1.95 4.29<br />

11,000 2.13 1.88 4.19<br />

10,000 2.06 1.80 4.10 1.87 1.80 3.31<br />

9,000 2.00 1.73 3.99 1.80 1.73 3.20<br />

8,000 1.92 1.64 3.89 1.72 1.64 3.08<br />

7,000 1.85 1.56 3.78 1.63 1.56 2.95<br />

6,000 1.77 1.46 3.66 1.55 1.46 2.82<br />

5,000 1.69 1.36 3.53 1.45 1.36 2.67<br />

4,000 1.60 1.25 3.40 1.34 1.25 2.52<br />

3,000 1.50 1.12 3.25 1.23 1.12 2.34<br />

2,000 1.39 0.97 3.09 1.09 0.97 2.14<br />

1,000 1.27 0.78 2.90 0.92 0.78 1.89<br />

500 0.82 0.64 1.72<br />

Table 3 - XTT, ATT and Semi-width Values (in NM) for DME/DME RNAV (More than 2 DMEs available)<br />

Los cálculos anteriores se pue<strong>de</strong>n encontrar tabulados.<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Edition : 2.2 Released Issue Page 8<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

<strong>Sistemas</strong> <strong>de</strong> posicionamiento satelitales: TRANSIT<br />

13 / 48<br />

En 1957, cuando se lanzó el Sputnik, se observó que<br />

empleando el efecto Doppler a sus señales <strong>de</strong> radio se<br />

podía estimar su velocidad relativa al observador.<br />

A partir <strong>de</strong> la velocidad relativa se podía encontrar la<br />

posición relativa, y suponiendo que el observador<br />

conociera su posición perfectamente, por tanto se<br />

encontraba la posición <strong>de</strong>l Sputnik.<br />

Se plantea la i<strong>de</strong>a <strong>de</strong> invertir este cálculo: conocida la<br />

posición <strong>de</strong>l satélite, y utilizando señales <strong>de</strong> radio,<br />

<strong>de</strong>terminar la posición <strong>de</strong>l observador.<br />

Un primer sistema satelital es el sistema TRANSIT:<br />

5 satélites en órbita polar baja y 5 repuestos.<br />

Empleaba el efecto Doppler para obtener medidas 2-D<br />

<strong>de</strong> la posición, con precisión <strong>de</strong> 200–400 m.<br />

En servicio <strong>de</strong>s<strong>de</strong> 1965 hasta 1991.<br />

Actualización <strong>de</strong> posición cada 30 minutos<br />

(φ = 80 o )–110 minutos (φ = 0 0 ).<br />

14 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

<strong>Sistemas</strong> <strong>de</strong> posicionamiento satelitales: GPS<br />

En los años 60 agencias <strong>de</strong> EE.UU. (NASA,<br />

DoD...) se interesan por <strong>de</strong>sarrollar un sistema:<br />

Global.<br />

3-D.<br />

De gran precisión.<br />

Con operación continua.<br />

Útil en plataformas <strong>de</strong> dinámica rápida.<br />

En los años 70 nace el sistema GPS (Global Positioning<br />

System) que satisface los criterios <strong>de</strong>mandados y es pasivo:<br />

permite infinitos usuarios.<br />

El sistema en su concepción es <strong>de</strong> naturaleza militar.<br />

1978: Se lanza el primer satélite.<br />

Años 80: el sistema es operacional.<br />

Años 90: mo<strong>de</strong>rnización <strong>de</strong>l sistema. El uso civil supera<br />

ampliamente al militar.<br />

2000: Se <strong>de</strong>sconecta la S.A. (Selective Availability).<br />

Otros sistemas: Glonass (Rusia), Beidou y Compass(China),<br />

Galileo (UE, 2010?).<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmento espacial<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Constelación <strong>de</strong> 24 satélites (nominal)<br />

distribuidos en 6 planos orbitales, con 4<br />

satélites por plano. Órbitas circulares.<br />

15 / 48<br />

La constelación se ubica en órbita media,<br />

con una altitud aproximada <strong>de</strong> 20200<br />

kilómetros sobre la Tierra.<br />

Satélites NAVSTAR, fabricados por Rockwell<br />

International. Pesan 860 kg.<br />

Cada satélite lleva a bordo un reloj atómico<br />

sincronizado con el tiempo GPS.<br />

Cada satélite emite continuamente un mensaje en dos<br />

frecuencias: L1(1575.42 Mhz), L2(1227.6MHz).<br />

El mensaje tiene 2 partes: C/A co<strong>de</strong> (coarse/adquisition) y P<br />

co<strong>de</strong> (precision). Contienen una secuencia que permite estimar<br />

el tiempo <strong>de</strong> recepción e información sobre la localización <strong>de</strong>l<br />

16 / 48<br />

satélite (efeméri<strong>de</strong>s).


Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmento <strong>de</strong> control<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmento <strong>de</strong> usuario<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Segmento <strong>de</strong> control: red que monitoriza el<br />

estado <strong>de</strong> los satélites.<br />

Actualiza con observaciones la posición real<br />

<strong>de</strong> los satélites (efeméri<strong>de</strong>s).<br />

Sincroniza los relojes atómicos.<br />

Controlado por el ejército. La estación <strong>de</strong><br />

control maestra está en Colorado (Schriever<br />

AFB).<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Dispositivo que emplea un usuario <strong>de</strong> GPS para obtener su<br />

posición a partir <strong>de</strong> las señales recibidas. Para ello<br />

implementa un algoritmo <strong>de</strong> estimación <strong>de</strong> posición.<br />

Requiere: receptor <strong>de</strong> radio, reloj <strong>de</strong> cuarzo.<br />

17 / 48<br />

Contiene un propagador <strong>de</strong> órbitas: calcula la posición <strong>de</strong> los<br />

satélites a partir <strong>de</strong> las efeméri<strong>de</strong>s.<br />

El GPS fue concebido con uso dual, civil o militar.<br />

La señal militar está encriptada, y permite mayor precisión<br />

(PPS=Precise Positioning System). La señal civil tenía ruido<br />

añadido para hacerla menos precisa (SPS=Standard<br />

Positioning System). Ésta adición <strong>de</strong> ruido se <strong>de</strong>nominaba<br />

S.A.=Selective Availability, pero se <strong>de</strong>sactivó en 2000,<br />

incrementando la precisión SPS.<br />

Las precisiones mínimas SPS son <strong>de</strong>l or<strong>de</strong>n <strong>de</strong> 13m. 2drms<br />

horizontal, 22m 2-σ vertical, 0.2m/s 2-σ en velocidad y 40ns<br />

2-σ en tiempo.<br />

18 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Observables. Pseudodistancia.<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Las medidas <strong>de</strong>l receptor GPS se <strong>de</strong>nominan observables.<br />

A partir <strong>de</strong> las señales enviadas por un satélite, es posible<br />

<strong>de</strong>terminar el tiempo t0 en el que se enviaron. Comparando<br />

con el tiempo t1 <strong>de</strong> recepción, el primer observable que se<br />

obtiene es la diferencia <strong>de</strong> tiempos ∆t = t1 − t0.<br />

Llamando r a la distancia receptor-satélite, r = r = c∆t,<br />

don<strong>de</strong> c es la velocidad <strong>de</strong> la luz. Definamos ρ = c∆t.<br />

Si el reloj <strong>de</strong>l receptor (un reloj <strong>de</strong> cuarzo) estuviera<br />

sincronizado perfectamente con el tiempo GPS (dado por los<br />

relojes atómicos a bordo <strong>de</strong> los satélites), entonces ρ sería una<br />

medida exacta <strong>de</strong> la distancia.<br />

Pero un reloj <strong>de</strong> cuarzo tiene errores; treceptor = tGPS + tu,<br />

don<strong>de</strong> tu es el sesgo <strong>de</strong>l reloj. Errores muy pequeños<br />

correspon<strong>de</strong>n con gran<strong>de</strong>s distancias ya que c es muy elevado.<br />

Ya que ρ no es una medida exacta <strong>de</strong> la distancia se <strong>de</strong>nomina<br />

pseudodistancia.<br />

19 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Cálculo <strong>de</strong> la posición.<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Llamemos s a la posición <strong>de</strong>l satélite y u a la posición <strong>de</strong>l<br />

usuario. En aplicaciones GPS se suele trabajar en el sistema <strong>de</strong><br />

<strong>referencia</strong> ECI o a veces ECEF.<br />

Se tiene entonces que r = s − u. Luego r = ρ − ctu = s − u.<br />

En el mensaje <strong>de</strong> navegación está codificada la efeméri<strong>de</strong>s <strong>de</strong>l<br />

satélite con gran precisión, lo que permite calcular s con gran<br />

exactitud.<br />

Por tanto para cada satélite i que sea visible en un instante<br />

dado tendremos una ecuación <strong>de</strong>l tipo ρi − ctu = s i − u<br />

(una esfera).<br />

¿Cuántos satélites serán necesarios para hallar u?<br />

La intersección <strong>de</strong> dos esferas es una circunferencia.<br />

La intersección <strong>de</strong> tres esferas son dos puntos.<br />

A<strong>de</strong>más tu es <strong>de</strong>sconocido: son necesarios al menos cuatro<br />

satélites.<br />

20 / 48


Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Cálculo <strong>de</strong> la posición con cuatro satélites I<br />

Por tanto tenemos las siguientes ecuaciones:<br />

ρ1 − ctu = s 1 − u<br />

ρ2 − ctu = s 2 − u<br />

ρ3 − ctu = s 3 − u<br />

ρ4 − ctu = s 4 − u<br />

Es necesario un algoritmo para <strong>de</strong>terminar tu y u.<br />

Si <strong>de</strong>finimos u = [xu yu zu] T y s i = [xi yi zi] T , obsérvese que<br />

ρi = (xi − xu) 2 + (yi − yu) 2 + (zi − zu) 2 + ctu. Por tanto<br />

ρi = fi(xu, yu, zu, tu).<br />

Supongamos que conozco una estimación inicial <strong>de</strong> u y tu,<br />

dada por û = [ˆxu ˆyu ˆzu] T y ˆtu. Definamos<br />

δu = u − û = [δxu δyu δzu] T , δtu = tu − ˆtu y<br />

ˆρi = s i − û + cˆtu.<br />

Linealicemos ahora fi en torno a la estimación inicial.<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Cálculo <strong>de</strong> la posición con cuatro satélites II<br />

Se tendrá que:<br />

ρ i = f i (xu, yu, zu, tu) = f i (δxu + ˆxu, δyu + ˆyu, δzu + ˆzu, δtu + ˆtu)<br />

= f i (ˆxu, ˆyu, ˆzu, ˆtu) + ∂f i (ˆxu, ˆyu, ˆzu, ˆtu)<br />

Se tiene que:<br />

+ ∂fi (ˆxu, ˆyu, ˆzu, ˆtu)<br />

δtu<br />

∂ˆtu<br />

∂fi<br />

∂ˆxu<br />

∂ˆxu<br />

δxu + ∂f i (ˆxu, ˆyu, ˆzu, ˆtu)<br />

∂ˆyu<br />

δyu + ∂fi (ˆxu, ˆyu, ˆzu, ˆtu)<br />

δzu<br />

∂ˆzu<br />

(xi − ˆxu)<br />

= −<br />

(xi − ˆxu) 2 + (yi − ˆyu) 2 + (zi − ˆzu) 2<br />

Puesto que todo es conocido en la expresión <strong>de</strong> arriba,<br />

(xi −ˆxu)<br />

<strong>de</strong>finimos axi<br />

= − ∂fi<br />

∂ˆxu =<br />

Similarmente se <strong>de</strong>fine ayi<br />

Finalmente se tiene que ∂fi = c.<br />

∂ˆtu<br />

Por tanto la linealización queda:<br />

√<br />

(xi −ˆxu) 2 +(yi −ˆyu) 2 .<br />

+(zi −ˆzu) 2<br />

= − ∂fi<br />

∂ˆyu<br />

ρi = ˆρi − axi δxu − ayi δyu − azi δzu + cδtu<br />

y azi = − ∂fi<br />

∂ˆzu .<br />

21 / 48<br />

22 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Cálculo <strong>de</strong> la posición con cuatro satélites III<br />

Definamos ∆ρ = ˆρi − ρi = axi δxu + ayi δyu + azi δzu − cδtu.<br />

Si <strong>de</strong>finimos:<br />

2<br />

6<br />

∆x = 6<br />

4<br />

δxu<br />

δyu<br />

δzu<br />

−cδtu<br />

3<br />

2<br />

7 6<br />

7<br />

5 , ∆ρ = 6<br />

4<br />

ˆρ1 − ρ1<br />

ˆρ2 − ρ2<br />

ˆρ3 − ρ3<br />

ˆρ4 − ρ4<br />

3 2<br />

ax1 7 6 ax 7<br />

5 , H = 6 2<br />

4 ax3 ax4 ay1 ay2 ay3 ay4 az1 az2 az3 az4 3<br />

1<br />

1 7<br />

1 5<br />

1<br />

Se tiene que ∆ρ = H∆x.<br />

Por tanto para <strong>de</strong>terminar ∆x simplemente ∆x = H −1 ∆ρ y<br />

se obtienen los errores respecto a la estimación inicial.<br />

Algoritmo iterativo: dada una estimación inicial û 0 , ˆt 0 u y las<br />

medidas ρi:<br />

1 Formar ˆρ 0 i , ∆ρ0 y H 0 .<br />

2 Encontrar ∆x 0 = (H 0 ) −1 ∆ρ 0 .<br />

3 Mejorar la estimación inicial usando ∆x 0 , obteniendo û 1 , ˆt 1 u.<br />

4 Formar ˆρ 1 i , ∆ρ1 y H 1 .<br />

5 Encontrar ∆x 1 = (H 1 ) −1 ∆ρ 1 .<br />

6 Iterar hasta que ∆x n ≤ ɛ, una tolerancia pre<strong>de</strong>finida.<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Algoritmo <strong>de</strong> mínimos cuadrados I<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

23 / 48<br />

El algoritmo anterior no es válido si se tienen más <strong>de</strong> cuatro<br />

satélites, porque H no sería cuadrada. En general para n<br />

satélites δρ es n × 1 y H es n × 4, mientras que δx es 4 × 1.<br />

Si las medidas contienen error, se podría usar un mo<strong>de</strong>lo <strong>de</strong>l<br />

tipo ∆ρ = H∆x + ν, don<strong>de</strong> ν ∼ Nn(0, Σ) es un mo<strong>de</strong>lo <strong>de</strong>l<br />

error.<br />

En ambos casos se resuelve el problema usando el algoritmo<br />

<strong>de</strong> mínimos cuadrados, que resuelve un problema <strong>de</strong>l tipo:<br />

y = Az + b, don<strong>de</strong>:<br />

y es <strong>de</strong> dimensión n y conocido (medidas).<br />

z es <strong>de</strong> dimensión m ≤ n y es <strong>de</strong>sconocido (datos a calcular).<br />

A es conocido (medidas).<br />

b son los errores (<strong>de</strong>sconocidos): b ∼ Nm(0, Σ)<br />

Se busca una solución ˆz <strong>de</strong> forma que Aˆz sea lo más parecido<br />

posible a y en el sentido <strong>de</strong> los mínimos cuadrados.<br />

Matemáticamente, se busca ˆz tal que la función <strong>de</strong> coste<br />

J = (y − Aˆz) T (y − Aˆz) sea mínimo. 24 / 48


Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Algoritmo <strong>de</strong> mínimos cuadrados II<br />

Se busca ∂J<br />

∂ˆz<br />

= 0.<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

En primer lugar: J = y T y − 2y T Aˆz + ˆz T A T Aˆz<br />

Tomando la <strong>de</strong>rivada: ∂J<br />

∂ˆz = −2y T A + 2ˆz T A T A<br />

Igualándola a 0:y T A = ˆz T A T A<br />

Despejando ˆz: ˆz T = y T A(A T A) −1 ⇒ ˆz = (A T A) −1 A T y.<br />

Obsérvese que (A T A) −1 A T es la pseudoinversa y existe<br />

siempre que A tenga al menos m filas (medidas)<br />

in<strong>de</strong>pendientes.<br />

Propieda<strong>de</strong>s estadísticas <strong>de</strong> la solución:<br />

E[ˆz] = E[(A T A) −1 A T y] = (A T A) −1 A T E[y] = (A T A) −1 A T E[Az + b] =<br />

(A T A) −1 A T AE[z] = E[z] = z.<br />

Cov[ˆz] = Cov[(A T A) −1 A T y] = (A T A) −1 A T Cov[y]A(A T A) −1 = (A T A) −1 A T Cov[Az +<br />

b]A(A T A) −1 = (A T A) −1 “<br />

T<br />

A ACov[z]A T ”<br />

+ Σ A(A T A) −1 = (A T A) −1 A T ΣA(A T A) −1<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Algoritmo <strong>de</strong> mínimos cuadrados pon<strong>de</strong>rados<br />

¿Existe alguna mejora posible <strong>de</strong>l algoritmo <strong>de</strong> mínimos<br />

cuadrados que disminuya la covarianza <strong>de</strong> la estimación?<br />

Se plantea pon<strong>de</strong>rar las medidas en la función <strong>de</strong> coste con<br />

una matriz <strong>de</strong> pesos W , <strong>de</strong> forma que se dé más peso a las<br />

medidas más precisas y menos a las menos precisas. Por<br />

tanto: J = (y − Aˆz) T W (y − Aˆz) don<strong>de</strong> W ha <strong>de</strong> ser una<br />

matriz simétrica <strong>de</strong>finida positiva.<br />

Procediendo como antes (se <strong>de</strong>ja como ejercicio) se llega a<br />

ˆz = (A T WA) −1 A T W y.<br />

Propieda<strong>de</strong>s estadísticas <strong>de</strong> la solución:<br />

E[ˆz] = z.<br />

Cov[ˆz] = (A T WA) −1 A T W ΣWA(A T WA) −1<br />

Para minimizar la covarianza, tomar W = Σ −1 ; es simétrica y<br />

<strong>de</strong>finida positiva. Llegamos a ˆz = (A T Σ −1 A) −1 A T Σ −1 y.<br />

La covarianza será:<br />

Cov[ˆz] = (A T Σ −1 A) −1 A T Σ −1 ΣΣ −1 A(A T Σ −1 A) −1 =<br />

(A T Σ −1 A) −1 A T Σ −1 A(A T Σ −1 A) −1 = (A T Σ −1 A) −1 .<br />

25 / 48<br />

26 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Errores en los observables<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Po<strong>de</strong>mos aplicar el algoritmo <strong>de</strong> los mínimos cuadrados<br />

pon<strong>de</strong>rados a nuestro caso <strong>de</strong> n medidas <strong>de</strong> pseudodistancia,<br />

con ∆ρ = H∆x + ν, don<strong>de</strong> ν ∼ Nn(0, Σ) mo<strong>de</strong>la los errores<br />

en la pseudodistancia.<br />

⎡<br />

⎤<br />

⎢<br />

Es razonable suponer Σ = ⎢<br />

⎣<br />

σ 2 1<br />

σ 2 2<br />

. ..<br />

σ 2 n<br />

⎥<br />

⎦ , don<strong>de</strong> σi es<br />

la varianza <strong>de</strong>l error <strong>de</strong> cada pseudodistancia.<br />

En primera aproximación se toma σ2 i = σ2 UERE , don<strong>de</strong><br />

UERE=User Equivalent Range Error, una estimación cuyo<br />

valor típico es σUERE ∼ 7 − 1,5m (PPS-SPS), y proviene <strong>de</strong><br />

las siguientes fuentes <strong>de</strong> error (sumadas con RSS):<br />

Segmento espacial: error reloj (1.1 m), cálculo órbita (0.8 m).<br />

Segmento usuario: Efectos atmosféricos, ruido <strong>de</strong>l receptor y<br />

resolución, efectos multicamino: 7-1.4 m. (PPS-SPS)<br />

Factores DOP I<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Por tanto en primera aproximación Σ = σ 2 UERE Idn y no es<br />

necesario usar mínimos cuadrados pon<strong>de</strong>rados. La covarianza<br />

<strong>de</strong>l resultado será: Cov[∆ˆx] =<br />

(H T H) −1 H T σ 2 UERE IdnH(H T H) −1 = σ 2 UERE (HT H) −1 .<br />

Definimos G = (H T H) −1 , llegamos a Cov[∆ˆx] = σ 2 UERE G.<br />

El significado físico <strong>de</strong> Cov[∆ˆx] viene dado por<br />

2<br />

Var[δx<br />

6<br />

Cov[∆ˆx] = 6<br />

4<br />

2 u ] Cov[δxuδyu] Cov[δxuδzu] Cov[δxuδtu]<br />

Cov[δxuδyu] Var[δyu] Cov[δyuδzu] Cov[δyuδtu]<br />

Cov[δxuδzu] Cov[δzuδyu] Var[δz 2 u ] Cov[δzuδtu]<br />

Cov[δxuδtu] Cov[δtuδyu] Cov[δtuδzu] Var[δt 2 u ]<br />

3 2<br />

G11<br />

7 6<br />

7<br />

5 = σ2 6<br />

UERE 4<br />

Los valores interesantes son los <strong>de</strong> la diagonal: nos dicen la<br />

varianza en las diferences direcciones y el tiempo.<br />

Éstas varianzas son el producto <strong>de</strong> dos factores: σ2 UERE , que<br />

<strong>de</strong>pen<strong>de</strong> <strong>de</strong> la señal, y G, que <strong>de</strong>pen<strong>de</strong> sólo <strong>de</strong> H, que a su vez<br />

sólo ✞ <strong>de</strong>pen<strong>de</strong> <strong>de</strong> las <strong>de</strong>rivadas <strong>de</strong> fi: es <strong>de</strong>cir <strong>de</strong> la geometría. ☎<br />

ERROR GPS=(FACTOR GEOMETRICO)× (ERROR SEÑAL)<br />

✝<br />

✆<br />

G22<br />

G33<br />

27 / 48<br />

G44<br />

3<br />

7<br />

5<br />

28 / 48


Factores DOP II<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Éstos valores en la diagonal <strong>de</strong> G se combinan para formar los<br />

llamados factores DOP, que nos dicen cuánto afecta la<br />

geometría a la solución <strong>de</strong>l error. Los valores típicamente<br />

usados son:<br />

GDOP-Geometric Dilution of Precision.<br />

GDOP = √ G11 + G22 + G33 + G44.<br />

PDOP-Position Dilution of Precision.<br />

PDOP = √ G11 + G22 + G33.<br />

TDOP-Time Dilution of Precision. TDOP = √ G44.<br />

HDOP-Horizontal Dilution of Precision. GDOP = √ G11 + G22.<br />

VDOP-Vertical Dilution of Precision. VDOP = √ G33.<br />

Usando los factores DOP po<strong>de</strong>mos hallar rápidamente una<br />

estimación <strong>de</strong> la precisión <strong>de</strong> nuestro GPS:<br />

Factores DOP III<br />

σz = VDOP × σUERE<br />

σt = TDOP × σUERE<br />

Precisión horizontal 2 − DRMS = 2HDOP × σUERE<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

La elevación/azimut óptimo <strong>de</strong> los satélites es:<br />

29 / 48<br />

¿Cómo influye la geometría en G?<br />

Intuitivamente, parece bastante claro<br />

que si las medidas se obtienen <strong>de</strong><br />

satélites muy próximos, los resultados<br />

no serán buenos.<br />

Estudiamos para el caso <strong>de</strong> 4 satélites<br />

la configuración que minimiza el<br />

GDOP, con los satélites visibles en el<br />

horizonte (elevación mínima 5 grados).<br />

Satélite 1 2 3 4<br />

h 5 o 5 o 5 o 90 o<br />

Az 0 o 120 o 240 o 0 o<br />

Nota: Al azimut <strong>de</strong> 1-3 se le pue<strong>de</strong> añadir cualquier valor<br />

constante, siempre que se añada a todos. 30 / 48<br />

Factores DOP IV<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Dicha configuración óptima es un tetraedro, con el usuario<br />

situado aproximadamente en el centro <strong>de</strong> una <strong>de</strong> las caras, y<br />

el vértice opuesto a dicha cara justo sobre el usuario.<br />

Para esta configuración se tiene:<br />

2<br />

6<br />

H = 6<br />

4<br />

0 0,996 0,087 1<br />

0,863 −0,498 0,087 1<br />

−0,863 −0,498 0,087 1<br />

0 0 1 1<br />

3<br />

2<br />

7<br />

5 → G = (HT H) −1 6<br />

= 6<br />

4<br />

0,672 0 0 0<br />

0 0,672 0 0<br />

0 0 1,6 −0,505<br />

0 0 −0,505 0,409<br />

Los factores DOP son: GDOP = 1,83, PDOP = 1,72,<br />

TDOP = 0,64, HDOP = 1,16, VDOP = 1,26.<br />

Tomando σUERE = 7m (SPS):<br />

Error vertical: 17.64 metros 2-σ.<br />

Precisión horizontal 16.24 metros 2-DRMS.<br />

Precisión en tiempo 2-σ:2 × TDOP × σUERE /c = 30 ns<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Cálculo <strong>de</strong> la velocidad<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Una sistema <strong>de</strong> navegación enfocado a navegación aérea no<br />

sólo <strong>de</strong>be ser capaz <strong>de</strong> hallar la posición, sino también la<br />

velocidad (y la actitud).<br />

Un sistema GPS se pue<strong>de</strong> actualizar aproximadamente <strong>de</strong>s<strong>de</strong> 1<br />

(receptores básicos baratos) hasta unas 20 veces por segundo<br />

(receptores con gran capacidad <strong>de</strong> cálculo, muy caros). Como<br />

primera i<strong>de</strong>a para calcular v podríamos usar simplemente la<br />

posición en dos medidas consecutivas: v = u(t+∆t)−u(t)<br />

∆t .<br />

No obstante si v es elevado (lo que siempre suce<strong>de</strong> en<br />

aeronaves), incluso para un alto ancho <strong>de</strong> banda, la anterior<br />

fórmula es poco precisa e introduce errores.<br />

Los receptores GPS mo<strong>de</strong>rnos encuentran la velocidad<br />

mediante otro observable: la frecuencia <strong>de</strong> la portadora. Ésta<br />

frecuencia se modifica por el efecto Doppler, <strong>de</strong>bido a que<br />

entre el usuario y el satélite existe una velocidad relativa.<br />

3<br />

7<br />

5<br />

31 / 48<br />

32 / 48


Efecto Doppler<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Ecuación <strong>de</strong>l efecto Doppler: fR = fT<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

<br />

1 − v r · a<br />

c<br />

fR es la frecuencia recibida.<br />

fT es la frecuencia transmitida (conocida).<br />

<br />

, don<strong>de</strong>:<br />

v r = ˙s − ˙u es la velocidad relativa satélite-usuario.<br />

a = s−u<br />

s−u es el vector unitario en la dirección satélite-usuario.<br />

Si ya hemos obtenido la posición siguiendo los métodos<br />

anteriormente <strong>de</strong>scritos se pue<strong>de</strong> consi<strong>de</strong>rar a conocido.<br />

Por tanto la diferencia <strong>de</strong> fase ∆f vendrá dada por:<br />

v r · a<br />

∆f = fT − fR = −fT .<br />

c<br />

Por otro lado el observable no es directamente ∆f , porque el<br />

reloj <strong>de</strong>l segmento <strong>de</strong> usuario no tiene la suficiente precisión e<br />

introduce errores <strong>de</strong> medida <strong>de</strong> frecuencia <strong>de</strong> la siguiente<br />

forma: fM = fR − fM ˙ tu, don<strong>de</strong> fM es la frecuencia medida.<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Deriva <strong>de</strong>l reloj <strong>de</strong> usuario<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Para enten<strong>de</strong>r la ecuación fM = fR − fM ˙<br />

tu, imaginemos que el<br />

usuario mi<strong>de</strong> una señal dada por y = sin(a · τ), don<strong>de</strong> τ es el<br />

tiempo <strong>de</strong>l receptor.<br />

El receptor <strong>de</strong>l usuario <strong>de</strong>duce que tiene una señal <strong>de</strong> a<br />

Hercios. Por tanto fM = a.<br />

Pero si τ = t, don<strong>de</strong> t es el tiempo GPS, se introduce un<br />

error. Este error es τ = t + tu, don<strong>de</strong> tu es la <strong>de</strong>riva <strong>de</strong>l reloj<br />

<strong>de</strong>l usuario. Imaginemos que tu c1 + c2t. Luego ˙<br />

tu = c2.<br />

Entonces realmente y = sin(at + ac1 + ac2t), lo que es una<br />

señal <strong>de</strong> a + ac2 Hercios (ac1 es un <strong>de</strong>sfase y no influye en la<br />

frecuencia <strong>de</strong> la señal). Luego fR es igual a a + ac2.<br />

En efecto, se verifica: a = a + ac2 − ac2.<br />

33 / 48<br />

Aunque ˙<br />

tu pue<strong>de</strong> ser muy pequeño, tiene un efecto muy<br />

significativo en el resultado real, ya que estará multiplicado<br />

por c. Por tanto una <strong>de</strong>riva <strong>de</strong> 1 microsegundo por segundo<br />

(10 −6 ) daría errores <strong>de</strong>l or<strong>de</strong>n <strong>de</strong> 300 m/s! 34 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Algoritmo <strong>de</strong> cálculo <strong>de</strong> velocidad I<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Por tanto tenemos las dos ecuaciones: fT − fR = −fT<br />

fM = fR − fM ˙<br />

tu.<br />

Eliminando fR, se llega a:<br />

c fT − fM<br />

fT<br />

= −v r · a − c fM<br />

Puesto que v r = ˙s − ˙u, escribimos:<br />

c fT − fM<br />

fT<br />

Llamemos d = c fT −fM<br />

fT<br />

˙<br />

tu<br />

fT<br />

+ ˙s · a = ˙u · a − c fM<br />

˙<br />

tu<br />

fT<br />

+ ˙s · a; es un vector conocido en<br />

v r · a<br />

c<br />

función <strong>de</strong> los datos, la medida <strong>de</strong> fase <strong>de</strong> la portadora, el<br />

cálculo orbital, y la estimación anterior <strong>de</strong> la posición.<br />

Para cada satélite (un mínimo como ya vimos <strong>de</strong> 4) se<br />

tendrá una ecuación: d i = ˙u · ai − c fM i<br />

tu ˙<br />

fT i<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Algoritmo <strong>de</strong> cálculo <strong>de</strong> velocidad II<br />

GPS: segmentos<br />

Cálculo <strong>de</strong> posición. Errores.<br />

Cálculo <strong>de</strong> velocidad.<br />

Obsérvese que las componentes <strong>de</strong> ai a partir <strong>de</strong> una posición<br />

anteriormente estimada û son:<br />

axi =<br />

(xi −ˆxu)<br />

ayi =<br />

azi =<br />

√<br />

(xi −ˆxu) 2 +(yi −ˆyu) 2 ,<br />

+(zi −ˆzu) 2<br />

(yi −ˆyu)<br />

√<br />

(xi −ˆxu) 2 +(yi −ˆyu) 2 ,<br />

+(zi −ˆzu) 2<br />

(zi −ˆzu)<br />

√<br />

(xi −ˆxu) 2 +(yi −ˆyu) 2 .<br />

+(zi −ˆzu) 2<br />

Estos valores ya se habían calculado anteriormente en la<br />

estimación <strong>de</strong> posición! Luego son conocidos. Llegamos a:<br />

d i = axi ˙ux + ayi ˙uy + azi ˙uz − c fM i<br />

tu ˙<br />

fT i<br />

Aproximamos fM i 1. Por tanto llegamos a la ecuación<br />

fT i<br />

d = Hg, don<strong>de</strong> H es la matriz que se usó para estimar la<br />

posición, d es un vector con las medidas y datos, y<br />

g = [ ˙ux ˙uy ˙uz − c ˙tu] T que hay que calcular.<br />

Resolvemos el problema por mínimos cuadrados como antes.<br />

y<br />

35 / 48<br />

36 / 48


Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Disponibilidad, integridad, continuidad<br />

<strong>Sistemas</strong> <strong>de</strong> aumento: GPS diferencial<br />

Cálculo <strong>de</strong> la actitud<br />

Disponibilidad, integridad y continuidad.<br />

Disponibilidad I<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

En la tabla se resumen la mayor<br />

parte <strong>de</strong> los sistemas <strong>de</strong><br />

navegación en uso.<br />

Como se pue<strong>de</strong> ver, el GPS es el<br />

que consigue mayor precisión.<br />

No obstante, la precisión no es<br />

el único parámetro por el que se<br />

<strong>de</strong>be elegir un sistema <strong>de</strong><br />

navegación.<br />

Otros conceptos <strong>de</strong> gran<br />

importancia son integridad,<br />

continuidad y disponibilidad.<br />

Disponibilidad, integridad, continuidad<br />

<strong>Sistemas</strong> <strong>de</strong> aumento: GPS diferencial<br />

Cálculo <strong>de</strong> la actitud<br />

Se <strong>de</strong>fine disponibilidad (availability) <strong>de</strong> un sistema <strong>de</strong><br />

navegación como el porcentaje <strong>de</strong>l tiempo que dicho sistema<br />

es “utilizable”, <strong>de</strong>ntro <strong>de</strong> su área especificada <strong>de</strong> cobertura.<br />

Utilizable se refiere a que el sistema cumple unos requisitos<br />

mínimos (p.ej. en precisión) previamente especificados. Una<br />

<strong>de</strong>finición típica <strong>de</strong> utilizable es que el usuario obtenga un<br />

PDOP ≤ 6.<br />

En el caso <strong>de</strong>l GPS, el área <strong>de</strong> cobertura es toda la superficie<br />

<strong>de</strong> la Tierra, pero también hay que consi<strong>de</strong>rar el llamado<br />

“ángulo <strong>de</strong> máscara”: el ángulo <strong>de</strong> elevación en el horizonte a<br />

partir <strong>de</strong>l cual los satélites se consi<strong>de</strong>ran visibles para el<br />

receptor GPS.<br />

En un entorno urbano o con acci<strong>de</strong>ntes geográficos dicho<br />

ángulo tendrá que consi<strong>de</strong>rarse mayor que en un entorno sin<br />

acci<strong>de</strong>ntes (p.ej. el mar).<br />

37 / 48<br />

38 / 48<br />

Disponibilidad II<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

336 Performance of Stand-Alone GPS<br />

Availability (%)<br />

Availability (%)<br />

99.999<br />

99.99<br />

99.9<br />

99<br />

90<br />

70<br />

50<br />

30<br />

10<br />

1<br />

7.5 Deg. mask angle<br />

5.0 Deg. mask angle<br />

2.5 Deg. mask angle<br />

0.0 Deg. mask angle<br />

0.1<br />

0 1 2 3 4 5 6 7 8 9 10<br />

HDOP<br />

Figure 7.8 Cumulative distribution of HDOP with 7.5º, 5º, 2.5º, and 0º mask angles.<br />

Disponibilidad, 10 integridad, continuidad<br />

<strong>Sistemas</strong> <strong>de</strong> aumento: GPS diferencial<br />

1 Cálculo <strong>de</strong> la actitud<br />

99.999<br />

99.99<br />

The threshold for the maximum acceptable DOP value is <strong>de</strong>pen<strong>de</strong>nt on the<br />

<strong>de</strong>sired accuracy level. The availability of GPS, therefore, will <strong>de</strong>pend on the strin-<br />

Los 99.9 datos mostrados son para la constelación nominal y para<br />

gency of the accuracy requirement. For this analysis, availability of GPS is chosen to<br />

99<br />

be <strong>de</strong>fined as PDOP ≤ 6, which is commonly used as a service availability threshold<br />

distintos ángulos <strong>de</strong> máscara. in the GPS performance standards [17].<br />

90<br />

Los 7.5 Deg. mask angle<br />

70 datos son a nivel global y en intervalos <strong>de</strong> 5 minutos.<br />

5.0 Deg. mask angle<br />

50<br />

2.5 Deg. mask angle<br />

30<br />

0.0 Deg. mask angle<br />

10<br />

es <strong>de</strong>l 100 %. Para 7.5 grados se encuentra una disponibilidad<br />

1<br />

0.1<br />

0 1 2 3 4 5 6 7 8 9 10<br />

PDOP<br />

Figure 7.9 disponibilidad Cumulative distribution of PDOP with 7.5º, con 5º, 2.5º, and dicho 0º mask angles. ángulo <strong>de</strong> máscara es <strong>de</strong> 10 minutos,<br />

y suce<strong>de</strong>n para latitu<strong>de</strong>s extremas (mayores <strong>de</strong> ±60 The threshold for the maximum acceptable DOP value is <strong>de</strong>pen<strong>de</strong>nt on the<br />

<strong>de</strong>sired accuracy level. The availability of GPS, therefore, will <strong>de</strong>pend on the stringency<br />

of the accuracy requirement. For this analysis, availability of GPS is chosen to<br />

be <strong>de</strong>fined as PDOP ≤ 6, which is commonly used as a service availability threshold<br />

in the GPS performance standards [17].<br />

o ). 39 / 48<br />

Navegación por posicionamiento Disponibilidad, integridad, continuidad<br />

GNSS: Navegación por satélite <strong>Sistemas</strong> <strong>de</strong> aumento: GPS diferencial<br />

GPS: Otros conceptos Cálculo <strong>de</strong> la actitud<br />

Availability (%)<br />

Availability (%)<br />

90<br />

70<br />

50<br />

30<br />

99.999<br />

0.1<br />

0 1 2 3 4 5 6 7 8 9 10<br />

99.99<br />

99.9<br />

99<br />

90<br />

70<br />

50<br />

30<br />

10<br />

1<br />

HDOP<br />

7.5 Deg. mask angle<br />

5.0 Deg. mask angle<br />

2.5 Deg. mask angle<br />

0.0 Deg. mask angle<br />

0.1<br />

0 1 2 3 4 5 6 7 8 9 10<br />

PDOP<br />

7.5 Deg. mask angle<br />

5.0 Deg. mask angle<br />

2.5 Deg. mask angle<br />

0.0 Deg. mask angle<br />

Figure 7.8 Cumulative distribution of HDOP with 7.5º, 5º, 2.5º, and 0º mask angles.<br />

Figure 7.9 Cumulative distribution of PDOP with 7.5º, 5º, 2.5º, and 0º mask angles.<br />

Para ángulos <strong>de</strong> máscara <strong>de</strong> 0, 2.5 y 5 grados la disponibilidad<br />

<strong>de</strong>l 99.98 %. La duración máxima <strong>de</strong> los periodos <strong>de</strong> no<br />

Disponibilidad III<br />

7.4 GPS Availability 341<br />

7.4 GPS Availability 339<br />

Availability (%)<br />

99.999<br />

99.99<br />

99.9<br />

99<br />

90<br />

70<br />

50<br />

30<br />

10<br />

1<br />

24 Satellites<br />

23 Satellites<br />

22 Satellites<br />

21 Satellites<br />

0.1<br />

0 1 2 3 4 5 6 7 8 9 10<br />

PDOP<br />

Figure 7.12 Cumulative distribution of PDOP with 5º mask angle cases of 24, 23, 22, and 21<br />

satellites.<br />

−150 −120 −90 −60 −30 0 30 60 90 120 150<br />

• Date of prediction: The date for which the prediction is to be performed. The<br />

Sólo el 72 % <strong>de</strong>l tiempo la constelación GPS almanac can be used nominal<br />

to accurately predict for approximately 7 days in<br />

90<br />

90 the future.<br />

• Mask angle: The elevation angle above the horizon at which satellites are con-<br />

está 60 disponible (por errores o60 reparaciones).<br />

si<strong>de</strong>red visible by the GPS receiver.<br />

• Terrain mask: The azimuth and elevation of terrain (buildings, mountains,<br />

and so on) that may block the satellite signal can be entered into the program<br />

30<br />

30<br />

Típicamente fallan 1, 2 o 3 satélites; to ensure an accurate el prediction. 98 % <strong>de</strong>l tiempo<br />

0<br />

habrá al menos 21 satélites.<br />

0<br />

• Satellite outages: If any satellites are currently out of service, their status will<br />

be reflected in the almanac data. However, if satellites are scheduled for maintenance<br />

for a prediction date in the future, the software allows the user to<br />

mark those satellites unusable. This data can be obtained from the USCG<br />

−30<br />

−30 NAVCEN Web site.<br />

• Maximum DOP: As discussed previously, in or<strong>de</strong>r to <strong>de</strong>termine availability, a<br />

−60<br />

−60 maximum DOP threshold must be set (e.g., PDOP = 6). If the DOP exceeds<br />

that value, the software will <strong>de</strong>clare GPS to be unavailable. Other applications<br />

may use criteria other than DOP as the availability threshold. This will be dis-<br />

−90<br />

−90 cussed further in Section 7.3 for aviation applications.<br />

−150 −120 −90 −60 −30 0 30 60 90 120 150<br />

Once these parameters have been input into the software, the prediction can be<br />

son respectivamente 100 %, 99.969 performed. A prediction %, was 99.903 performed for Boston % (42.35ºN, y 71.08ºW) 99.197 on Decem- %.<br />

1- to 5-minute outages<br />

6- to 10-minute outages<br />

11- to 15-minute outages<br />

rences of these during the day. The majority of the outages are 10 minutes or less.<br />

This constellation provi<strong>de</strong>s an availability of 99.903%.<br />

90<br />

60<br />

30<br />

0<br />

−30<br />

−60<br />

−90<br />

−150 −120 −90 −60 −30 0 30 60 90 120 150<br />

−150 −120 −90 −60 −30 0 30 60 90 120 150<br />

1- to 5-minute outages<br />

6- to 10-minute outages<br />

11- to 20-minute outages<br />

21- to 30-minute outages<br />

90<br />

60<br />

30<br />

0<br />

−30<br />

−60<br />

−90<br />

31- to 40-minute outages<br />

41- to 65-minute outages<br />

Figure 7.15 Availability of the GPS constellation with a 5º mask angle with three satellites<br />

removed from the constellation.<br />

En la figura <strong>de</strong> la izquierda se muestra el PDOP para 24,23,22<br />

y 21 satélites con ángulo <strong>de</strong> máscara 5 %. Las disponibilida<strong>de</strong>s<br />

Las Figure 7.13 zonas Availability of the sin GPS constellation disponibilidad with a 5º mask angle with one satellite removed se muestran en la <strong>de</strong>recha para el<br />

from the constellation.<br />

caso <strong>de</strong> 21 satélites.<br />

40 / 48


Disponibilidad IV<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

344 Performance of Stand-Alone GPS<br />

SV<br />

1<br />

2<br />

4<br />

5<br />

6<br />

7<br />

9<br />

12<br />

14<br />

15<br />

16<br />

17<br />

18<br />

19<br />

20<br />

21<br />

22<br />

23<br />

24<br />

25<br />

26<br />

27<br />

28<br />

29<br />

31<br />

GPS<br />

available<br />

Satellite visibility and GPS availability forecast<br />

0 2 4 6 8 10 12 14 16 18 20 22 24<br />

Time of day (hours UTC)<br />

Figure 7.18 Satellite visibility/availability over a 24-hour period.<br />

GPS<br />

available<br />

0 2 4 6 8 10 12 14 16 18 20 22 24<br />

Time of day (hours UTC)<br />

Location<br />

12/23/94Z<br />

42.35N<br />

71.08W<br />

0.00km<br />

7 <strong>de</strong>g 3D<br />

PDOP 6.0<br />

No. visible<br />

Dilution of<br />

precision<br />

plied by the total system. Integrity inclu<strong>de</strong>s the ability of a system to provi<strong>de</strong> valid<br />

and timely warnings to the user, known as alerts, when the system must not be used<br />

for the inten<strong>de</strong>d operation.<br />

GPS<br />

GPS<br />

31 Disponibilidad, integridad, continuidad<br />

<strong>Sistemas</strong> GPS <strong>de</strong> aumento: GPS diferencial<br />

available<br />

Cálculo <strong>de</strong> la actitud<br />

Satellite visibility and GPS availability forecast<br />

plied by the total system. Integrity inclu<strong>de</strong>s the ability of a system to provi<strong>de</strong> valid<br />

Location<br />

SV<br />

and timely warnings to the user, known as alerts, when the system must not be used<br />

12/23/94Z<br />

1<br />

2 constelación nominal o quitando 42.35N for satélites, the inten<strong>de</strong>d operation. con distintos<br />

4<br />

71.08W<br />

5<br />

6<br />

0.00km<br />

7<br />

7 <strong>de</strong>g 3D<br />

9 ángulos <strong>de</strong> máscara, etc...<br />

12<br />

PDOP 6.0<br />

14<br />

15<br />

16<br />

No. visible<br />

17Por<br />

ejemplo la figura muestra un análisis local para Boston.<br />

18<br />

19<br />

20<br />

21<br />

22Con<br />

tres satélites menos hay dos cortes al día.<br />

23<br />

24<br />

25<br />

Dilution of<br />

26<br />

27Para<br />

realizar este tipo <strong>de</strong> análisis precision es útil software <strong>de</strong> análisis<br />

28<br />

29<br />

31<br />

Figure 7.19 Satellite visibility/availability over a 24-hour period with satellites 16, 25, and 26<br />

removed from the constellation.<br />

Continuidad<br />

19<br />

20<br />

21<br />

22<br />

23<br />

24<br />

25<br />

26<br />

27<br />

28<br />

29<br />

0 2 4 6 8 10 12 14 16 18 20 22 24<br />

Time of day (hours UTC)<br />

Figure 7.18 Satellite visibility/availability over a 24-hour period.<br />

SV<br />

1<br />

2<br />

4<br />

5<br />

6<br />

7<br />

9<br />

12<br />

14<br />

15<br />

16<br />

17<br />

18<br />

19<br />

20<br />

21<br />

22<br />

23<br />

24<br />

25<br />

26<br />

27<br />

28<br />

29<br />

31<br />

GPS<br />

available<br />

Satellite visibility and GPS availability forecast<br />

0 2 4 6 8 10 12 14 16 18 20 22 24<br />

Time of day (hours UTC)<br />

Dilution of<br />

precision<br />

GPS<br />

Location<br />

12/23/94Z<br />

42.35N<br />

71.08W<br />

0.00km<br />

7 <strong>de</strong>g 3D<br />

PDOP 6.0<br />

No. visible<br />

Dilution of<br />

precision<br />

Figure 7.19 Satellite visibility/availability over a 24-hour period with satellites 16, 25, and 26<br />

removed from the constellation.<br />

También se pue<strong>de</strong>n realizar análisis locales, con toda la<br />

orbital, como por ejemplo STK (que se usará en las prácticas). 41 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Disponibilidad, integridad, continuidad<br />

<strong>Sistemas</strong> <strong>de</strong> aumento: GPS diferencial<br />

Cálculo <strong>de</strong> la actitud<br />

Se <strong>de</strong>fine continuidad (continuity) <strong>de</strong> un sistema <strong>de</strong><br />

navegación respecto a una misión u operación, como la<br />

probabilidad <strong>de</strong> que dicho sistema sea “utilizable” <strong>de</strong> forma<br />

continua por toda la duración <strong>de</strong> dicha misión u operación.<br />

Utilizable se <strong>de</strong>fine respecto a los requisitos mínimos<br />

requeridos por la operación o misión, pue<strong>de</strong> venir dado en<br />

términos <strong>de</strong> PDOP u otros términos.<br />

La continuidad <strong>de</strong>pen<strong>de</strong> mucho <strong>de</strong> la misión u operación, pero<br />

en cualquier caso está claramente relacionada con fallos no<br />

planificados <strong>de</strong> satélites. La probabilidad estimada <strong>de</strong> que un<br />

satélite <strong>de</strong>je <strong>de</strong> emitir <strong>de</strong> forma no planificada, es <strong>de</strong>l<br />

0.0001 %.<br />

GPS<br />

42 / 48<br />

Integridad<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Disponibilidad, integridad, continuidad<br />

<strong>Sistemas</strong> <strong>de</strong> aumento: GPS diferencial<br />

Cálculo <strong>de</strong> la actitud<br />

Se <strong>de</strong>fine integridad (integrity) <strong>de</strong> un sistema <strong>de</strong> navegación<br />

como la capacidad <strong>de</strong> dicho sistema para advertir que el<br />

sistema no <strong>de</strong>be ser utilizado (<strong>de</strong>bido a que no está operativo<br />

o contiene errores). Por tanto da una medida <strong>de</strong> la confianza<br />

que se pue<strong>de</strong> tener en el sistema.<br />

El sistema GPS no proporciona, por sí mismo, ningún<br />

mecanismo <strong>de</strong> integridad. Pue<strong>de</strong>n suce<strong>de</strong>r errores críticos (a<br />

veces <strong>de</strong>nominados “aberraciones”) que <strong>de</strong>gra<strong>de</strong>n el sistema.<br />

Por ejemplo:<br />

Efectos <strong>de</strong> la radiación en el espacio: pue<strong>de</strong>n afectar a los<br />

relojes o a la electrónica <strong>de</strong> los satélites, provocando señales<br />

anómalas.<br />

Fallos en los satélites.<br />

Error humano, <strong>de</strong> software o <strong>de</strong> hardware en el segmento <strong>de</strong><br />

control.<br />

Son errores raros que ocurren pocas veces al año, pero no son<br />

admisibles para aplicaciones <strong>de</strong> navegación aérea. 43 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Técnicas <strong>de</strong> mejora <strong>de</strong> integridad<br />

Disponibilidad, integridad, continuidad<br />

<strong>Sistemas</strong> <strong>de</strong> aumento: GPS diferencial<br />

Cálculo <strong>de</strong> la actitud<br />

Puesto que la integridad es crítica para muchas aplicaciones,<br />

como por ejemplo aviación, se han implementando diversos<br />

mecanismos para proporcionar integridad al GPS.<br />

Las técnicas <strong>de</strong> GSP diferencial (que veremos a continuación)<br />

pue<strong>de</strong>n proporcionar integridad.<br />

Una técnica muy utilizada es la RAIM (Receiver Autonomous<br />

Integrity Monitoring):<br />

Es un algoritmo incorporado al receptor.<br />

Requiere al menos cinco satélites visibles: <strong>de</strong>tecta la<br />

inconsistencia <strong>de</strong> la solución y avisa que el GPS no <strong>de</strong>be ser<br />

utilizado.<br />

Para ello emplea técnicas estadísticas <strong>de</strong> estimación.<br />

Si tiene al menos seis satélites visibles, es capaz <strong>de</strong> ignorar el<br />

satélite y seguir proporcionando datos <strong>de</strong> navegación fiables.<br />

Obsérvese que puesto que RAIM requiere 5 o 6 satélites, la<br />

disponibilidad y continuidad con RAIM será menor en general. 44 / 48


GPS diferencial<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Disponibilidad, integridad, continuidad<br />

<strong>Sistemas</strong> <strong>de</strong> aumento: GPS diferencial<br />

Cálculo <strong>de</strong> la actitud<br />

Para mejorar la precisión <strong>de</strong>l GPS (o la integridad) se emplean<br />

las técnicas <strong>de</strong> GPS diferencial (DGPS).<br />

La i<strong>de</strong>a básica es usar una o más estaciones (pseudollites),<br />

cuya posición se conoce con gran precisión, equipadas con un<br />

receptor GPS y en comunicación con el usuario<br />

(GBAS=Ground-Based Augmentation Systems).<br />

También se pue<strong>de</strong>n emplear satélites extra que proporcionen<br />

medidas adicionales (SBAS=Space-Based Augmentation<br />

Systems). Por ejemplo, la red europea EGNOS.<br />

Los sistemas DGPS se clasifican como:<br />

Absolutos (ECEF) o relativos (posiciones relativas a la<br />

estación).<br />

Por zona geográfica <strong>de</strong> cobertura:<br />

Locales (10-100 km)<br />

Regionales (menos <strong>de</strong> 1000 km)<br />

Wi<strong>de</strong>-area (más <strong>de</strong> 1000 km)<br />

Basados en pseudodistancias o en fases (en fases son más<br />

8.2 Spatial and Time Correlation Characteristics of GPS Errors 381<br />

extremely important, since they directly influence the performance achievable for<br />

any type of DGPS system. The un<strong>de</strong>rlying algorithms and performance of co<strong>de</strong>- and<br />

carrier-based DGPS systems are presented in Sections 8.3 and 8.4, respectively.<br />

Some important DGPS message standards are introduced in Section 8.5. The final<br />

section, Section 8.6, <strong>de</strong>tails a number of operational and planned DGPS systems.<br />

8.2 Spatial and Time Correlation Characteristics of GPS Errors<br />

Many of the GPS error sources discussed in Chapter 7 are highly correlated over<br />

space and time. All DGPS systems exploit these correlations to improve overall system<br />

performance. For instance, in a simple local-area DGPS system with a single reference<br />

station (see Figure 8.1), the errors in the reference station’s pseudorange and<br />

carrier-phase measurements for visible satellites are expected to be very similar to<br />

those experienced by a nearby user. If the reference station estimates the errors by<br />

leveraging its known surveyed position and provi<strong>de</strong>s this information in the form of<br />

corrections to the user, it is expected that the user’s position accuracy will be<br />

precisos, pue<strong>de</strong>n conseguir precisión <strong>de</strong> mm.)<br />

improved as a result. This section quantifies the correlation of GPS errors between<br />

receivers separated over some distance (often referred to as the baseline, which may<br />

be interpreted as a vector) and over time. Time correlations (i.e., how rapidly the<br />

errors change with time), are also of interest, Navegación becausepor in general posicionamiento<br />

DGPS systems can- Disponibilidad, integridad, continuidad<br />

not instantaneously provi<strong>de</strong> data to the end GNSS: user—even Navegación with a high-speed por satélite radio link <strong>Sistemas</strong> <strong>de</strong> aumento: GPS diferencial<br />

there is some finite <strong>de</strong>lay associated with the generation, GPS: Otros transmission, conceptos reception, Cálculo <strong>de</strong> la actitud<br />

and application of the data.<br />

GPS diferencial: principios básicos <strong>de</strong> funcionamiento I<br />

8.2.1 Satellite Clock Errors<br />

Satellite clock errors are one of the simplest GPS errors to correct. This is because a<br />

satellite clock error causes the same effect on pseudorange and carrier-phase measurements,<br />

regardless of the location of the user. For instance, if the satellite clock<br />

User<br />

Figure 8.1 Local-area DGPS concept.<br />

Satellite<br />

Reference<br />

station<br />

45 / 48<br />

Ejemplifiquemos el funcionamiento <strong>de</strong>l<br />

DGPS con un caso simple: GBAS,<br />

absoluto, local, basado en distancias y<br />

con una sola estación.<br />

Recor<strong>de</strong>mos que el usuario <strong>de</strong>be<br />

encontrar su posición u resolviendo el<br />

sistema <strong>de</strong> 4 o más ecuaciones<br />

ρi − ctu = s i − u + νu, don<strong>de</strong> νu<br />

son los errores <strong>de</strong> las señales recibidas<br />

por el usuario.<br />

Supongamos ahora que se tiene una estación (pseudollite) <strong>de</strong><br />

posición m = [xm ym zm] T ; su distancia al satélite i es:<br />

R m i = s i − m = (xi − xm) 2 + (yi − ym) 2 + (zi − zm) 2 .<br />

Si tiene un error <strong>de</strong> reloj tm, las medidas <strong>de</strong> pseudodistancia<br />

en la estación serán: ρ m i − ctm = s i − m + νm<br />

46 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Disponibilidad, integridad, continuidad<br />

<strong>Sistemas</strong> <strong>de</strong> aumento: GPS diferencial<br />

Cálculo <strong>de</strong> la actitud<br />

GPS diferencial: principios básicos <strong>de</strong> funcionamiento II<br />

La posición <strong>de</strong> la estación es fija y conocida .<br />

Por tanto conocemos la cantidad<br />

∆ρm i = Rm i − ρm i = −ctm − νm.<br />

al receptor, y el receptor calcula<br />

La estación envía ∆ρ m i<br />

(ρi)corr = ρi + ∆ρ m i = s i − u + c(tu − tm) + (νu − νm).<br />

Si <strong>de</strong>finimos tum como el error <strong>de</strong>l reloj <strong>de</strong>l receptor respecto<br />

al reloj <strong>de</strong> la estación, tum = tu − tm observamos que<br />

(ρi)corr = s i − u + ctum + (νu − νm).<br />

Por otro lado, ν ′ = νu − νm ≪ νu, porque νu y νm serán muy<br />

parecidos. Luego hemos conseguido reducir mucho el error.<br />

El nuevo tiempo que calculemos será con respecto a la<br />

estación. Pero la estación pue<strong>de</strong> calcular su error respecto al<br />

satélite e incluirla en su mensaje <strong>de</strong> radio, <strong>de</strong> forma que<br />

tu = tum + tm. Luego recuperamos el tiempo GPS.<br />

Se consigue<br />

σUERE ≈ 0,3m + (1 − 6 cm) × (dEST −RECEP en km). 47 / 48<br />

Navegación por posicionamiento<br />

GNSS: Navegación por satélite<br />

GPS: Otros conceptos<br />

Cálculo <strong>de</strong> la actitud mediante GPS<br />

Disponibilidad, integridad, continuidad<br />

<strong>Sistemas</strong> <strong>de</strong> aumento: GPS diferencial<br />

Cálculo <strong>de</strong> la actitud<br />

Con DGPS <strong>de</strong> precisión (basado en fases) se obtiene la<br />

actitud. Se sitúan n antenas receptoras en puntos separados <strong>de</strong><br />

la aeronave y un único receptor. Se calculan las diferencias <strong>de</strong><br />

posición entre antenas, asumiendo que los errores se cancelan.<br />

A cada una <strong>de</strong> estas diferencias las llamamos r i. Por ejemplo<br />

si hay 3 antenas habrá 3 medidas. Si hay 4 antenas habrá 6<br />

medidas. En general serán n!/(2 × (n − 2)!) medidas.<br />

Evi<strong>de</strong>ntemente r b i es conocido. Lo que se mi<strong>de</strong> es r e i .<br />

Suponiendo la posición conocida, calculamos r n i = C n e r e i .<br />

Queremos calcular C b n <strong>de</strong> las ecuaciones r b i = C b n r n i .<br />

Formemos las matrices Rb = [r b 1r b 2 . . . r b n] y Rn = [r n 1r n 2 . . . r n n].<br />

Se tendrá que Rb = C b n Rn . Si las medidas fueran tres, se<br />

podría hacer C b n = Rb (Rn ) −1 , pero conviene mejor<br />

Rn = (C b n ) T Rb , luego C b n = (Rn (Rb ) −1 ) T . En general se<br />

usará una solución <strong>de</strong> mínimos cuadrados para más medidas.<br />

El mínimo <strong>de</strong> medidas necesarias son 3; por tanto el mínimo<br />

48 / 48<br />

<strong>de</strong> antenas necesario será <strong>de</strong> 3.


<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


<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 II<br />

Por tanto:<br />

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

δ ˙VD ≈ − 2g0<br />

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

Re<br />

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

INS-GPS<br />

t<br />

0<br />

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

y tomando <strong>de</strong>rivada en la primera ecuación y sustituyendo la<br />

segunda, obtenemos:<br />

δ¨ h = 2g0<br />

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

Re<br />

t<br />

0<br />

(δh − δhB)dτ − C1δ ˙ h.<br />

Tomando otra <strong>de</strong>rivada y reescribiendo la ecuación:<br />

δ ...<br />

h + C1δ¨h + (C2 − 2g0<br />

)δ ˙h + C3δh = C3δhB.<br />

Re<br />

Los autovalores <strong>de</strong> esta ecuación vienen dados por las raíces<br />

)s + C3.<br />

<strong>de</strong>l polinomio s 3 + C1s 2 + (C2 − 2g0<br />

Re<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 III<br />

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

INS-GPS<br />

Típicamente se eligen lo valores <strong>de</strong> C1, C2 y C3 para que los<br />

autovalores tengan parte real negativa (es <strong>de</strong>cir, la ecuación<br />

<strong>de</strong> δh sea estable). Una elección clásica es fijar un autovalor al<br />

valor −λ y los otros dos a los valores −λ + jλ y −λ − jλ.<br />

El polinomio característico sería entonces:<br />

(s + λ)(s + λ − jλ)(s + λ + jλ)<br />

= (s + λ)(s 2 + 2λs + 2λ 2 )<br />

= s 3 + 3λs 2 + 4λ 2 s + 2λ 3<br />

Sustituyendo en el polinomio en función <strong>de</strong> los coeficientes<br />

estos valores, se llega a: C1 = 3λ, C2 = 4λ 2 + 2g<br />

Re , C3 = 2λ 3 .<br />

Un valor típico elegido <strong>de</strong> λ es λ = 0,01.<br />

5 / 26<br />

6 / 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 />

El caso INS-GPS<br />

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

INS-GPS<br />

El sistema <strong>de</strong> navegación INS y el GPS son particularmente<br />

complementarios.<br />

El INS:<br />

Da una estimación continua en el tiempo.<br />

Su error crece con el tiempo.<br />

Posee un elevado ancho <strong>de</strong> banda (KHz).<br />

El GPS:<br />

Proporciona una medida <strong>de</strong> alta precisión pero discreta en el<br />

tiempo.<br />

El error está acotado.<br />

Posee un bajo ancho <strong>de</strong> banda (Hz).<br />

Una primera solución sería resetear el INS cada vez que se<br />

obtenga una medida GPS. Pero la medida GPS tampoco es<br />

exacta.<br />

Por tanto hay que intentar, <strong>de</strong> algún modo, combinar el INS y<br />

el GPS para minimizar el error final.<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 />

Tight Integration y Loose Integration<br />

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

INS-GPS<br />

Existen dos formas <strong>de</strong> llevar a cabo la integración:<br />

Loose Integration:<br />

Éste tipo <strong>de</strong> integración permite tomar dos sistemas separados,<br />

un INS y un GPS, y a partir <strong>de</strong> las salidas <strong>de</strong> ambos, obtener<br />

una estimación común.<br />

Es la forma más simple <strong>de</strong> integrar GPS e INS.<br />

No requiere modificar las estimaciones internas <strong>de</strong> ambos<br />

sistemas.<br />

Tight Integration:<br />

Éste tipo <strong>de</strong> integración emplea las señales <strong>de</strong> entrada al INS y<br />

GPS, es <strong>de</strong>cir, las medidas <strong>de</strong> giróscopos y acelerómetros y los<br />

observables GPS, y los integra directamente.<br />

Es más complejo <strong>de</strong> <strong>de</strong>sarrollar.<br />

No se emplean los algoritmos que hemos visto <strong>de</strong> GPS e INS,<br />

sino un único algoritmo que integra los dos sistemas a la vez.<br />

Se obtienen estimaciones más precisas que en la tipo loose.<br />

En ambos casos, la herramienta clave para <strong>de</strong>sarrollar la<br />

integración es el Filtro <strong>de</strong> Kalman y sus extensiones (Filtro<br />

Extendido <strong>de</strong> Kalman).<br />

7 / 26<br />

8 / 26


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

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

El filtro <strong>de</strong> Kalman<br />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

El filtro <strong>de</strong> Kalman (KF) fue <strong>de</strong>sarrollado por Rudolph E.<br />

Kalman, un ingeniero húngaro nacionalizado estadouni<strong>de</strong>nse.<br />

Presentó su filtro a la NASA en 1960; la NASA buscaba un<br />

algoritmo <strong>de</strong> fusión <strong>de</strong> sensores para el programa espacial<br />

Apollo.<br />

Finalmente una versión <strong>de</strong>l KF fue utilizada en las misiones<br />

Apollo para integrar las diferentes medidas <strong>de</strong> los sensores <strong>de</strong>l<br />

vehículo espacial.<br />

A día <strong>de</strong> hoy, el KF se emplea no sólo en navegación sino en<br />

multitud <strong>de</strong> sistemas en los que se <strong>de</strong>sea reconstruir una señal<br />

que evoluciona en el tiempo, a partir <strong>de</strong> medidas con ruido,<br />

por ejemplo en teléfonos móviles.<br />

Realmente el KF sólo sirve para sistemas lineales. Puesto que<br />

muchos sistemas reales son no lineales, se han <strong>de</strong>sarrollado<br />

extensiones no lineales, conocidas como Filtro Extendido <strong>de</strong><br />

Kalman (EKF); en Navegación se emplean éste tipo <strong>de</strong> filtros.<br />

Nos limitaremos a enten<strong>de</strong>r el KF lineal y sus fundamentos. 9 / 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 />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Procesos dinámicos discretos con medidas<br />

PROCESO: Consi<strong>de</strong>remos el siguiente mo<strong>de</strong>lo discreto <strong>de</strong> un<br />

proceso: x(tk+1) = Akx(tk) + Bkɛ(tk), don<strong>de</strong> x es un proceso<br />

gaussiano con dimensión nx, Ak es una matriz (que pue<strong>de</strong><br />

cambiar en cada instante <strong>de</strong> tiempo tk) <strong>de</strong> dimensión nx × nx,<br />

ɛ(tk) es ruido blanco gaussiano <strong>de</strong> dimensión nɛ y varianza Qk<br />

(el ruido <strong>de</strong>l proceso), y Bk es una matriz (que pue<strong>de</strong> cambiar<br />

en cada instante <strong>de</strong> tiempo tk) <strong>de</strong> dimensión nx × nɛ.<br />

MEDIDA: En cada instante también consi<strong>de</strong>ramos que se<br />

realiza una medida, representada por z, y <strong>de</strong>finida <strong>de</strong> la<br />

siguiente forma: z(tk+1) = Hk+1x(tk+1) + ν(tk+1), don<strong>de</strong> z<br />

es la medida, <strong>de</strong> dimensión nz, Hk es una matriz (que pue<strong>de</strong><br />

cambiar en cada instante <strong>de</strong> tiempo tk) <strong>de</strong> dimensión nz × nx,<br />

y ν(tk) es ruido blanco gaussiano <strong>de</strong> dimensión nν y varianza<br />

Rk (el ruido <strong>de</strong> medida).<br />

A<strong>de</strong>más suponemos que ν(tk) y ɛ(tk) son in<strong>de</strong>pendientes, y<br />

que sabemos que la condición inicial <strong>de</strong> x es<br />

x(t0) ∼ Nnx (ˆx0, P0). 10 / 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 />

Ecuaciones <strong>de</strong>l proceso y la medida<br />

Resumiendo las ecuaciones:<br />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

x(tk+1) = Akx(tk) + Bkɛ(tk),<br />

z(tk+1) = Hk+1x(tk+1) + ν(tk+1),<br />

E[ɛ(tk)] = E[ν(tk)] = 0,<br />

E[ɛ(tk)ɛ T (tj)] = δkjQk,<br />

E[ν(tk)ν T (tj)] = δkjRk,<br />

E[ɛ(tk)ν T (tj)] = 0,<br />

x(t0) ∼ Nnx (ˆx0, P0).<br />

Definimos la estimación en tk <strong>de</strong> x(tk) como ˆx(tk).<br />

Definimos la covarianza <strong>de</strong>l error <strong>de</strong> estimación como<br />

P(tk) = E[(x(tk) − ˆx(tk))(x(tk) − ˆx(tk)) T ].<br />

El objetivo <strong>de</strong>l filtro <strong>de</strong> Kalman es, empleando el<br />

conocimiento <strong>de</strong> las ecuaciones arriba formuladas, y a partir<br />

<strong>de</strong> las medidas z(tk), obtener la mejor estimación posible, es<br />

<strong>de</strong>cir, el valor <strong>de</strong> ˆx(tk) que minimiza P(tk).<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 />

El filtro <strong>de</strong> Kalman I<br />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Si sólo tuviéramos el proceso, po<strong>de</strong>mos calcular su media y<br />

tomamos ˆx como dicha media; por tanto,<br />

x(tk) ∼ Nnx (ˆx(tk), Pk), don<strong>de</strong>:<br />

ˆx(tk+1) = Ak ˆx(tk),<br />

Pk+1 = AkPkA T k + BkQkB T k .<br />

La i<strong>de</strong>a <strong>de</strong> Kalman es <strong>de</strong>cir: la estimación arriba escrita es<br />

válida antes <strong>de</strong> tomar la medida z(tk+1). Denotamos dicha<br />

estimación “a priori” como ˆx − (tk+1) y su covarianza como<br />

P −<br />

k+1 .<br />

Ahora, si la estimación fuera perfecta y la medida no tuviera<br />

error, se tendría que z(tk+1) = Hk+1ˆx − (tk+1). Como no es<br />

así, se actualiza la estimación (“a posteriori”) <strong>de</strong> forma<br />

proporcional a la discrepancia:<br />

ˆx + (tk+1) = ˆx − (tk+1) + Kk+1(z(tk+1) − Hk+1ˆx − (tk+1)).<br />

11 / 26<br />

12 / 26


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

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

El filtro <strong>de</strong> Kalman II<br />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

En la ecuación<br />

ˆx + (tk+1) = ˆx − (tk+1) + Kk+1(z(tk+1) − Hk+1ˆx − (tk+1)) lo<br />

único que no conocemos es Kk+1, que es la ganancia <strong>de</strong><br />

Kalman. Ésta se <strong>de</strong>termina para garantizar que la covarianza<br />

, sea la menor posible.<br />

<strong>de</strong> ˆx + (tk+1), P +<br />

k+1<br />

Calculemos P +<br />

k+1 :<br />

P +<br />

k+1 = E[(x(tk+1) − ˆx + (tk+1))(x(tk+1) − ˆx + (tk+1)) T ], y<br />

sustituyendo la ecuación <strong>de</strong> ˆx + (tk+1):<br />

P + k+1<br />

" „<br />

= E x(tk+1 ) − ˆx + « „<br />

(tk+1 ) x(tk+1 ) − ˆx + « #<br />

T<br />

(tk+1 )<br />

»„<br />

= E x(tk+1 ) − ˆx − (tk+1 ) − Kk+1 (z(tk+1 ) − Hk+1 ˆx − «<br />

(tk+1 )<br />

„<br />

× x(tk+1 ) − ˆx − (tk+1 ) − Kk+1 (z(tk+1 ) − Hk+1 ˆx − « #<br />

T<br />

(tk+1 ))<br />

Sustituyendo ahora z(tk+1) = Hk+1x(tk+1) + ν(tk+1):<br />

P +<br />

k+1 =<br />

h“<br />

E x(tk+1) − ˆx − (tk+1) − Kk+1(Hk+1x(tk+1) + ν(tk+1) − Hk+1ˆx − ”<br />

(tk+1) “<br />

× x(tk+1) − ˆx − (tk+1) − Kk+1(Hk+1x(tk+1) + ν(tk+1) − Hk+1ˆx − ” –<br />

T<br />

(tk+1)) <strong>Sistemas</strong> <strong>de</strong> navegación integrados<br />

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

El filtro <strong>de</strong> Kalman III<br />

Simplificando, obtenemos:<br />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

P +<br />

k+1 =<br />

h“<br />

E (I − Kk+1Hk+1)(x(tk+1) − ˆx − ”<br />

) − Kk+1ν(tk+1) “<br />

× (I − Kk+1Hk+1)(x(tk+1) − ˆx − ” –<br />

T<br />

) − Kk+1ν(tk+1) = (I − K k+1H k+1)P −<br />

k+1 (I − K k+1H k+1) T + K k+1R k+1K T<br />

k+1<br />

Es necesario encontrar el valor <strong>de</strong> Kk+1 que minimiza la<br />

anterior expresión. Usando cálculo matricial, se encuentra que<br />

Kk+1 = P −<br />

k+1HT <br />

k+1<br />

Hk+1P −<br />

k+1HT −1 k+1 + Rk+1<br />

Sustituyendo ésta expresión se llega a que:<br />

P +<br />

−<br />

k+1 = (I − Kk+1Hk+1)Pk+1 . Ésta es la covarianza mínima.<br />

13 / 26<br />

14 / 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 />

Algoritmo <strong>de</strong>l filtro <strong>de</strong> Kalman<br />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

El algoritmo queda como sigue:<br />

1 En el instante <strong>de</strong> tiempo tk+1, suponemos que tenemos la<br />

anterior estimación que incluyó también la última medida:<br />

ˆx + (tk) y su covarianza P + tk. Para k = 0 tomamos<br />

ˆx + (t0) = ˆx 0 y P + 0<br />

= P0.<br />

2 Fase <strong>de</strong> propagación; usamos la ecuación <strong>de</strong>l sistema dinámico<br />

para calcular la estimación a priori:<br />

ˆx − (tk+1) = Ak ˆx + (tk),<br />

P −<br />

k+1<br />

= AkP +<br />

k AT k + BkQkB T k .<br />

3 Preparándonos para la medida, calculamos la ganacia <strong>de</strong><br />

Kalman: Kk+1 = P −<br />

k+1HT <br />

k+1<br />

Hk+1P −<br />

k+1HT −1. k+1 + Rk+1<br />

4 Tomamos la medida y calculamos la estimación a posteriori:<br />

ˆx + (tk+1) = ˆx − (tk+1) + Kk+1(z(tk+1) − Hk+1ˆx − (tk+1)),<br />

P +<br />

k+1<br />

= (I − Kk+1Hk+1)P −<br />

k+1 .<br />

5 Iteramos para los siguientes valores <strong>de</strong> k.<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 />

Sobre las medidas<br />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Observación: es posible que no se realice una medida cada tk,<br />

sino que en ciertos instantes se hagan medidas, y en otros no<br />

se haga ninguna medida.<br />

Por ejemplo po<strong>de</strong>mos tener un sensor con bajo ancho <strong>de</strong><br />

banda (como el GPS) mientras que nuestro tiempo <strong>de</strong><br />

muestreo ∆t representa una elevada frecuencia.<br />

Una forma <strong>de</strong> solucionarlo es tomar Hk = 0, luego Kk = 0 en<br />

los instantes tk en los que no se realizan medidas. Por tanto<br />

no es necesario realizar ninguna actualización y<br />

ˆx + (tk) = ˆx − (tk), P + (tk) = P − (tk).<br />

15 / 26<br />

16 / 26


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

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

El caso INS-GPS<br />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

En el caso INS-GPS no po<strong>de</strong>mos aplicar el Filtro <strong>de</strong> Kalman<br />

directamente porque los sistemas y medidas son no lineales.<br />

Lo que se hace es aplicar la solución al error <strong>de</strong> navegación.<br />

Recor<strong>de</strong>mos que <strong>de</strong>rivamos para el INS una ecuación <strong>de</strong> la<br />

forma: δx(tk+1) = Akδx(tk) + Bkɛ(tk), don<strong>de</strong> el vector δx(tk)<br />

contiene los errores <strong>de</strong> posición, velocidad y actitud en tk y<br />

ɛ(tk) son las fuentes <strong>de</strong> error.<br />

Por otro lado en el tema <strong>de</strong>l GPS obtuvimos ecuaciones <strong>de</strong> la<br />

forma: ∆ρ(tk+1) = Hk+1∆x(tk+1) + ν(tk+1), don<strong>de</strong> ∆x(tk+1)<br />

eran errores <strong>de</strong> posición (y velocidad, si también estimamos<br />

velocidad) respecto a una estimación inicial y ∆ρ(tk+1) las<br />

diferencias entre los observables medidos y los estimados.<br />

Por tanto usando la medida <strong>de</strong>l INS como estimación para el<br />

GPS, ya tenemos los errores linealizados escritos <strong>de</strong> una forma<br />

a<strong>de</strong>cuada para implementar el filtro <strong>de</strong> Kalman!<br />

El error estimado se suma a la posición estimada por el INS,<br />

para conseguir la mejor estimación final posible. 17 / 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 />

El caso INS-GPS<br />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Esquema <strong>de</strong> la integración INS-GPS (loose):<br />

18 / 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 1-D <strong>de</strong>l filtro <strong>de</strong> Kalman I<br />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Para enten<strong>de</strong>r mejor el filtro <strong>de</strong> Kalman consi<strong>de</strong>remos un<br />

sistema sencillo. Imaginemos un vehículo que sólo se pue<strong>de</strong><br />

mover en una dirección, con un acelerómetro <strong>de</strong> un ancho <strong>de</strong><br />

banda <strong>de</strong> 100Hz que mi<strong>de</strong> la aceleración en dicha dirección, y<br />

con un sensor con un ancho <strong>de</strong> banda <strong>de</strong> 1Hz que estima la<br />

posición en dicha dirección.<br />

El mo<strong>de</strong>lo <strong>de</strong>l sistema será:¨x = a. Llamando v a la velocidad:<br />

d<br />

dt<br />

» x<br />

v<br />

El mo<strong>de</strong>lo <strong>de</strong>l error será:<br />

d<br />

dt<br />

» δx<br />

δv<br />

– »<br />

0 1<br />

=<br />

0 0<br />

– »<br />

0 1<br />

=<br />

0 0<br />

– » x<br />

v<br />

– » δx<br />

δv<br />

– »<br />

0<br />

+<br />

a<br />

– »<br />

0<br />

+<br />

1<br />

–<br />

–<br />

δa<br />

Pasando a tiempo discreto y teniendo en cuenta que<br />

x(tk+1)−x(tk)<br />

x(t) ≈ :<br />

d<br />

dt<br />

∆t<br />

» δx(tk+1)<br />

δv(t k+1)<br />

– »<br />

1 ∆t<br />

=<br />

0 1<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 />

– » δx(tk )<br />

δv(t k )<br />

Ejemplo 1-D <strong>de</strong>l filtro <strong>de</strong> Kalman II<br />

– »<br />

+<br />

0<br />

∆t<br />

–<br />

δa(t k )<br />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Por otro lado el mo<strong>de</strong>lo <strong>de</strong> medida será: z = x + ν, luego el<br />

mo<strong>de</strong>lo <strong>de</strong> error será: δz = δx + ν.<br />

Escribiéndolo todo:<br />

» δx(tk+1)<br />

δv(t k+1)<br />

–<br />

=<br />

» 1 ∆t<br />

0 1<br />

– » δx(tk )<br />

δv(t k )<br />

δz(t k+1) = δx(t k+1) + ν(t k+1)<br />

– »<br />

+<br />

0<br />

∆t<br />

–<br />

δa(t k+1)<br />

A<strong>de</strong>más las medidas sólo se hacen con una frecuencia <strong>de</strong> 1Hz<br />

(cada segundo), mientras que la frecuencia <strong>de</strong>l acelerómetro<br />

es 100 Hz con lo que <strong>de</strong>beríamos tomar ∆t = 0,01.<br />

Supongamos a<strong>de</strong>más que la precisión <strong>de</strong> los instrumentos es:<br />

σ 2 δa = 0,1, σ2 ν = 0,01, y que se verifican las hipótesis <strong>de</strong>l KF<br />

(ruidos blancos gaussianos, in<strong>de</strong>pendientes, etc...).<br />

En la nomenclatura que hemos usado para el KF, tendremos:<br />

»<br />

1 0,01<br />

Ak =<br />

0 1<br />

– »<br />

, Bk =<br />

0<br />

0,01<br />

–<br />

j ˆ ˜<br />

1 0 , tk = n<br />

, Qk = 0,1, Rk = 0,01, Hk =<br />

0, tk = n.<br />

don<strong>de</strong> n es cualquier entero (para mo<strong>de</strong>lar que se toman<br />

medidas cada segundo, pero no en fracciones <strong>de</strong> segundo).<br />

19 / 26<br />

20 / 26


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

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

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Ejemplo 1-D <strong>de</strong>l filtro <strong>de</strong> Kalman III<br />

Por tanto las ecuaciones <strong>de</strong>l filtro <strong>de</strong> Kalman dirán, para cada<br />

instante <strong>de</strong> tiempo tk+1:<br />

» δˆx − (tk+1)<br />

δˆv − (t k+1)<br />

–<br />

P −<br />

k+1<br />

=<br />

=<br />

» – » +<br />

1 0,01 δˆx (tk )<br />

0 1 δˆv + –<br />

(tk )<br />

» –<br />

1 0,01<br />

P<br />

0 1<br />

+<br />

»<br />

1 0<br />

k 0,01 1<br />

– »<br />

+ 0,1<br />

0<br />

0,01<br />

– ˆ 0 0,01 ˜<br />

Si tk+1 = n, es <strong>de</strong>cir, tiene un valor entero, significa que ha<br />

habido medida. Entonces, calcular la ganancia <strong>de</strong> Kalman:<br />

Kk+1 = P −<br />

»<br />

1<br />

k+1 0<br />

– „ ˆ 0 1 ˜ P −<br />

k+1<br />

» 0<br />

1<br />

– « −1<br />

+ 0,01 .<br />

Tomamos la medida y calculamos la estimación a posteriori:<br />

» δˆx + (tk+1)<br />

δˆv + (t k+1)<br />

–<br />

=<br />

» −<br />

δˆx (tk+1)<br />

δˆv − (tk+1) P +<br />

k+1 =<br />

ˆ<br />

(I − Kk+1 1 0<br />

˜ −<br />

)P<br />

k+1 .<br />

–<br />

+ Kk+1(δz(tk+1) − ˆ 1 0 ˜ » δˆx − (tk+1) δˆv − (tk+1) don<strong>de</strong> δz(tk+1) = z(tk+1) − Hk+1(ˆx(tk+1) + δˆx − (tk+1)).<br />

Si no hubo medida, entonces simplemente:<br />

» δˆx + (tk+1)<br />

δˆv + (t k+1)<br />

–<br />

=<br />

» δˆx − (tk+1)<br />

δˆv − (t k+1)<br />

–<br />

, P +<br />

k+1 = P−<br />

k+1 .<br />

Actualizamos ˆx(tk+1) = ˆx(tk+1) + δˆx + (tk+1). Iteramos para<br />

los siguientes valores <strong>de</strong> k.<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 />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Ejemplo 1-D <strong>de</strong>l filtro <strong>de</strong> Kalman: simulación I<br />

Simulación <strong>de</strong> la posición (exacta) y medidas:<br />

('!<br />

(!!<br />

"'!<br />

"!!<br />

&'!<br />

&!!<br />

'!<br />

+,-./.,0<br />

123.34-<br />

–<br />

,<br />

21 / 26<br />

! *<br />

! "! #! $!<br />

)<br />

%! &!! &"!<br />

22 / 26<br />

*<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 />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Ejemplo 1-D <strong>de</strong>l filtro <strong>de</strong> Kalman: simulación II<br />

('!<br />

(!!<br />

"'!<br />

"!!<br />

&'!<br />

&!!<br />

'!<br />

Usando las medidas para estimar la posición, el resultado es<br />

bueno porque el sensor es preciso y el movimiento en x es<br />

lento.<br />

Si intentamos estimar la velocidad con la fórmula<br />

v(tk) = x(tk)−x(tk−1)<br />

se obtiene ) una estimación muy mala:<br />

!<br />

,-./0/-1<br />

234/45.<br />

!'! *<br />

! "! #! $! %! &!! &"!<br />

%<br />

+<br />

$<br />

'<br />

#<br />

(<br />

"<br />

&<br />

!<br />

!&<br />

∆t<br />

637-0/454<br />

6*3.)/2545*43*234/45.<br />

!" *<br />

! "! #! $!<br />

)<br />

%! &!! &"!<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 />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Ejemplo 1-D <strong>de</strong>l filtro <strong>de</strong> Kalman: simulación III<br />

Comportamiento <strong>de</strong> la estimación y <strong>de</strong>l error sin filtro <strong>de</strong><br />

Kalman:<br />

#!!<br />

'!!<br />

"!!<br />

&!!<br />

! )<br />

! "! #! $!<br />

(<br />

%! &!! &"!<br />

%<br />

$<br />

#<br />

"<br />

!<br />

*+,-.-+/<br />

0,(-12.-+/)30)*+,-.-+/<br />

405+.-323<br />

0,(-12.-+/)30)405+.-323<br />

!" )<br />

! "! #! $!<br />

(<br />

%! &!! &"!<br />

)<br />

)<br />

*<br />

*<br />

23 / 26<br />

24 / 26


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

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

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Ejemplo 1-D <strong>de</strong>l filtro <strong>de</strong> Kalman: simulación IV<br />

Comportamiento <strong>de</strong> la estimación y <strong>de</strong>l error con filtro <strong>de</strong><br />

Kalman:<br />

#!!<br />

'!!<br />

"!!<br />

&!!<br />

! )<br />

! "! #! $!<br />

(<br />

%! &!! &"!<br />

$<br />

#<br />

"<br />

!<br />

*+,-.-+/<br />

0,(-12.-+/)30)*+,-.-+/)4567<br />

809+.-323<br />

0,(-12.-+/)30)809+.-323)4567<br />

!" )<br />

! "! #! $!<br />

(<br />

%! &!! &"!<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 />

Deducción <strong>de</strong>l filtro <strong>de</strong> Kalman. Ecuaciones.<br />

Ejemplo <strong>de</strong> un filtro <strong>de</strong> Kalman<br />

Ejemplo 1-D <strong>de</strong>l filtro <strong>de</strong> Kalman: simulación V<br />

Comparación <strong>de</strong> errores con y sin filtro <strong>de</strong> Kalman:<br />

#!<br />

'!<br />

"!<br />

&!<br />

! )<br />

! "! #! $!<br />

(<br />

%! &!! &"!<br />

&*+<br />

&<br />

!*+<br />

,--.-)/,)0.1232.4)5124)678<br />

,--.-)/,)0.1232.4)53.4)678<br />

,--.-)/,)9,:.32/;/)5124)678<br />

,--.-)/,)9,:.32/;/)53.4)678<br />

! )<br />

! "! #! $!<br />

(<br />

%! &!! &"!<br />

)<br />

)<br />

)<br />

)<br />

25 / 26<br />

26 / 26

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

Saved successfully!

Ooh no, something went wrong!