Geodesia. Cartografía. Sistemas de referencia. Tiempos.
Geodesia. Cartografía. Sistemas de referencia. Tiempos.
Geodesia. Cartografía. Sistemas de referencia. Tiempos.
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