Professional Documents
Culture Documents
Puesto que la Tierra tiene una forma aproximadamente Ejemplos de otros elipsoides de referencia:
elipsoidal, este modelo tiene el merito de ser lo
suficientemente simple como para ser manejable y lo
suficientemente preciso como para ser util en la practica.
Para definir un elipsoide son necesarios dos parametros:
re = semieje ecuatorial (mayor) [a veces llamado a].
rp = semieje polar (menor) [a veces llamado b].
Cartografa Proyecciones.
Cartografa: es la disciplina que estudia la teora y la Otras formas de clasificar una proyeccion podran ser:
confeccion de mapas geograficos y cartas. Por la orientacion de la superficie respecto al Ecuador:
Para ello combina ciencia, tecnica e incluso estetica, partiendo normales, trasversales u oblicuas.
Por la posicion del globo terraqueo respecto a la superficie:
de la premisa de que se puede comunicar informacion
tangente (podra tener una lnea sin deformacion) o secante
geografica de forma efectiva modelando adecuadamente la (podra tener dos lneas sin deformacion).
realidad fsica. Mas importante es el tipo de proyeccion; p.ej. para el caso
Los principales problemas que encuentra la
de un plano:
cartografa son: Gnomonica (la proyeccion pasa por el centro de la
Seleccionar los aspectos geograficos que se Tierra).
muestran en una representacion. Estereografica (pasa por el punto antipodal).
Eliminar la complejidad innecesaria o Ortografica (la proyeccion tiene una direccion fija).
irrelevante contenida en una representacion. Escenografica (la proyeccion viene desde fuera del
Combinar los elementos representativos que globo terrestre).
tiene una representacion para comunicar de
forma efectiva la informacion deseada.
Plasmar la representacion de la realidad
tridimensional sobre una superficie plana (el
mapa o carta): mediante proyecciones. 25 / 67 27 / 67
Geodesia Geodesia
Proyecciones. Mapas y Cartas Proyecciones. Mapas y Cartas
Cartografa Cartografa
Trayectorias ortodromicas y loxodromicas Trayectorias ortodromicas y loxodromicas
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
Ecuaciones matematicas:
x = ) 0 ,) ** Ecuaciones matematicas:
y = ln tan 4 + 2 . x = cos sen( 0 ),
Geodesia Geodesia
Proyecciones. Mapas y Cartas Proyecciones. Mapas y Cartas
Cartografa Cartografa
Trayectorias ortodromicas y loxodromicas Trayectorias ortodromicas y loxodromicas
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
30 / 67 32 / 67
Geodesia Geodesia
Proyecciones. Mapas y Cartas Proyecciones. Mapas y Cartas
Cartografa Cartografa
Trayectorias ortodromicas y loxodromicas Trayectorias ortodromicas y loxodromicas
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
Geodesia Geodesia
Proyecciones. Mapas y Cartas Proyecciones. Mapas y Cartas
Cartografa Cartografa
Trayectorias ortodromicas y loxodromicas Trayectorias ortodromicas y loxodromicas
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
Dado un mapa, un origen y un destino, se plantea el problema En una esfera, un crculo mayor (gran
de encontrar el camino mas apropiado para ir de uno a otro. crculo, crculo maximo) viene dado por la
En la realidad, esta eleccion del camino (que se plasma en el interseccion de un plano que pasa por el
plan de vuelo) esta sujeta a numerosas restricciones. A da de centro de la esfera con la esfera.
hoy, se vuela entre waypoints. ! Las rectas esfericas (geodesicas) son
Ademas habra que tener en cuenta los vientos. los crculos mayores. Observese que
cualesquiera dos rectas esfericas cortan
No obstante, en esta leccion vamos a simplificar el problema y
siempre en dos puntos; por tanto, no
vamos a suponer que en principio cualquier camino es volable.
existen paralelas en geometra esferica.
Ademas supondremos que la Tierra es una esfera de radio Re .
El problema queda reducido a:
Veremos dos posibilidades:
Dados dos puntos, determinar el crculo mayor que contiene a
El camino mas corto: trayectoria ortodromica.
ambos. Es dicho crculo unico?
El camino mas simple de volar: trayectoria loxodromica.
Medir la distancia sobre dicho crculo: dara la distancia entre
los dos puntos.
34 / 67 36 / 67
Geodesia Geodesia
Proyecciones. Mapas y Cartas Proyecciones. Mapas y Cartas
Cartografa Cartografa
Trayectorias ortodromicas y loxodromicas Trayectorias ortodromicas y loxodromicas
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
Geodesia Geodesia
Proyecciones. Mapas y Cartas Proyecciones. Mapas y Cartas
Cartografa Cartografa
Trayectorias ortodromicas y loxodromicas Trayectorias ortodromicas y loxodromicas
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
Geodesia Geodesia
Proyecciones. Mapas y Cartas Proyecciones. Mapas y Cartas
Cartografa Cartografa
Trayectorias ortodromicas y loxodromicas Trayectorias ortodromicas y loxodromicas
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
56.7*,8)0179-)(4
!&("
ln = !"(" :9,6)963*/-
;6<6)963*/-
&#
! "! #!! #"! $!! $"!
)*+,-./*-0123(4
%!! %"! &!! &"!
5-,*,8)0179-)(4
&!
%?
En segundo
" lugar calcular la distancia de: %>
%= 0
:9,6)963*/-
;6<6)963*/-
d = Re 1 + tan2 (B A ).
! "! #!! #"! $!! $"! %!! %"! &!! &"!
)*+,-./*-0123(4
$"(" 0
@83A60179-)(4
$"
$& :9,6)963*/-
;6<6)963*/-
$%(" 0
! "! #!! #"! $!! $"! %!! %"! &!! &"!
45 / 67 47 / 67
Geodesia Geodesia
Proyecciones. Mapas y Cartas Proyecciones. Mapas y Cartas
Cartografa Cartografa
Trayectorias ortodromicas y loxodromicas Trayectorias ortodromicas y loxodromicas
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
67.8*,9)018:-)45
Los resultados obtenidos fueron los siguientes:
!#!
!%!
!'! ;7<7):73*/-
=:,7):73*/-
!(! 0
! "!!! #!!! $!!! %!!! &!!! '!!!
Ciudad Distancia (ort., km) Rumbo inicial (grados, ort) Distancia (lox., km) Rumbo (lox., grados) )*+,-./*-012345
%& 0
Madrid 410.0943 23.78 410.1023 24.38
6-,*,9)018:-)45
NY 5716.03 296.26 5864.08 273.67 %!
Melbourne 17427.04 100 17601.17 118.3 ;7<7):73*/-
=:,7):73*/-
$& 0
! "!!! #!!! $!!! %!!! &!!! '!!!
)*+,-./*-012345
#(!
#'! ;7<7):73*/-
=:,7):73*/-
#%! 0
Ciudad Distancia (ort., km) Rumbo inicial (grados, ort) Distancia (lox., km) Rumbo (lox., grados) ! "!!! #!!! $!!!
)*+,-./*-012345
%!!! &!!! '!!!
46 / 67 48 / 67
Geodesia Geodesia
Proyecciones. Mapas y Cartas Sistemas de referencia
Cartografa Cartografa
Trayectorias ortodromicas y loxodromicas Tiempos
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
&!!
'!
! :6;6(962).,
<9+6(962).,
NED: North East Down).
!'! /
! "!!! #!!! $!!! %!!! &!!!!
()*+,-.),/01234
&"!!! &#!!! &$!!! &%!!!
Sistema de referencia de azimut de deriva (Wander azimuth
#! /
frame).
5,+)+8(/079,(34
"!
!"! :6;6(962).,
<9+6(962).,
!#! /
! "!!! #!!! $!!! %!!! &!!!! &"!!! &#!!! &$!!! &%!!!
&>!
()*+,-.),/01234
/ Ademas estudiaremos las relaciones entre los diferentes
?82@6/079,(34
&&!
&!! :6;6(962).,
<9+6(962).,
=! /
! "!!! #!!! $!!! %!!! &!!!!
()*+,-.),/01234
&"!!! &#!!! &$!!! &%!!!
En este proceso se definiran cantidades utiles, como la
velocidad respecto a Tierra y los angulos de Euler que definen
la actitud de una aeronave.
49 / 67 51 / 67
Geodesia Geodesia
Proyecciones. Mapas y Cartas Sistemas de referencia
Cartografa Cartografa
Trayectorias ortodromicas y loxodromicas Tiempos
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
El plano Oxy contiene al Ecuador y el plano Oxz al Meridiano Esta definida respecto al elipsoide: la direccion Norte es e , la
Earth-Centered, Earth-Fixed Frame
Geodesia Geodesia
Sistemas de referencia Sistemas de referencia
Cartografa Cartografa
Tiempos Tiempos
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
Los ejes estan definidos como en la Velocidad inercial: es la derivada de la posicion, tomada en el
figura. sistema de referencia inercial, es decir, v i = r i .
El centro del sistema de referencia, Velocidad respecto a Tierra: es la derivada de la posicion,
en el centro de masas del avion. tomada en el sistema de referencia ejes Tierra, es decir,
El eje xb contenido en el plano de v e = r e .
simetra del avion, hacia el morro. Observese que ambas definiciones no coinciden puesto que la
El angulo rotado en torno a xb es Tierra rota; ademas v e "= Cie v i porque las derivadas no estan
(alabeo o roll). tomadas en el mismo sistema de referencia. Mas adelante
El eje zb contenido en el plano de simetra del avion, hacia veremos como estan relacionadas ambas cantidades.
abajo. El angulo rotado en torno a zb es (guinada o yaw). Velocidad en los ejes de navegacion: es la velocidad respecto a
El eje yb completa el triedro (direccion aproximada del ala Tierra v e tomada en el sistema de referencia de navegacion,
derecha). El angulo rotado en torno a yb es (cabeceo o es decir, v n = Cen v e . Observese que v n "= r n = 0!
pitch).
58 / 67 60 / 67
Geodesia Geodesia
Sistemas de referencia Sistemas de referencia
Cartografa Cartografa
Tiempos Tiempos
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
61 / 67 63 / 67
Geodesia Geodesia
Sistemas de referencia Sistemas de referencia
Cartografa Cartografa
Tiempos Tiempos
Sistemas de referencia. Tiempos Sistemas de referencia. Tiempos
Relacion entre ECEF y ECI. Relacion entre LLS y azimut errante (n).
Para encontrar Cie , hay que tener en cuenta que la Tierra gira
con velocidad angular i/e = [0 0 E ]T , es decir, ambos
Para encontrar Cgn , hay que tener en cuenta que la rotacion de
sistemas de referencia estaran rotados una cantidad
angulo en torno al eje z. Por tanto:
E = E 0 + E t. Luego:
E
LLS WA
z
ECI ECEF
zi
Por tanto:
Por tanto:
c s 0
cE sE 0 Cgn = s c 0
Cie = sE cE 0 0 0 1
0 0 1
62 / 67 64 / 67
Fig. 2.3 Single rotation in three-axis coordinate frame.
Geodesia Geodesia
Sistemas de referencia Sistemas de referencia
A vector's components described in one frame can be described in another frame Tiempos
Cartografa Cartografa
Tiempos
Sistemas
of arbitrary orientation with respect to the original de referencia.
frame Tiempos ma-
by a transformation Sistemas de referencia. Tiempos
trix composed of three sequential rotations (Euler angles) starting from the original
frame's axes. These rotations are illustrated in Fig. 2.4. In this figure, the primes
Relacion entre n y BFS
are used to represent the corresponding transformed axis. The final y frame cor- Husos horarios
responds to the triple primed x axes. Written in vector form, the transformation is
n
n
S S #
"
BFS
z yS xS
Se llega a:
Fig. 2.4 Three rotations in three-axis coordinate frame.
2 3
cc cs + ssc ss + csc
b b S" S
Cn = CS " CS Cn = 4 cs cc + sss sc + css 5
s sc cc
65 / 67 67 / 67
Geodesia
Sistemas de referencia
Cartografa
Tiempos
Sistemas de referencia. Tiempos
66 / 67
Introduccion historica Introduccion historica
Navegacion. Definicion y tipos de navegacion Navegacion. Definicion y tipos de navegacion
La actitud de la aeronave. Formas de representacion La actitud de la aeronave. Formas de representacion
3 / 28
2 / 28 4 / 28
Introduccion historica Introduccion historica
Navegacion. Definicion y tipos de navegacion Navegacion. Definicion y tipos de navegacion
La actitud de la aeronave. Formas de representacion La actitud de la aeronave. Formas de representacion
! ! !
Observese: e Sx = CSS exS = CSS [1 0 0]T = [c11 c21 c31 ]T .
La navegacion autonoma (p.ej. inercial) proporciona una ! !
Introduccion historica Matriz de cosenos directores Introduccion historica Matriz de cosenos directores
Navegacion. Definicion y tipos de navegacion Angulos de Euler Navegacion. Definicion y tipos de navegacion Angulos de Euler
La actitud de la aeronave. Formas de representacion Cuaterniones La actitud de la aeronave. Formas de representacion Cuaterniones
17 / 28 19 / 28
Introduccion historica Matriz de cosenos directores Introduccion historica Matriz de cosenos directores
Navegacion. Definicion y tipos de navegacion Angulos de Euler Navegacion. Definicion y tipos de navegacion Angulos de Euler
La actitud de la aeronave. Formas de representacion Cuaterniones La actitud de la aeronave. Formas de representacion Cuaterniones
21 / 28 23 / 28
Introduccion historica Matriz de cosenos directores Introduccion historica Matriz de cosenos directores
Navegacion. Definicion y tipos de navegacion Angulos de Euler Navegacion. Definicion y tipos de navegacion Angulos de Euler
La actitud de la aeronave. Formas de representacion Cuaterniones La actitud de la aeronave. Formas de representacion Cuaterniones
Introduccion historica Matriz de cosenos directores Introduccion historica Matriz de cosenos directores
Navegacion. Definicion y tipos de navegacion Angulos de Euler Navegacion. Definicion y tipos de navegacion Angulos de Euler
La actitud de la aeronave. Formas de representacion Cuaterniones La actitud de la aeronave. Formas de representacion Cuaterniones
Tema 3: Ecuaciones de la navegacion. donde suponemos que di son angulos pequenos, de forma
que podemos aproximar cos di # 1 y sen di # di .
Si escribimos las matrices de rotacion teniendo en cuenta la
aproximacion anterior, obtenemos:
2 3 2 3 2 3
1 0 0 1 0 d2 1 d3 0
S S 5 , C B = 4 d3
CA1 = 4 0 1 d1 5 , CS 2 = 4 0 1 0 S2 1 0 5.
1
0 d1 1 d2 0 1 0 0 1
DCM DCM
Ecuaciones Diferenciales Cinematicas de la Actitud Ecuaciones Diferenciales Cinematicas de la Actitud
Angulos de Euler Angulos de Euler
Ecuaciones Fundamentales de la Navegacion Ecuaciones Fundamentales de la Navegacion
Cuaterniones Cuaterniones
DCM DCM
Ecuaciones Diferenciales Cinematicas de la Actitud Ecuaciones Diferenciales Cinematicas de la Actitud
Angulos de Euler Angulos de Euler
Ecuaciones Fundamentales de la Navegacion Ecuaciones Fundamentales de la Navegacion
Cuaterniones Cuaterniones
DCM DCM
Ecuaciones Diferenciales Cinematicas de la Actitud Ecuaciones Diferenciales Cinematicas de la Actitud
Angulos de Euler Angulos de Euler
Ecuaciones Fundamentales de la Navegacion Ecuaciones Fundamentales de la Navegacion
Cuaterniones Cuaterniones
EDC para los angulos de Euler I EDC para los angulos de Euler III
Observese que lo que realmente se quiere es una expresion
Partimos de la definicion de los angulos de Euler:
para las derivadas de los angulos en funcion de
bb/n = [1 2 3 ]T , y por tanto hay que invertir la matriz:
n S S # b
nz #
yS xS 1
1 0 s 1
La velocidad angular tiene la propiedad de que = 0 c sc 2
b/n = b/S # + S # /S + S/n . 0 s cc 3
Si mecanizamos esta ecuacion en b: c ss sc 1
1
bb/n = bb/S # + bS # /S + bS/n = 0 cc sc 2
c
Por otro lado esta claro que: 0 s c 3
#
bb/S # = [ 0 0]T , SS # /S = [0 0]T , SS/n = [0 0 ]T . Observese que se trata de 3 ecuaciones diferenciales no
#
Luego: bb/n = bb/S # + CSb# SS # /S + CSb SS/n y puesto que lineales, con multitud de funciones trigonometricas.
# Posee una singularidad para = 90o . En realidad los
CSb = CSb# CSS , podemos escribir:
# # angulos de Euler no estan bien definidos para esta situacion.
bb/n = bb/S # + CSb# SS # /S + CSb# CSS SS/n
Esta singularidad es el motivo por el que no se suelen usar en
10 / 28 sistemas de navegacion inercial. 12 / 28
DCM DCM
Ecuaciones Diferenciales Cinematicas de la Actitud Ecuaciones Diferenciales Cinematicas de la Actitud
Angulos de Euler Angulos de Euler
Ecuaciones Fundamentales de la Navegacion Ecuaciones Fundamentales de la Navegacion
Cuaterniones Cuaterniones
DCM Velocidad
Ecuaciones Diferenciales Cinematicas de la Actitud Ecuaciones Diferenciales Cinematicas de la Actitud
Angulos de Euler Velocidades angulares entre sistemas de referencia
Ecuaciones Fundamentales de la Navegacion Ecuaciones Fundamentales de la Navegacion
Cuaterniones Posicion
Velocidad Velocidad
Ecuaciones Diferenciales Cinematicas de la Actitud Ecuaciones Diferenciales Cinematicas de la Actitud
Velocidades angulares entre sistemas de referencia Velocidades angulares entre sistemas de referencia
Ecuaciones Fundamentales de la Navegacion Ecuaciones Fundamentales de la Navegacion
Posicion Posicion
Velocidad Velocidad
Ecuaciones Diferenciales Cinematicas de la Actitud Ecuaciones Diferenciales Cinematicas de la Actitud
Velocidades angulares entre sistemas de referencia Velocidades angulares entre sistemas de referencia
Ecuaciones Fundamentales de la Navegacion Ecuaciones Fundamentales de la Navegacion
Posicion Posicion
E s h = vD
cc s Estas ecuaciones me permiten obtener la posicion conocida la
g
Igualmente ng /e = Cgn g /e = cs c velocidad en todo instante. Observese que son singulares en
s = 90o .
Finalmente Por ese motivo se introduce el azimuth dederiva. vE
0 cc s
Re +hv
nn/e = ng /e + nn/g = ng /e + 0 = cs c Sustituyendo en gg /e obtenemos: gg /e = Re N+h
s + vERetan
+h
22 / 28 24 / 28
Velocidad Velocidad
Ecuaciones Diferenciales Cinematicas de la Actitud Ecuaciones Diferenciales Cinematicas de la Actitud
Velocidades angulares entre sistemas de referencia Velocidades angulares entre sistemas de referencia
Ecuaciones Fundamentales de la Navegacion Ecuaciones Fundamentales de la Navegacion
Posicion Posicion
meridiano), que fueron definidos en el primer tema; dichos puede elegir como se quiera.
vx sen +vy cos
radios dependen de la latitud en la que se encuentre el avion. Se suele fijar por definicion = s = cos (Re +h) tan,
vy
v E
R +h Re +h
Y por tanto: gg /e
N
v
= RMN+h
de donde: nn/e = Rev+h
x ,
0
vRENtan
+h
Observese que ha desaparecido la singularidad en nn/e ! (a
costa de un grado de libertad adicional, ).
25 / 28 27 / 28
Velocidad Velocidad
Ecuaciones Diferenciales Cinematicas de la Actitud Ecuaciones Diferenciales Cinematicas de la Actitud
Velocidades angulares entre sistemas de referencia Velocidades angulares entre sistemas de referencia
Ecuaciones Fundamentales de la Navegacion Ecuaciones Fundamentales de la Navegacion
Posicion Posicion
EDC de la Posicion con Azimuth de Deriva I EDC de la Posicion con Azimuth de Deriva III
Trabajamos con tierra esferica. Si %= 0 entonces n %= g y la Usando se mantiene la singularidad a la hora de calcular ,
unica ecuacion que se mantiene es h = vD , mientras que el pero al menos se puede seguir computando nn/e , que es
resto de las ecuaciones cambian. necesaria para poder calcular v n .
Si escribimos v n = [vx vy vD ]T y nn/e = [x y z ]T , Interpretacion fsica: Esta definicion de equivale a tener una
siguiendo
' el(mismo procedimiento de antes hallamos: plataforma a bordo, a la que se permite girar en las
v n = n r n + rn direcciones x n y y n pero se le impide girar en z n . El angulo
n/e
que forma una direccion fija de la plataforma con el N sera .
La ecuacion matricial queda:
2 3 2 32 3 2
0
3 Observacion: puesto que la posicion viene dada por los
vx 0 z y 0
4 vy 5 = 4 z 0 x 5 4 0 5+4 0 5 angulos (, , ), se puede tratar como una actitud, Cen .
vD y x 0 Re h h
En tal caso las ecuaciones cinematicas de la posicion ' podran
(
donde recordemos que ya calculamos x = cc s,
darse como EDC de actitud, por ejemplo Cen = n Cen n/e
y = cs c, z = s + .
Se llega a: o incluso tratarse como cuaterniones.
vx =
cs + c (Re + h)
As eliminamos totalmente la singularidad, y podemos
sobrevolar cualquier punto del planeta.
vy = cc s (Re + h)
En cualquier caso habra que anadir la ecuacion para la
vD = h
26 / 28 altitud, h = vD . 28 / 28
Sistema de navegacion autonomo: Navegacion inercial. Sistema de navegacion autonomo: Navegacion inercial. La IMU: sensores inerciales
Errores en navegacion inercial. Errores en navegacion inercial. Mecanizacion en ejes n y en ejes e
Modelos de Error Modelos de Error Alineamiento inicial
Sistema de navegacion autonomo: Navegacion inercial. La IMU: sensores inerciales Sistema de navegacion autonomo: Navegacion inercial. La IMU: sensores inerciales
Errores en navegacion inercial. Mecanizacion en ejes n y en ejes e Errores en navegacion inercial. Mecanizacion en ejes n y en ejes e
Modelos de Error Alineamiento inicial Modelos de Error Alineamiento inicial
Sistema de navegacion autonomo: Navegacion inercial. La IMU: sensores inerciales Sistema de navegacion autonomo: Navegacion inercial. La IMU: sensores inerciales
Errores en navegacion inercial. Mecanizacion en ejes n y en ejes e Errores en navegacion inercial. Mecanizacion en ejes n y en ejes e
Modelos de Error Alineamiento inicial Modelos de Error Alineamiento inicial
Sistema de navegacion autonomo: Navegacion inercial. La IMU: sensores inerciales Sistema de navegacion autonomo: Navegacion inercial. La IMU: sensores inerciales
Errores en navegacion inercial. Mecanizacion en ejes n y en ejes e Errores en navegacion inercial. Mecanizacion en ejes n y en ejes e
Modelos de Error Alineamiento inicial Modelos de Error Alineamiento inicial
Sistema de navegacion autonomo: Navegacion inercial. La IMU: sensores inerciales Sistema de navegacion autonomo: Navegacion inercial. La IMU: sensores inerciales
Errores en navegacion inercial. Mecanizacion en ejes n y en ejes e Errores en navegacion inercial. Mecanizacion en ejes n y en ejes e
Modelos de Error Alineamiento inicial Modelos de Error Alineamiento inicial
En ocasiones, por motivos de integracion INS-GPS, conviene Tenemos por tanto dos ecuaciones: abNG = Cnb g n y
mecanizar las ecuaciones en los ejes e (en los que trabaja el bb/i = Cnb e/i
n . Llamando a las medidas x b = ab
1 NG y
GPS). x 2 = b/i , y denotando los modelos como y 1 = g n y
b b n
Se llega a las siguientes ecuaciones para velocidad y posicion: x n2 = e/i
n , se tiene que
! "
d e
Velocidad: dt v = 2 ee/i v e + aeNG + g e =
! " x n1 = Cnb (0)y b1 , x n2 = Cnb (0)y b2
2 ee/i v e + (Cen )T (Cnb )T abNG + g e
d e
Posicion: dt r = ve. Tendramos 6 medidas (las componentes de dos vectores) para
Habra que escribir Cen en funcion de r e y v e , escribir un 9 grados de libertad (las entradas de la matriz).
modelo de g e , y escribir la ecuacion de la actitud, y se llegara Es necesario pues generar una medida adicional
a un esquema similar al anterior. independiente.
17 / 49 19 / 49
Sistema de navegacion autonomo: Navegacion inercial. La IMU: sensores inerciales Sistema de navegacion autonomo: Navegacion inercial. La IMU: sensores inerciales
Errores en navegacion inercial. Mecanizacion en ejes n y en ejes e Errores en navegacion inercial. Mecanizacion en ejes n y en ejes e
Modelos de Error Alineamiento inicial Modelos de Error Alineamiento inicial
Sistema de navegacion autonomo: Navegacion inercial. Variables de error. Error en actitud Sistema de navegacion autonomo: Navegacion inercial. Variables de error. Error en actitud
Errores en navegacion inercial. Modelo de propagacion linealizado Errores en navegacion inercial. Modelo de propagacion linealizado
Modelos de Error El canal vertical Modelos de Error El canal vertical
En general, para una variable cualquiera de navegacion x, se Se quiere estudiar como evoluciona el error del INS con el
denota con x el valor estimado con el INS. tiempo. Para ello, es necesario encontrar el modelo de
propagacion del error.
Puesto que este valor no sera exacto se define el error como
x = x x. Este modelo se encuentra directamente de las ecuaciones de
la navegacion inercial, suponiendo que los errores son
Error en posicion: las variables de posicion son , y h. Las
pequenos, con lo que las ecuaciones se pueden linealizar.
variables estimadas seran , , h. Definimos el error en
posicion p como p = [ h]T = [ h h]T . Por ejemplo, supongamos que x es una variable que el INS
estima como x. La ecuacion que verifica x sera x = f (x). El
Error en velocidad: igualmente se define v n = v n v n , donde
INS lo que hara sera calcular x a partir de x = f (x). Por
v n es la velocidad calculada por el INS.
tanto: x = x x = f (x) f (x) = f (x + x) f (x).
Para la actitud, como definir un error en la matriz de actitud
Desarrollando esta expresion en serie de Taylor y quedandonos
Cnb ? f
el termino constante y el lineal: f (x + x) # f (x) + x |x=x x.
Lo que se hace es suponer que el INS estima una actitud de f
los ejes cuerpo b que denotaremos por b.
Por tanto llegamos a la siguiente expresion: x = x |x=x x,
que es aproximada y solo sirve para x pequeno.
22 / 49 24 / 49
Sistema de navegacion autonomo: Navegacion inercial. Variables de error. Error en actitud Sistema de navegacion autonomo: Navegacion inercial. Variables de error. Error en actitud
Errores en navegacion inercial. Modelo de propagacion linealizado Errores en navegacion inercial. Modelo de propagacion linealizado
Modelos de Error El canal vertical Modelos de Error El canal vertical
Sistema de navegacion autonomo: Navegacion inercial. Variables de error. Error en actitud Sistema de navegacion autonomo: Navegacion inercial. Variables de error. Error en actitud
Errores en navegacion inercial. Modelo de propagacion linealizado Errores en navegacion inercial. Modelo de propagacion linealizado
Modelos de Error El canal vertical Modelos de Error El canal vertical
Sistema de navegacion autonomo: Navegacion inercial. Variables de error. Error en actitud Sistema de navegacion autonomo: Navegacion inercial. Variables de error. Error en actitud
Errores en navegacion inercial. Modelo de propagacion linealizado Errores en navegacion inercial. Modelo de propagacion linealizado
Modelos de Error El canal vertical Modelos de Error El canal vertical
30 / 49 32 / 49
Sistema de navegacion autonomo: Navegacion inercial. Variables de error. Error en actitud Sistema de navegacion autonomo: Navegacion inercial. Variables de error. Error en actitud
Errores en navegacion inercial. Modelo de propagacion linealizado Errores en navegacion inercial. Modelo de propagacion linealizado
Modelos de Error El canal vertical Modelos de Error El canal vertical
Propagacion del error del INS. Ecuacion del error en el canal vertical II
Por tanto podremos escribir, como antes, La solucion
q de la ecuacion
q diferencial es:
= Cp p + Cv v n + C bb/i . h = C1 e Re + C2 e
2g0
t
2g0
t
Re , donde las constantes son funcion
Es una ecuacion lineal en los errores, donde las matrices estan de las condiciones iniciales de altura y velocidad vertical.
definidas en funcion de la estimacion del INS, y con un
Estas ecuaciones son inestables! El primer termino crece hasta
terminos forzante: el error en los giroscopos bb/i .
el infinito.
Si ponemos todos los errores juntos, llegamos a:
Fsicamente, lo que sucede es lo siguiente: si hay un error de
p Cpp Cpv 0 p 0 altitud, p.ej. el INS piensa que el avion esta mas alto de lo
d
v n = Cvp Cvv Cv v n + Ca abNG + G n que realmente esta, el modelo de gravedad predice que la
dt bb/i
Cp Cv C gravedad es menor de lo que es, con lo que el INS predice que
el avion se eleva, es decir, el error inicial se amplifica!
p
Ademas estaran las condiciones iniciales: v n (t = 0). Este resultado se mantiene si no se desprecian los terminos
que no se han considerado. Por tanto el canal vertical del INS
Este es el modelo de propagacion del error del INS. Puesto es inestable y no se puede usar por s solo; empleando otras
que el termino forzante es desconocido (y se modela mediante medidas (p.ej. barometricas) es posible compensar el canal
la estadstica) es una ecuacion diferencial estocastica. vertical y obtener una medida fiable de la altura.
33 / 49 35 / 49
Sistema de navegacion autonomo: Navegacion inercial. Variables de error. Error en actitud Sistema de navegacion autonomo: Navegacion inercial. Breve recordatorio de estadstica
Errores en navegacion inercial. Modelo de propagacion linealizado Errores en navegacion inercial. Procesos estocasticos. Ruido blanco. Propagacion.
Modelos de Error El canal vertical Modelos de Error Medidas del error.
37 / 49 39 / 49
Sistema de navegacion autonomo: Navegacion inercial. Breve recordatorio de estadstica Sistema de navegacion autonomo: Navegacion inercial. Breve recordatorio de estadstica
Errores en navegacion inercial. Procesos estocasticos. Ruido blanco. Propagacion. Errores en navegacion inercial. Procesos estocasticos. Ruido blanco. Propagacion.
Modelos de Error Medidas del error. Modelos de Error Medidas del error.
Sistema de navegacion autonomo: Navegacion inercial. Breve recordatorio de estadstica Sistema de navegacion autonomo: Navegacion inercial. Breve recordatorio de estadstica
Errores en navegacion inercial. Procesos estocasticos. Ruido blanco. Propagacion. Errores en navegacion inercial. Procesos estocasticos. Ruido blanco. Propagacion.
Modelos de Error Medidas del error. Modelos de Error Medidas del error.
42 / 49 44 / 49
Sistema de navegacion autonomo: Navegacion inercial. Breve recordatorio de estadstica Sistema de navegacion autonomo: Navegacion inercial. Breve recordatorio de estadstica
Errores en navegacion inercial. Procesos estocasticos. Ruido blanco. Propagacion. Errores en navegacion inercial. Procesos estocasticos. Ruido blanco. Propagacion.
Modelos de Error Medidas del error. Modelos de Error Medidas del error.
Sistema de navegacion autonomo: Navegacion inercial. Breve recordatorio de estadstica Sistema de navegacion autonomo: Navegacion inercial. Breve recordatorio de estadstica
Errores en navegacion inercial. Procesos estocasticos. Ruido blanco. Propagacion. Errores en navegacion inercial. Procesos estocasticos. Ruido blanco. Propagacion.
Modelos de Error Medidas del error. Modelos de Error Medidas del error.
%
!" !# !$ % $ # "
*+,-$
.&%/$)$
!$
!"#$
%&'($)
!#
!"
!"#$ % !& & ' & %( )*
" "
D/4:2("!Q"EF",/)43("+#/)0"-#./0/#)."9#33(90(5"#)"0'("2##$0#-"#$"G#6H0(3"C:/35/)4"$#2"!L"
+,-%./#$"012%3''$%42"0%567"&28%(.345*%%
menos representativo estadsticamente
" hablando. Si
OPK,"/."1"./)43("):7C(2"0'10"(T-2(..(."!O"199:219A;"U)"#25(2"0#"9#7-:0("0'("OPK,"#$"
91)"C("-2(5/90(5"$2#7"0'("9#22(.-#)5/)4"612/1)9(."#)"0'("5/14#)13"#$"0'("
2 2
DRMS = x + y . Entonces el 2DRMS es el crculo de
9#612/1)9("7102/T;""
Fundamentos basicos.
3 / 48
users location will be in error and result in error in the computed position. The con- Foghorn 1
Navegacion por posicionamiento Navegacion por posicionamiento
GNSS: Navegacion por satelite
Fundamentos basicos
Navegacion DME-DME y el diseno de aerovas
cept of dilution of precision is theGNSS:
ideaNavegacion
that the position
por sateliteerror that results from mea-
Fundamentos basicos
Navegacion DME-DME y el diseno de aerovas
GPS: Otros conceptos
surement errors depends on the user/foghorn relative geometry. Graphically, these
GPS: Otros conceptos
ideas are illustrated in Figure 7.5. Two geometries are indicated. In Figure 7.5(a),
DME II Errores en navegacion DME/DME Foghorn 2
(a)
Variation in range ring
due to range errors: Shaded region: Locations
from foghorn 1 using data from within
Shaded region: Locations using data
from foghorn 2 frombounds
indicated error within indicated error bounds
User location
La secuencia de pares de pulsos depende del equipo del avion,
por lo que un mismo equipo de tierra puede responder a User location
multiples equipos en el aire (hasta 100200 aeronaves). Los errores dependen de la posicion relativa de las estaciones
La precision tpica de un DME esta entre 185 m (0.1 nm) y Foghorn 1
DME con respecto al receptor.
926 m. (0.5nm) 2 . Se pueden obtener medidas casi Si la linea que une al receptor con uno de los DME forma 90
continuamente (10 medidas por segundo). Tambien se obtiene grados con la linea que une Foghorn 2
al receptor con el otro DME, la
Foghorn 1
una estimacion de la velocidad (proyectada en la direccion de situacion
Foghorn 2 es optima, como se ve
(b) en la figura de la izquierda.
la estacion) mediante el efecto Doppler. Si dichas lineas (a)geometry and dilution of precision: (a) geometry with low DOP, and (b)
with high forman
Figure 7.5 Relative
geometry DOP. un angulo pequeno (por ejemplo si el
Observese que la medida de distancia D es 3-D. Para obtener receptor se encuentra aproximadamente entre las estaciones
la distancia sobre el terreno, dG , si la altitud Alt es conocida: DME) la situacion es adversa,
Shaded region: Locations using como data se muestra en la figura de
from within indicated error bounds
D 2 = dG2 + Alt 2 . la derecha.
5 / 48 7 / 48
Variation in range ring due to
range errors:
from foghorn 1
Navegacion por posicionamiento Navegacion por posicionamiento
GNSS: Navegacion por satelite
Fundamentos basicos from foghorn 2 GNSS: Navegacion por satelite
Fundamentos basicos
Navegacion DME-DME y el diseno de aerovas Navegacion DME-DME y el diseno de aerovas
GPS: Otros conceptos GPS: Otros conceptos
User location
Navegacion DME/DME RNAV
RNAV=aRea NAVigation.
Consideremos el caso de dos DMEs. En principio existira una
ambiguedad que se puede resolver conocidas medidas La navegacion tradicional exige emplear
anteriores o con una tercera estacion. radioayudas (tpicamente VOR) como
waypoints generando aerovas rgidas que
Simplifiquemos y supongamos Tierra plana y las coordenadas
no permiten explotar el espacio aereo.
x, y que miden la posicion de la aeronave; las coordenadas Foghorn 2
x1 , y1 y x2 , y2 determinan la posicion de las estaciones. Los sistemas de navegacion actuales
Foghorn 1
Se mide la distancia a la primera estacion 1 y a la segunda (b) permiten saber la posicion de la aeronave
estacion 2 (distancias sobre tierra). con
Figure 7.5 Relative geometry and dilution of precision: (a) geometry withprecision, para cualquier ruta.
low DOP, and (b)
geometry with high DOP.
Las ecuaciones que hay que resolver para hallar la posicion RNAV es un procedimiento de navegacion que permite disenar
son: una ruta arbitraria con waypoints virtuales, siempre que la
ruta de la aeronave se encuentre en una zona donde los
(x x1 )2 + (y y1 )2 = 1 , (x x2 )2 + (y y2 )2 = 2 . sistemas de navegacion tengan la suficiente precision.
Dicha precision se puede especificar, de forma que una
Estas ecuaciones son sencillas de resolver. Pero si las
determinada ruta o procedimiento RNAV solo la pueden
distancias contienen error, como determinar el error final en
realizar aviones con ciertas caractersticas y adecuadamente
la estimacion de posicion?
6 / 48
equipados. Esta especificacion se denomina RNP. 8 / 48
Navegacion por posicionamiento Navegacion por posicionamiento
Fundamentos basicos Fundamentos basicos
GNSS: Navegacion por satelite GNSS: Navegacion por satelite
Navegacion DME-DME y el diseno de aerovas Navegacion DME-DME y el diseno de aerovas
GPS: Otros conceptos GPS: Otros conceptos
EUROCONTROL
WAYPOINT TOLERANCE
EUROCONTROL
SYSTEM ACCURACY
HORIZONTAL VIEW
RNP=Required Navigation Performance. True Aircraft Flight Path
separacion que la tradicionalmente empleada, y Errores 2-D: ATT (along-track tolerance) y XTT (cross-track
por tanto una explotacion eficiente del espacio tolerance).
aereo. Estos son los errores que se requieren para disenar
RNAV/RNP es el futuro del trafico aereo y requiere un amplio procedimientos RNAV. Se fija un corredor de seguridad en
conocimiento de los sistemas de navegacion utilizados. torno a la trayectoria que respete estos errores maximos.
Ejemplificamos estos conceptos para el caso DME-DME. Aparte de los errores procedentes del DME, otros errores que
juegan un papel son (FTT=error tecnico de vuelo) y el error
de calculo (ST=system tolerance).
9 / 48 11 / 48
Diseno de un procedimiento III 2.3.4 The procedure designer should choose the table based upon the worst case
navaid availability for the waypoint in question. In other words, how many DME
stations are within range and available for use at the lowest usable level at the
Sistemas de posicionamiento satelitales: GPS
waypoint. The XTT, ATT and !AW values at that level, for the appropriate
phase of flight, should then be used for all containment area calculations
associated with that waypoint. The en-route values are provided for use on
Altitude
arrival legs that are more than 25 NM from the IAWP.
4.08
ATT
(NM)
For all altitudes
3.56
!AW
(NM)
8.10
XTT
(NM)
2.94
2.86
ATT
(NM)
2.76
2.68
!AW
(NM)
5.41
5.29
XTT
(NM)
ATT
(NM)
!AW
(NM)
DoD...) se interesan por desarrollar un sistema:
Aparte se anaden pequenos bufferspara aumentar la 13,000
12,000
11,000
10,000
2.78
2.70
2.61
2.53
2.60
2.51
2.42
2.32
5.17
5.05
4.92
4.79 2.37 2.32 4.06
Global.
seguridad de los procedimientos. 9,000
8,000
7,000
2.43
2.34
2.23
2.22
2.11
2.00
4.65
4.50
4.35
2.27
2.17
2.06
2.22
2.11
2.00
3.91
3.75
3.59
3-D.
6,000 2.13 1.88 4.19 1.94 1.88 3.41
5,000 2.01 1.74 4.01 1.81 1.74 3.22
De gran precision.
Usando los valores de XTT y ATT se pueden disenar 4,000
3,000
1.88
1.75
1.60
1.43
3.83
3.62
1.67
1.52
1.60
1.43
3.01
2.77
RNAV in Europe - Procedure Design Master Class 2,000
1,000
1.59
1.40
1.24
0.98
3.38
3.10
1.33
1.10
1.24
0.98
2.50
2.15
Con operacion continua.
DESIGN OF PROTECTION
procedimientos RNAV. 500 0.95 0.81 1.92
EUROCONTROL
Table 2 - XTT, ATT and Semi-width Values (in NM) for DME/DME RNAV (Only 2 DMEs available)
Util en plataformas de dinamica rapida.
AREAS
Altitude
(ft)
XTT
(NM)
En-route
ATT
(NM)
!AW
(NM)
XTT
(NM)
IAWP/IWP
ATT
(NM)
!AW
(NM)
FAWP/MAWP/DWP
XTT
(NM)
ATT
(NM)
!AW
(NM)
En los anos 70 nace el sistema GPS (Global Positioning
15,000 For all altitudes 2.37 2.15 4.55
SECONDARY AREA
14,000
13,000
12,000
3.40 2.67 7.10 2.31
2.25
2.19
2.08
2.02
1.95
4.47
4.38
4.29
System) que satisface los criterios demandados y es pasivo:
11,000 2.13 1.88 4.19
IAWP
PRIMARY AREA
IWP 10,000
9,000
8,000
2.06
2.00
1.92
1.80
1.73
1.64
4.10
3.99
3.89
1.87
1.80
1.72
1.80
1.73
1.64
3.31
3.20
3.08
permite infinitos usuarios.
7,000 1.85 1.56 3.78 1.63 1.56 2.95
6,000
5,000
4,000
1.77
1.69
1.60
1.46
1.36
1.25
3.66
3.53
3.40
1.55
1.45
1.34
1.46
1.36
1.25
2.82
2.67
2.52
El sistema en su concepcion es de naturaleza militar.
3,000
2,000
1,000
1.50
1.39
1.27
1.12
0.97
0.78
3.25
3.09
2.90
1.23
1.09
0.92
1.12
0.97
0.78
2.34
2.14
1.89
1978: Se lanza el primer satelite.
500 0.82 0.64 1.72
Table 3 - XTT, ATT and Semi-width Values (in NM) for DME/DME RNAV (More than 2 DMEs available)
Anos 80: el sistema es operacional.
19
Eliane Belin
Anos 90: modernizacion del sistema. El uso civil supera
Los calculos anteriores se pueden encontrar tabulados. ampliamente al militar.
Edition : 2.2 Released Issue Page 8
Navegacion por posicionamiento GPS: segmentos Navegacion por posicionamiento GPS: segmentos
GNSS: Navegacion por satelite Calculo de posicion. Errores. GNSS: Navegacion por satelite Calculo de posicion. Errores.
GPS: Otros conceptos Calculo de velocidad. GPS: Otros conceptos Calculo de velocidad.
Navegacion por posicionamiento GPS: segmentos Navegacion por posicionamiento GPS: segmentos
GNSS: Navegacion por satelite Calculo de posicion. Errores. GNSS: Navegacion por satelite Calculo de posicion. Errores.
GPS: Otros conceptos Calculo de velocidad. GPS: Otros conceptos Calculo de velocidad.
Calculo de la posicion con cuatro satelites I Calculo de la posicion con cuatro satelites III
Por tanto tenemos las siguientes ecuaciones: Definamos = i i = axi xu + ayi yu + azi zu ctu .
Si definimos:
1 ctu = "s 1 u"
2 3 2 3 2 3
2 ctu = "s 2 u" xu 1 1 ax1 ay1 az1 1
6 7 6 2 2 7 6 1 7
3 ctu = "s 3 u" x = 6
yu 7 , = 6 7 , H = 6 ax2 ay2 az2 7
4 zu 5 4 3 3 5 4 ax3 ay3 az3 1 5
4 ctu = "s 4 u" ctu 4 4 ax4 ay4 az4 1
Navegacion por posicionamiento GPS: segmentos Navegacion por posicionamiento GPS: segmentos
GNSS: Navegacion por satelite Calculo de posicion. Errores. GNSS: Navegacion por satelite Calculo de posicion. Errores.
GPS: Otros conceptos Calculo de velocidad. GPS: Otros conceptos Calculo de velocidad.
Navegacion por posicionamiento GPS: segmentos Navegacion por posicionamiento GPS: segmentos
GNSS: Navegacion por satelite Calculo de posicion. Errores. GNSS: Navegacion por satelite Calculo de posicion. Errores.
GPS: Otros conceptos Calculo de velocidad. GPS: Otros conceptos Calculo de velocidad.
Navegacion por posicionamiento GPS: segmentos Navegacion por posicionamiento GPS: segmentos
GNSS: Navegacion por satelite Calculo de posicion. Errores. GNSS: Navegacion por satelite Calculo de posicion. Errores.
GPS: Otros conceptos Calculo de velocidad. GPS: Otros conceptos Calculo de velocidad.
Navegacion por posicionamiento GPS: segmentos Navegacion por posicionamiento GPS: segmentos
GNSS: Navegacion por satelite Calculo de posicion. Errores. GNSS: Navegacion por satelite Calculo de posicion. Errores.
GPS: Otros conceptos Calculo de velocidad. GPS: Otros conceptos Calculo de velocidad.
del usuario. Imaginemos que tu ) c1 + c2 t. Luego tu = c2 . Estos valores ya se haban calculado anteriormente en la
Entonces realmente y = sin(at + ac1 + ac2 t), lo que es una estimacion de posicion! Luego son conocidos. Llegamos a:
senal de a + ac2 Hercios (ac1 es un desfase y no influye en la d i = axi ux + ayi uy + azi uz c ffMT i tu
i
frecuencia de la senal). Luego fR es igual a a + ac2 . fM i
Aproximamos ) 1. Por tanto llegamos a la ecuacion
fT i
En efecto, se verifica: a = a + ac2 ac2 . d = Hg , donde H es la matriz que se uso para estimar la
Aunque tu puede ser muy pequeno, tiene un efecto muy posicion, d es un vector con las medidas y datos, y
significativo en el resultado real, ya que estara multiplicado g = [ux uy uz c tu ]T que hay que calcular.
por c. Por tanto una deriva de 1 microsegundo por segundo Resolvemos el problema por mnimos cuadrados como antes.
(106 ) dara errores del orden de 300 m/s! 34 / 48 36 / 48
Availability (%)
90
7.5 Deg. mask angle
70
5.0 Deg. mask angle
50 2.5 Deg. mask angle
30 0.0 Deg. mask angle
Navegacion por posicionamiento Disponibilidad, integridad, continuidad Navegacion por posicionamiento Disponibilidad,
10 integridad, continuidad
GNSS: Navegacion por satelite Sistemas de aumento: GPS diferencial GNSS: Navegacion por satelite Sistemas de aumento: GPS diferencial
1
GPS: Otros conceptos Calculo de la actitud GPS: Otros conceptos Calculo de la actitud
0.1
0 1 2 3 4 5 6 7 8 9 10
99.999 99.999
99.99
99.99
99.9
99.9
99
Availability (%)
90
Availability (%)
90
10
0.0 Deg. mask angle
30 0.0 Deg. mask angle
10
HDOP
6 7 8 9 10 0.1
0 1 2 3 4 5 6 7 8 9 10
Figure 7.8 Cumulative distribution of HDOP with 7.5, 5, 2.5, and 0 mask angles. PDOP
No obstante, la precision no es Figure 7.9 Cumulative distribution of PDOP with 7.5, 5, 2.5, and 0 mask angles.
99.999
el unico parametro por el que se 99.99 The threshold for the maximum acceptable DOP value is dependent on the
Los datos mostrados son para la constelacion nominal y para
99.9
desired accuracy level. The availability of GPS, therefore, will depend on the strin-
gency of the accuracy requirement. For this analysis, availability of GPS is chosen to
debe elegir un sistema de be defined as PDOP 6, which is commonly used as a service availability threshold
distintos angulos de mascara.
99
in the GPS performance standards [17].
navegacion.
Availability (%)
90
99.9
90 90
30
60
30
Availability (%)
90
50
22 Satellites
10
21 Satellites
30
60 60
30
0.1
definicion tpica de utilizable es que el usuario obtenga un 0 1 2 3 4 5
PDOP
6 7 8 9 10
150 120
1- to 5-minute outages
6- to 10-minute outages
90 60 30 0 30
de la Tierra, pero tambien hay que considerar el llamado esta disponible (por errores o reparaciones).
60 60
Mask angle: The elevation angle above the horizon at which satellites are con-
sidered visible by the GPS receiver.
Terrain mask: The azimuth and elevation of terrain (buildings, mountains,
angulo de mascara: el angulo de elevacion en el horizonte a Tpicamente fallan 1, 2 o 3 satelites; el 98 % del tiempo
30 30
and so on) that may block the satellite signal can be entered into the program
to ensure an accurate prediction.
Satellite outages: If any satellites are currently out of service, their status will
partir del cual los satelites se consideran visibles para el habra al menos 21 satelites.
0 0 be reflected in the almanac data. However, if satellites are scheduled for main-
tenance for a prediction date in the future, the software allows the user to
mark those satellites unusable. This data can be obtained from the USCG
receptor GPS.
30 30 NAVCEN Web site.
angulo tendra que considerarse mayor que en un entorno sin son respectivamente 100 %, 99.969 %, 99.903 % y 99.197 %.
150 120
1- to 5-minute outages
90 60 30 0
accidentes (p.ej. el mar). Las zonas sin disponibilidad se muestran en la derecha para el
Figure 7.13 Availability of the GPS constellation with a 5 mask angle with one satellite removed
from the constellation.
38 / 48 40 / 48
caso de 21 satelites.
rences of these during the day. The majority of the outages are 10 minutes or less.
This constellation provides an availability of 99.903%.
19
20
21
22
23
24
25
26 Dilution of
27 precision
28
29
Navegacion por posicionamiento Disponibilidad, integridad, continuidad
31
Navegacion por posicionamiento Disponibilidad, integridad, continuidad
GNSS: Navegacion por satelite Sistemas
GPS de aumento: GPS diferencial GNSS: Navegacion por satelite Sistemas de aumento: GPS diferencial
available
GPS: Otros conceptos Calculo de la actitud GPS: Otros conceptos Calculo de la actitud
0 2 4 6 8 10 12 14 16 18 20 22 24 GPS
Time of day (hours UTC)
GPS
31
orbital, como por ejemplo STK (que se usara en las practicas). 41 / 48 admisibles para aplicaciones de navegacion aerea. 43 / 48
available
0 2 4 6 8 10 12 14 16 18 20 22 24 GPS
Time of day (hours UTC)
Figure 7.19 Satellite visibility/availability over a 24-hour period with satellites 16, 25, and 26
removed from the constellation.
Navegacion por posicionamiento Disponibilidad, integridad, continuidad Navegacion por posicionamiento Disponibilidad, integridad, continuidad
GNSS: Navegacion por satelite Sistemas de aumento: GPS diferencial GNSS: Navegacion por satelite Sistemas de aumento: GPS diferencial
GPS: Otros conceptos Calculo de la actitud GPS: Otros conceptos Calculo de la actitud
plied by the total system. Integrity includes the ability of a system to provide valid
and timely warnings to the user, known as alerts, when the system must not be used
for the intended operation.
Continuidad Tecnicas de mejora de integridad
Puesto que la integridad es crtica para muchas aplicaciones,
Se define continuidad (continuity) de un sistema de como por ejemplo aviacion, se han implementando diversos
navegacion respecto a una mision u operacion, como la mecanismos para proporcionar integridad al GPS.
probabilidad de que dicho sistema sea utilizable de forma Las tecnicas de GSP diferencial (que veremos a continuacion)
continua por toda la duracion de dicha mision u operacion. pueden proporcionar integridad.
Utilizable se define respecto a los requisitos mnimos Una tecnica muy utilizada es la RAIM (Receiver Autonomous
Integrity Monitoring):
requeridos por la operacion o mision, puede venir dado en
Es un algoritmo incorporado al receptor.
terminos de PDOP u otros terminos. Requiere al menos cinco satelites visibles: detecta la
La continuidad depende mucho de la mision u operacion, pero inconsistencia de la solucion y avisa que el GPS no debe ser
en cualquier caso esta claramente relacionada con fallos no utilizado.
planificados de satelites. La probabilidad estimada de que un Para ello emplea tecnicas estadsticas de estimacion.
Si tiene al menos seis satelites visibles, es capaz de ignorar el
satelite deje de emitir de forma no planificada, es del
satelite y seguir proporcionando datos de navegacion fiables.
0.0001 %.
Observese que puesto que RAIM requiere 5 o 6 satelites, la
disponibilidad y continuidad con RAIM sera menor en general.
42 / 48 44 / 48
Navegacion por posicionamiento Disponibilidad, integridad, continuidad Navegacion por posicionamiento Disponibilidad, integridad, continuidad
GNSS: Navegacion por satelite Sistemas de aumento: GPS diferencial GNSS: Navegacion por satelite Sistemas de aumento: GPS diferencial
GPS: Otros conceptos Calculo de la actitud GPS: Otros conceptos Calculo de la actitud
h = VD ,
e
V D = z + ,
(Re + h)2
3 / 26
Sistemas de navegacion integrados Fusion de sensores. Ejemplo: el canal vertical. Sistemas de navegacion integrados Fusion de sensores. Ejemplo: el canal vertical.
Filtrado optimo de sistemas lineales: el filtro de Kalman. INS-GPS Filtrado optimo de sistemas lineales: el filtro de Kalman. INS-GPS
Sistemas de navegacion integrados Fusion de sensores. Ejemplo: el canal vertical. Sistemas de navegacion integrados Fusion de sensores. Ejemplo: el canal vertical.
Filtrado optimo de sistemas lineales: el filtro de Kalman. INS-GPS Filtrado optimo de sistemas lineales: el filtro de Kalman. INS-GPS
Sistemas de navegacion integrados Deduccion del filtro de Kalman. Ecuaciones. Sistemas de navegacion integrados Deduccion del filtro de Kalman. Ecuaciones.
Filtrado optimo de sistemas lineales: el filtro de Kalman. Ejemplo de un filtro de Kalman Filtrado optimo de sistemas lineales: el filtro de Kalman. Ejemplo de un filtro de Kalman
Sistemas de navegacion integrados Deduccion del filtro de Kalman. Ecuaciones. Sistemas de navegacion integrados Deduccion del filtro de Kalman. Ecuaciones.
Filtrado optimo de sistemas lineales: el filtro de Kalman. Ejemplo de un filtro de Kalman Filtrado optimo de sistemas lineales: el filtro de Kalman. Ejemplo de un filtro de Kalman
Simplificando, obtenemos:
Observacion: es posible que no se realice una medida cada tk ,
h
+
Pk+1 = E
(I Kk+1 Hk+1 )(x(tk+1 ) x ) Kk+1 (tk+1 ) sino que en ciertos instantes se hagan medidas, y en otros no
T
(I Kk+1 Hk+1 )(x(tk+1 ) x ) Kk+1 (tk+1 )
se haga ninguna medida.
=
(I Kk+1 Hk+1 )Pk+1 (I Kk+1 Hk+1 )
T
+ Kk+1 Rk+1 Kk+1
T Por ejemplo podemos tener un sensor con bajo ancho de
banda (como el GPS) mientras que nuestro tiempo de
Es necesario encontrar el valor de Kk+1 que minimiza la muestreo t representa una elevada frecuencia.
anterior expresion. Usando calculo matricial, se encuentra que Una forma de solucionarlo es tomar Hk = 0, luego Kk = 0 en
T
" T +R
#1
Kk+1 = Pk+1 Hk+1 Hk+1 Pk+1 Hk+1 k+1 los instantes tk en los que no se realizan medidas. Por tanto
Sustituyendo esta expresion se llega a que: no es necesario realizar ninguna actualizacion y
+
Pk+1 = (I Kk+1 Hk+1 )Pk+1
. Esta es la covarianza mnima. x + (tk ) = x (tk ), P + (tk ) = P (tk ).
14 / 26 16 / 26
Sistemas de navegacion integrados Deduccion del filtro de Kalman. Ecuaciones. Sistemas de navegacion integrados Deduccion del filtro de Kalman. Ecuaciones.
Filtrado optimo de sistemas lineales: el filtro de Kalman. Ejemplo de un filtro de Kalman Filtrado optimo de sistemas lineales: el filtro de Kalman. Ejemplo de un filtro de Kalman
eran errores de posicion (y velocidad, si tambien estimamos El modelo del error sera:
velocidad) respecto a una estimacion inicial y (tk+1 ) las d x
=
0 1 x
+
0
a
dt v 0 0 v 1
diferencias entre los observables medidos y los estimados.
Por tanto usando la medida del INS como estimacion para el Pasando a tiempo discreto y teniendo en cuenta que
d x(tk+1 )x(tk )
GPS, ya tenemos los errores linealizados escritos de una forma dt x(t) t :
adecuada para implementar el filtro de Kalman!
x(tk+1 )
1 t
x(tk )
0
= + a(tk )
El error estimado se suma a la posicion estimada por el INS, v (tk+1 ) 0 1 v (tk ) t
Sistemas de navegacion integrados Deduccion del filtro de Kalman. Ecuaciones. Sistemas de navegacion integrados Deduccion del filtro de Kalman. Ecuaciones.
Filtrado optimo de sistemas lineales: el filtro de Kalman. Ejemplo de un filtro de Kalman Filtrado optimo de sistemas lineales: el filtro de Kalman. Ejemplo de un filtro de Kalman
Ejemplo 1-D del filtro de Kalman III Ejemplo 1-D del filtro de Kalman: simulacion II
Por tanto las ecuaciones del filtro de Kalman diran, para cada
instante de tiempo tk+1 :
('! *
(!!
x (tk+1 )
=
1 0,01 x + (tk ) "'!
Usando las medidas para estimar la posicion, el resultado es
v (tk+1 ) 0 1 v + (tk ) "!!
1 0,01
1 0
0
&'!
bueno porque el sensor es preciso y el movimiento en x es
+
Pk+1 = Pk + 0,1 0 0,01
0 1 0,01 1 0,01 &!!
lento.
'!
Si tk+1 = n, es decir, tiene un valor entero, significa que ha ! Si intentamos estimar la velocidad con la formula ,-./0/-1
1
!'!*
!
v (tk ) = k t k1 se obtiene una estimacion muy mala:
"! #! $!
)
%! &!! &"!
1 0
Kk+1 = Pk+1 0 1 Pk+1 + 0,01 .
0 1
Tomamos la medida y calculamos la estimacion a posteriori: %
+
637-0/454
*
6*3.)/2545*43*234/45.
+
x (tk+1 ) x (tk+1 ) x (tk+1 ) $
= + Kk+1 (z(tk+1 ) 1 0 ,
v + (tk+1 ) v (tk+1 ) v (tk+1 ) '
#
+
Pk+1 = (I Kk+1 1 0 )Pk+1 . (
"
!"*
! "! #! $! %! &!! &"!
x + (tk+1 ) x (tk+1 ) +
)
= , Pk+1 = Pk+1 .
v + (tk+1 ) v (tk+1 )
Sistemas de navegacion integrados Deduccion del filtro de Kalman. Ecuaciones. Sistemas de navegacion integrados Deduccion del filtro de Kalman. Ecuaciones.
Filtrado optimo de sistemas lineales: el filtro de Kalman. Ejemplo de un filtro de Kalman Filtrado optimo de sistemas lineales: el filtro de Kalman. Ejemplo de un filtro de Kalman
Ejemplo 1-D del filtro de Kalman: simulacion I Ejemplo 1-D del filtro de Kalman: simulacion III
Simulacion de la posicion (exacta) y medidas: Comportamiento de la estimacion y del error sin filtro de
Kalman:
('!
+,-./.,0
*
#!! )
123.34-
*+,-.-+/
'!! 0,(-12.-+/)30)*+,-.-+/
(!!
"!!
"'!
&!!
"!!
!)
! "! #! $! %! &!! &"!
(
&'!
% )
&!! 405+.-323
$ 0,(-12.-+/)30)405+.-323
'!
#
"
!*
! "! #! $! %! &!! &"!
) !
!")
! "! #! $! %! &!! &"!
22 / 26 24 / 26
(
Sistemas de navegacion integrados Deduccion del filtro de Kalman. Ecuaciones.
Filtrado optimo de sistemas lineales: el filtro de Kalman. Ejemplo de un filtro de Kalman
'!!
"!!
&!! *+,-.-+/
0,(-12.-+/)30)*+,-.-+/)4567
!)
! "! #! $! %! &!! &"!
(
$ )
"
! 809+.-323
0,(-12.-+/)30)809+.-323)4567
!")
! "! #! $! %! &!! &"!
25 / 26
(
#! )
,--.-)/,)0.1232.4)5124)678
'! ,--.-)/,)0.1232.4)53.4)678
"!
&!
!)
! "! #! $! %! &!! &"!
(
&*+ )
,--.-)/,)9,:.32/;/)5124)678
,--.-)/,)9,:.32/;/)53.4)678
&
!*+
!)
! "! #! $! %! &!! &"!
(
26 / 26