Top Banner
Sistemadenavegaci´onaut´onomo:Navegaci´oninercial. Errores en navegaci´ on inercial. Modelos de Error Navegaci´onA´ erea Tema 4: Sistema de navegaci´ on aut´ onomo. Navegaci´ on inercial. Errores.
57

Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Oct 12, 2018

Download

Documents

lamxuyen
Welcome message from author
This document is posted to help you gain knowledge. Please leave a comment to let me know what you think about it! Share it to your friends and learn new things together.
Transcript
Page 1: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Navegacion AereaTema 4: Sistema de navegacion autonomo. Navegacion inercial.

Errores.

Page 2: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Sistema de navegacion autonomo: Navegacion inercial.

La navegacion autonoma es aquella que no depende demedidas externas y por tanto no es susceptible a interferencias(accidentales o provocadas) ni a manipulacion o error externo.

El ejemplo mas temprano es la navegacion a estima que ya sevio en la introduccion historica. En aviacion se emplea lanavegacion inercial.

El objeto de la navegacion inercial es determinar la posicion,velocidad y actitud de la aeronave, con la mayor precisionposible, a partir de las medidas de la IMU (InertialMeasurement Unit).

La IMU se compone de sensores inerciales: giroscopos yacelerometros.

Para la navegacion inercial, ademas de la IMU, es necesariauna estimacion inicial (fix) de posicion, velocidad y actitud, yun modelo gravitatorio.

2 / 57

Page 3: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Historia de la navegacion inercial I

Historicamente la navegacion inercial no nace hasta el sigloXX.Sus antecedentes se encuentran en la navegacion a estima (yaestudiada) y en la invencion de los primeros giroscopos.Los giroscopos se inventaron en el siglo XIX; fue Leon Focaultquien les dio su nombre, popularizandolo gracias a unexperimento (fracasado) en el que los uso para tratar dedemostrar la rotacion de la Tierra.

Un giroscopo mantiene su eje de rotacion (en elespacio inercial) frente a perturbaciones. Este efectose conoce como rigidez giroscopica.Dichas perturbaciones generan un movimiento deprecesion y nutacion, que se puede medir.Por ejemplo, al forzar la rotacion de un giroscopo enun eje distinto a su eje de giro, se produce un efectoque permite estimar la velocidad de rotacion.

3 / 57

Page 4: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Historia de la navegacion inercial II

Por tanto los giroscopos tienen un eje en tornoal cual giran permanentemente, otro eje en elcual se detectan perturbaciones y otro eje en elcual se miden dichas perturbaciones.Las plataformas giroestabilizadas se basan eneste fenomeno, son plataformas insensibles aperturbaciones que permiten diversasaplicaciones, como por ejemplo emplear unacamara de television en un helicoptero.Otra aplicacion del efecto es el girocompas obrujula giroscopica, que permite encontrar elNorte geografico.

Modernamente, se emplean giroscopos nomecanicos, mas sofisticados que empleandiversos efectos fısicos.

4 / 57

Page 5: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Historia de la navegacion inercial IIIEn la II Guerra Mundial, se emplearongiroscopos y acelerometros por primera vez,para guiar misiles V-2.

La invencion de este sistema de guiado se debea un estadounidense, Robert Goddard.

Tras la guerra, hubo un rapido desarrollo. Losprimeros sistemas de navegacion inercialconsistıan en una triada de acelerometros ygiroscopos montados en una plataforma, capazde rotar y orientarse con libertad.

Se disena la plataforma de manera que siempremantenga su orientacion respecto a un sistemade referencia dado (g o n).

Por tanto medimos directamente anNG y Cnb .

Estos sistemas a veces se llamansemianalıticos. 5 / 57

Page 6: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Historia de la navegacion inercial IV

Estos sistemas son funcionales en cualquier sitio de laTierra: tierra, aire, oceanos, bajo el agua...

Con navegacion inercial el submarino USS Nautiluscruzo bajo el hielo y paso por el polo Norte en 1958.

Sin embargo es muy costoso, contiene elementos mecanicosque se desgastan, requiere una perfecta alineacion inicial(lenta), y presenta problemas de bloqueo de los gimbals(gimbal lock) si se alinean los ejes de rotacion.

El sistema inercial mas sofisticado que se creo fue elAIRS-Advanced Inertial Reference Sphere, que consiste enuna esfera hueca con un fluido donde flota otra esfera congiroscopos y acelerometros.

Mantiene (mediante inyeccion de chorros) siempre una referenciainercial, con lo que se mide aiNG (que se puede integrardirectamente) y C b

i . Por esto se llama geometrico o analıtico.Su coste era enorme, pero se obtiene una gran precision, con unaderiva de 10−5 grados por hora (1,15o por ano). Se uso en misilesbalısticos y en bombarderos. 6 / 57

Page 7: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Historia de la navegacion inercial V

En 1956 se patenta la idea del INS “strapdown”, es decir, fijo(fijado al cuerpo).

En este caso los sensores inerciales miden las magnitudes enejes cuerpo, es decir, ωb

b/i y abNG . Este tipo se sistema INS sedenomina “analıtico” o de plataforma analıtica, porquerealmente no existe una plataforma y todo se realiza mediantecalculo numerico.

Requiere el uso de ordenadores de gran capacidad de computoy de sensores precisos (por las vibraciones). Eso solo fueposible a partir de los 70.

Hoy en dıa es el unico que se usa en la practica.

Ademas, gracias a la navegacion integrada (complementar elINS con otros sistemas como el GPS) se pueden emplearsensores de baja calidad, con lo que el coste se ha abaratadoenormemente.

7 / 57

Page 8: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

La IMU: sensores inerciales.

Una IMU consta de giroscopos y acelerometros. Estosdispositivos han sido estudiados en otras asignaturas.Un modelo tıpico de medida serıa: m = (1 + σ)m + b + ξ,donde m es la medida obtenida del valor real m, σ es el factorde escala, b es el sesgo y ξ es ruido de medida. Estos valoresse pueden calibrar pero estan sujetos a variaciones.Las principales caracterısticas de estos dispositivos son:

Ancho de banda: determina la frecuencia maxima deaceleracion o giro que son capaces de detectar. Se asimila a la“velocidad” maxima con la que se toman medidas.Rango de medicion.Supervivencia a choques.Ruido (en unidades de medida por

√Hz). Mide ξ. Se puede

usar para calcular como se degrada la medida acumulada.Inestabilidad del sesgo (en unidades de medida). Mide el ruidoaleatorio que entra en b.Inestabilidad del factor de escala (en porcentaje). Mide el ruidoaleatorio que entra en σ. 8 / 57

Page 9: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Acelerometros.

Precisiones tıpicas de acelerometros:

9 / 57

Page 10: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Giroscopos

Precisiones tıpicas de giroscopos (RLG=Ring Laser Gyro,FOG=Fibre Optic Gyro, MEMS=Micro-Electro-MechanicalSystems).

10 / 57

Page 11: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Los acelerometros y la gravedad I

Un acelerometro no puede medir g .

Principio de funcionamiento de un acelerometro: medir eldesplazamiento de una masa testigo. Ejemplo con muelle:

Se cumple que mx = F − kx , donde k es la constante delmuelle y F la fuerza en la direccion del eje. Puesto queF = ma, donde a es la aceleracion en la direccion del eje, setiene que a = k/m · x + x .

Suponiendo que a es aproximadamente constante, x tiende auna posicion de equilibrio que cumple a = k/m · x , y portanto a es proporcional a x .

Otros acelerometros mas sofisticados no requieren esperar aque se llegue al estado de equilibrio, por ejemplo compensandoF con una fuerza contraria para que nunca se desplace x .

11 / 57

Page 12: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Los acelerometros y la gravedad II

¿Que sucede si el eje esta en la misma direccion de lagravedad?

Supongamos que el objeto esta en caıda libre. Para aplicar laLey de Newton tenemos que estar en un sistema de referenciainercial, pero puesto que el objeto esta en caıda libre, tenemosque tener en cuenta que el sistema de referencia fijo en elcuerpo es no inercial!Por tanto: m(x − g) = F − kx . Por otro ladoF = m(aNG − g). Por tanto, en el equilibrio: aNG = k/m · x .

12 / 57

Page 13: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Los acelerometros y la gravedad III

¿Es cierto pues que un acelerometro no puede medir lagravedad?Es cierto que un acelerometro no puede medir g directamente.En estado de caıda libre en cualquier punto de la atmosfera (oen la Luna) sentirıa la misma aceleracion: cero.Sin embargo, en reposo sobre la superficie de la Tierra (porejemplo un acelerometro sobre una mesa), existe una fuerzade reaccion R = −g , es decir, R = g (apunta “hacia arriba”).Por tanto aNG = g y se tiene g = k/m · x . Es por tanto unamedida “indirecta” de la gravedad.La definicion correcta de acelerometro es “un dispositivo quemide desviaciones del estado de caıda libre”.Observese que la aceleracion debida al geopotencial(anadiendo la rotacion de la Tierra) tiene exactamente elmismo caracter que la gravitatoria y por tanto no se puedemedir (directamente).

13 / 57

Page 14: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Mecanizacion en ejes n I

En este tema supondremos, para simplificar, que n = g , y quela Tierra es esferica.Mecanizar las ecuaciones quiere decir escribirlas en el sistemade referencia apropiado y de forma que se puedan calcular apartir de las entradas.Partimos de las ecuaciones fundamentales de la navegacion:

Velocidad: ddt v

n = −(ωnn/e + 2ωn

e/i

)×vn + anNG + gn

Actitud: C bn = −

(ωbb/n

)×C bn

Posicion:

φ =vN

Re + h

λ =vE

cφ(Re + h)

h = −vD

Donde sabemos ademas que: ωne/i = [ωEcφ 0 − ωE sφ]T y

ωnn/e = [ vE

Re+h −vN

Re+h −vE tanφRe+h ]T .

14 / 57

Page 15: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Mecanizacion en ejes n II

Tambien disponemos de un modelo de gravedad:gn ' [0 0 g(h)]T , donde g(h) = µe

(Re+h)2 .

Ademas nuestra IMU nos proporcionara las medidas de lossensores inerciales: abNG y ωb

b/i . Observese que estas no son lasmagnitudes que aparecen en las ecuaciones fundamentales dela navegacion: necesitamos anNG y ωb

b/n.

Se tiene que anNG = Cnb a

bNG = (Cb

n )TabNG .Y se tiene que

ωbb/n = ωb

b/i − ωbe/i − ω

bn/e = ωb

b/i − Cbn

(ωne/i + ωn

n/e

).

Recordemos que por tanto:(ωbb/n

)×=(ωbb/i

)×− Cb

n

(ωne/i + ωn

n/e

)×(Cb

n )T

Por tanto las ecuaciones fundamentales de la navegacion develocidad y actitud se modifican:

Velocidad: ddt v

n = −(ωnn/e + 2ωn

e/i

)×vn + (C b

n )TabNG + gn

Actitud: C bn = −

(ωbb/i

)×C bn + C b

n

(ωne/i + ωn

n/e

)×15 / 57

Page 16: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Mecanizacion en ejes n III

Ya disponemos pues de todo lo que necesitamos y podemosesquematizarlo en el siguiente diagrama de bloques:

IMU

)Á;¸;h(

n

|g

e=in

|!;n=e

n

|!

nbC

b=ib

|!

NGb

|a

n

|v

Calculo devel. angulares

Modelogravitatorio

CalculoActitud

posicionCalculo

velocidadCalculo

16 / 57

Page 17: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Mecanizacion en ejes e

En ocasiones, por motivos de integracion INS-GPS, convienemecanizar las ecuaciones en los ejes e (en los que trabaja elGPS).

Se llega a las siguientes ecuaciones para velocidad y posicion:

Velocidad: ddt v

e = −2(ωee/i

)×v e + aeNG + g e =

−2(ωee/i

)×v e + (C n

e )T (C bn )TabNG + g e

Posicion: ddt r

e = v e .

Habrıa que escribir Cne en funcion de r e y v e , escribir un

modelo de g e , y escribir la ecuacion de la actitud, y se llegarıaa un esquema similar al anterior.

17 / 57

Page 18: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Alineamiento inicial I

Supongamos que tenemos el avion en reposo en unaeropuerto, y es necesario inicializar el INS con un “fix”.¿Como se harıa?Evidentemente, se tiene que φ, λ y h son las del aeropuerto, oincluso con mayor precision, las tomadas de un sistema GPS.Puesto el avion esta en reposo, vn = 0.Queda encontrar el valor inicial de actitud, es decir,Cbn (t = 0). Para ello se usa la medida obtenida de giroscopos

y acelerometros (en reposo).De la ecuacion fundamental de la navegacion se tiene:

0 = −(ωnn/e + 2ωn

e/i

)×0 + anNG + gn, luego anNG = −gn y

por tanto abNG = Cbn a

nNG = −Cb

n gn.

Por otro lado es claro que ωbb/n = ωb

b/i − ωbe/i − ω

bn/e y

evidentemente ωbb/n = 0 y ωb

n/e = 0.

Por tanto:ωbb/i = ωb

e/i = Cbn ω

ne/i . 18 / 57

Page 19: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Alineamiento inicial II

Tenemos por tanto dos ecuaciones: abNG = −Cbn g

n y

ωbb/i = Cb

n ωne/i . Llamando a las medidas xb1 = abNG y

xb2 = ωbb/i , y denotando los modelos como yn

1= −gn y

xn2 = ωne/i , se tiene que

xn1 = Cbn (0)yb

1, xn2 = Cb

n (0)yb2

Tendrıamos 6 medidas (las componentes de dos vectores) para9 grados de libertad (las entradas de la matriz).

Es necesario pues “generar” una medida adicionalindependiente.

19 / 57

Page 20: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

La IMU: sensores inercialesMecanizacion en ejes n y en ejes eAlineamiento inicial

Alineamiento inicial III

Llamemos x3 = x1 × x2. Observese que este vector se puede

escribir como(xb1)×

xb2 en el sistema de referencia b, donde Xes la matriz antisimetrica que representa el producto vectorial.

Por otro lado se tiene que(xb1)×

= Cbn (0)

(yn

1

)×Cnb (0). Por

tanto xb3 =(xb1)×

xb2 = Cbn (0)

(yn

1

)×Cnb (0)Cb

n (0)yn2

=

Cbn (0)

(yn

1

)×yn

2. Por tanto denotando y

3= y

1× y

2, se tiene

que xb3 = Cbn (0)yn

3.

Escribiendo la matriz A como la matriz cuyas columnas sonxb1, xb2 y xb3, y la matriz B como la matriz cuyas columnas sonyn

1, yn

2y yn

3, se tiene: A = Cb

n (0)B y por tanto Cbn (0) = AB−1.

No se han tenido en cuenta los errores de medida: Cbn (0)

probablemente no saldrıa ortonormal (habrıa que emplear unalgoritmo mas sofisticado que tuviera en cuenta los errores demedida).

20 / 57

Page 21: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Errores en navegacion inercial.

Si conocieramos con total precision las condiciones iniciales, elmodelo de gravedad fuera perfecto, y los sensores inerciales nocometieran errores de medida, entonces la navegacion inercialserıa totalmente exacta.No obstante, esto no es ası, y cada uno de los terminosmencionados contiene errores.

Errores en condiciones iniciales.Errores en el modelo de gravedad δgn.Errores en los sensores inerciales. Para simplificar losagruparemos en un unico valor: δabNG , δωb

b/i .

La navegacion inercial realiza integracion de ecuacionesdiferenciales, luego estos errores se van acumulando.Es importante tener un modelo del error para saber comocrece, para cuantificarlo, para aplicar medidas que permitandisminuirlo (como integracion con otros sensores), paradescubrir que sensores son mas crıticos (analisis desensibilidad), etc... 21 / 57

Page 22: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Variables de error.

En general, para una variable cualquiera de navegacion x , sedenota con x el valor estimado con el INS.Puesto que este valor no sera exacto se define el error comoδx = x − x .Error en posicion: las variables de posicion son φ, λ y h. Lasvariables estimadas seran φ, λ, h. Definimos el error enposicion δp como δp = [δφ δλ δh]T = [φ− φ λ− λ h− h]T .Error en velocidad: igualmente se define δvn = vn − vn, dondevn es la velocidad calculada por el INS.Para la actitud, ¿como definir un error en la matriz de actitudδCb

n ? No serıa correcto considerar una matriz de nuevecoeficientes pequenos ya que no necesariamente serıa unamatriz de actitud.En su lugar, supongamos que el INS estima una actitud de losejes cuerpo b que, al no ser exactamente la real, denotaremospor b.

22 / 57

Page 23: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Error de actitud.

Por tanto, realmente Cbn = C b

n , donde se tiene que:

n(ψ,θ,ϕ)−→ b

δφx−→xb

S1δφy−→yS1

S2δφz−→zS2

b

Se tiene entonces Cbn = Cb

bC bn , por analogıa con las

definiciones anteriores definimosδCb

n = Cbn − Cb

n = CbbCbn − Cb

n = (Cbb− Id)Cb

n .

Suponiendo que los errores δφ = [δφx δφy δφz ]T son

pequenos, se vio que C bb = Id− δφ×, donde como siempre:

δφ× =

0 −δφz δφyδφz 0 δφx−δφy δφx 0

Por tanto, la ecuacion que define la “matriz de error” δCb

n esδCb

n = (Id− δφ× − Id)Cbn = −δφ×Cb

n .Y se tiene

Cbn = (Id− δφ×)Cb

n .23 / 57

Page 24: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Ecuaciones de propagacion del error

Se quiere estudiar como evoluciona el error del INS con eltiempo. Para ello, es necesario encontrar el modelo depropagacion del error.

Este modelo se encuentra directamente de las ecuaciones dela navegacion inercial, suponiendo que los errores sonpequenos, con lo que las ecuaciones se pueden linealizar.

Por ejemplo, supongamos que x es una variable que el INSestima como x . La ecuacion que verifica x sera x = f (x). ElINS lo que hara sera calcular x a partir de ˙x = f (x). Portanto: δx = x − ˙x = f (x)− f (x) = f (x + δx)− f (x).

Desarrollando esta expresion en serie de Taylor y quedandonosel termino constante y el lineal: f (x + δx) ' f (x) + ∂f

∂x |x=xδx .

Por tanto llegamos a la siguiente expresion: δx = ∂f∂x |x=xδx ,

que es aproximada y solo sirve para δx pequeno.

24 / 57

Page 25: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Propagacion del error en posicion I

Se tiene que las ecuaciones de la posicion son:

φ =vN

Re + h

λ =vE

cφ(Re + h)

h = −vD

Por tanto el INS calculara:

˙φ =

vN

Re + h

˙λ =

vE

cφ(Re + h)

˙h = −vD

Aplicando la teorıa antes desarrollada, por ejemplo, para h:

δh = h − ˙h = −vD + vD = −δvD. Como la ecuacion ya eralineal no hubo que linealizar.

25 / 57

Page 26: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Propagacion del error en posicion II

Para la latitud: δφ = φ− ˙φ = vNRe+h −

vNRe+h

= vN+δvNRe+h+δh

− vNRe+h

.

Desarrollando en serie de Taylor y quedandonos hasta eltermino lineal: vN+δvN

Re+h+δh= vN

Re+h+ 1

Re+hδvN − vN

(Re+h)2δh

Por tanto: δφ = 1Re+h

δvN − vN(Re+h)2

δh.

Operando igualmente con la longitud:

δλ = 1cφ(Re+h)

δvE − vEcφ(Re+h)2

δh + vE tan φ

cφ(Re+h)δφ

Poniendolo todo en una matriz:

δp =d

dt

δφδλδh

=

0 0 − vN

(Re+h)21

Re+h0 0

vE tan φ

cφ(Re+h)0 − vE

cφ(Re+h)2 0 1cφ(Re+h)

0

0 0 0 0 0 −1

δφδλδhδvNδvEδvD

26 / 57

Page 27: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Propagacion del error en posicion III

El resultado se puede escribir abreviadamente comoδp = Cppδp + Cpvδv

n, donde:

Cpp =

0 0 − vN

(Re+h)2

vE tan φ

cφ(Re+h)0 − vE

cφ(Re+h)2

0 0 0

,

Cpv =

1

Re+h0 0

0 1cφ(Re+h)

0

0 0 −1

27 / 57

Page 28: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Errores en velocidad angular

Para repetir el procedimiento con las ecuaciones de velocidady actitud necesitamos antes encontrar el error en ωn

e/i y enωnn/e que denotaremos como δωn

e/i y δωnn/e .

En primer lugar se tiene que:

ωne/i =

ωEcφ0

−ωE sφ

→ δωne/i =

−ωE sφ0

−ωEcφ

δφ

Por otro lado: ωnn/e =

vE

Re+h

− vNRe+h

− vE tan φ

Re+h

, por tanto:

δωnn/e =

1

Re+hδvE − vE

(Re+h)2δh

− 1Re+h

δvN + vN(Re+h)2

δh

−1 tan φ

Re+hδvE + vE tan φ

(Re+h)2δh − vE(1+tan2 φ)

Re+hδφ

28 / 57

Page 29: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Propagacion del error en velocidad I

Las ecuaciones de la velocidad que calcula el INS seran:ddt v

n = −(ωnn/e + 2ωn

e/i

)×vn + (Cb

n )T abNG + gn

Por tanto las ecuaciones del error seran:

d

dtδvn = −

(δωn

n/e + 2δωne/i

)×vn −

(ωnn/e + 2ωn

e/i

)×δvn

+(δCbn )T abNG + (Cb

n )T δabNG + δgn

Recordemos que δCbn = −δφ×Cb

n . Los otros terminos los

hemos calculado, excepto δabNG (el error en los acelerometros)y δgn (el error en el modelo gravitatorio).

Puesto que

gn '

00µe

(Re+h)2

→ δgn =

00

− 2µe(Re+h)3

δh + δGn, donde

δGn son errores en el modelado gravitatorio.29 / 57

Page 30: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Propagacion del error en velocidad II

Por tanto podremos escribir, como en el caso de la posicion,δvn = Cvpδp + Cvvδv

n + Cvφδφ+ CaδabNG + δGn.

Es una ecuacion lineal en los errores, donde las matrices estandefinidas en funcion de la estimacion del INS, y con dosterminos forzantes: el error en los acelerometros δabNG y elerror en el modelo gravitatorio δGn.

30 / 57

Page 31: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Propagacion del error en actitud I

Finalmente, calculamos el error en actitud. Recordemos eldiagrama considerando una actitud estimada intermedia b:

n(ψ,θ,ϕ)−→ b

δφx−→xb

S1δφy−→yS1

S2δφz−→zS2

b

La actitud real verifica Cbn = −

(ωbb/n

)×Cbn y la actitud

estimada verifica ˙Cbn = C b

n = −(ωbb/n

)×Cbn . Por tanto

ωbb/n = ωb

b/n. ¿Cual es la definicion entonces de δωb

b/n?

Tenemos que definir el error como la realidad menos la

estimacion: δωbb/n = ωb

b/n − ωbb/n

. Pero son dos vectores que

no estan en la misma base!! (sı en una base muy parecida).Descomponemos ωb

b/n = ωbb/b

+ ωbb/n

y escribimos

ωbb/n

= Cbbωbb/n

=(Id− δφ×

)ωbb/n

, llegando a:

δωbb/n = ωb

b/b+(Id− δφ×

)ωbb/n− ωb

b/n= ωb

b/b− δφ×ωb

b/n. 31 / 57

Page 32: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Propagacion del error en actitud II

Puesto que los angulos son muy pequenos, se tieneδφ = ωb

b/b. Por tanto llegamos a δωb

b/n = δφ− δφ×ωbb/n.

Por tanto finalmente la ecuacion del error de actitud δφ queda

como δφ = δωbb/n + δφ×ωb

b/n.Para finalizar hay que expresar todo en funcion de la velocidadangular b/i , que es la que mide el giroscopo. En primer lugar,

ωbb/n = ωb

b/i − Cbn

(ωne/i + ωn

n/e

). Tomando error en esta

ecuacion:δωb

b/n = δωbb/i − δC

bn

(ωne/i + ωn

n/e

)− Cb

n

(δωn

e/i + δωnn/e

).

Por tanto la ecuacion del error de actitud δφ queda:

δφ = δωbb/i + δφ×Cb

n

(ωne/i + ωn

n/e

)− Cb

n

(δωn

e/i + δωnn/e

)+δφ×ωb

b/i − δφ×Cb

n

(ωne/i + ωn

n/e

)= δωb

b/i − Cbn

(δωn

e/i + δωnn/e

)+ δφ×ωb

b/i 32 / 57

Page 33: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Propagacion del error del INS.

Por tanto podremos escribir, como antes,δφ = Cφpδp + Cφvδv

n + Cφφδφ+ δωbb/i .

Es una ecuacion lineal en los errores, donde las matrices estandefinidas en funcion de la estimacion del INS, y con unterminos forzante: el error en los giroscopos δωb

b/i .Si ponemos todos los errores juntos, llegamos a:

d

dt

δp

δvn

δφ

=

Cpp Cpv 0Cvp Cvv Cvφ

Cφp Cφv Cφφ

δp

δvn

δφ

+

0Caδa

bNG + δGn

δωbb/i

Ademas estaran los errores en condiciones iniciales: δp

δvn

δφ

(t = 0).

Este es el modelo de propagacion del error del INS. Puestoque el termino forzante es desconocido (y se modela mediantela estadıstica) es una ecuacion diferencial estocastica. 33 / 57

Page 34: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Ecuacion del error en el canal vertical I

Si trabajamos solo con el error en h y VD , y despreciamostodos los terminos excepto el gravitatorio, llegamos a lasiguiente ecuacion:

δh = −δVD

δVD ' −2µe

(Re + h)3δh.

Por otro lado podemos aproximar en el denominadorRe + h ' Re . Teniendo en cuenta que la aceleracion de lagravedad al nivel del mar g0 = µe

R2e

, tendrıamos las ecuaciones:

δh = −δVD

δVD ' −2g0

Reδh.

Escribiendolo como una unica ecuacion para δh: δh = 2g0Reδh.

34 / 57

Page 35: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Variables de error. Error en actitudModelo de propagacion linealizadoEl canal vertical

Ecuacion del error en el canal vertical II

La solucion de la ecuacion diferencial es:

δh = C1e

√2g0Re

t+ C2e

−√

2g0Re

t, donde las constantes son funcion

de las condiciones iniciales de altura y velocidad vertical.

Estas ecuaciones son inestables! El primer termino crece hastael infinito.

Fısicamente, lo que sucede es lo siguiente: si hay un error dealtitud, p.ej. el INS piensa que el avion esta mas alto de loque realmente esta, el modelo de gravedad predice que lagravedad es menor de lo que es, con lo que el INS predice queel avion se eleva, es decir, el error inicial se amplifica!

Este resultado se mantiene si no se desprecian los terminosque no se han considerado. Por tanto el canal vertical del INSes inestable y no se puede usar por sı solo; empleando otrasmedidas (p.ej. barometricas) es posible compensar el canalvertical y obtener una medida fiable de la altura.

35 / 57

Page 36: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Fuentes de Error

Hemos visto que las ecuaciones de propagacion del error sondel tipo δx = A(x)δx + δε, donde δx son las variables denavegacion (posicion, velocidad, actitud) y los δε las fuentesde error. Estas fuentes son:

Errores en el modelo de gravedad δgn.

Errores en los sensores inerciales δabNG , δωbb/i .

Aparte esta el error en las condiciones iniciales δx(t0).

Si discretizamos estas ecuaciones en el tiempo, podrıamosescribir un modelo algo mas sencillo:δx(tk+1) = A(tk)δx(tk) + δε(tk).

¿Como se modelan los errores? ¿Como se interpretan lasecuaciones que contienen errores?

Para responder a estas preguntas es necesario recordaralgunos conceptos estadısticos.

36 / 57

Page 37: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Descripcion estadıstica del error

Consideremos por ejemplo el caso del error de medida de unacelerometro: abNG = abNG + δabNG , donde δabNG son errores demedida.

Una componente de δabNG , por ejemplo δax , puede tener elsiguiente aspecto:

Es imposible conocer el valor con exactitud.

Se observa que cambia con el tiempo.

Por tanto, se representan sus propiedades usando laestadıstica.

37 / 57

Page 38: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Variables aleatorias continuas unidimensionales

Sea una variable aleatoria X ∈ R continua.

Recordemos que la funcion de distribucion F (x) es laprobabilidad de que X ≤ x , que se escribe comoF (x) = P(X ≤ x).

La funcion de distribucion se calcula mediante la funcion dedensidad f (x): F (x) =

∫ x−∞ f (y)dy .

Se define el operador esperanza matematica actuando sobre lafuncion g(x) como E [g(X )] =

∫∞−∞ g(y)f (y)dy . Se trata de

un operador lineal, de forma queE [α1g1(X ) + α2g2(X )] = α1E [g1(X )] + α2E [g2(X )]. Los doscasos importantes son:

Media: m(X ) = E [X ] =∫∞−∞ yf (y)dy .

Varianza: V (X ) = E [(X −m(X ))2] = E [X 2]− (E [X ])2.Desviacion tıpica σ, la raız cuadrada de la varianza,σ =

√V (X ).

38 / 57

Page 39: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Distribucion normal o gaussiana I

Es la distribucion mas usada en estadıstica. Se escribeX ∼ N(m, σ2) y su funcion de densidad es

f (x) = 1σ√

2πExp

(− (x−m)2

2σ2

).

Intervalos de confianza: si X ∼ N(m, σ2):

Intervalo 1-σ: P(X ∈ [m − σ,m + σ]) = 68,3 %.Intervalo 2-σ: P(X ∈ [m − 2σ,m + 2σ]) = 95,45 %.Intervalo 3-σ: P(X ∈ [m − 3σ,m + 3σ]) = 99,74 %.

39 / 57

Page 40: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Distribucion normal o gaussiana II

El teorema central del lımite dice que la suma de variablesaleatorias (con cualquier tipo de distribucion) tiende en mediaa la normal. Puesto que los errores a gran escala provienen dela suma y acumulacion de muchos errores a pequena escala,esto justifica el uso de la normal como modelo para errores.

Una propiedad importante de la normal es que la suma denormales es de nuevo normal, es decir, si X ∼ N(mx , σ

2x) e

Y ∼ N(my , σ2y ) y son independientes, entonces si Z = X + Y

se tiene que Z ∼ N(mx + my , σ2x + σ2

y ).

Por tanto σz =√σ2x + σ2

y , es decir, la desviacion tıpica de la

suma de errores es la raız cuadrada de la suma de loscuadrados de las desviaciones tıpicas de los errores.

Esta regla, conocida como Root-Sum-of-Squares (RSS) esmuy importante.

40 / 57

Page 41: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Variables aleatorias continuas multidimensionales

Sea una variable aleatoria X ∈ Rn continua multidimensional.Cada componente de X sigue una distribucion unidimensional.Como en el caso unidimensional, se define una funcion dedistribucion conjunta, que se calcula mediante la funcion dedensidad f (x).Igualmente E [g(X )] =

∫Rn g(y)f (y)dy . Los dos casos

importantes son:Media: m(X ) = E [X ] =

∫Rn yf (y)dy .

Matriz de covarianzas:Cov(X ) = E [(X −m(X ))(X −m(X ))T ] = Σ. Es una matrizsimetrica y definida positiva. Los valores de la diagonalrepresentan la varianza de cada componente de X , mientrasque los valores fuera de la diagonal la correlacion entre doscomponentes de X . Se tiene Σ = E [(XXT ]−m(X )m(X )T .

Por ejemplo, para n = 3 y escribiendo X = [X ,Y ,Z ]:

Σ =

σ2x E [(X − mx )(Y − my )] E [(X − mx )(Z − mz )]

E [(X − mx )(Y − my )] σ2y E [(Y − my )(Z − mz )]

E [(X − mx )(Z − mz )] E [(Y − my )(Z − mz )] σ2z

41 / 57

Page 42: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Distribucion normal multivariante I

Se escribe X ∼ Nn(m,Σ) y su funcion de densidad esf (x) = 1

Det(Σ)(2π)n/2Exp(−1

2 (x −m)TΣ−1(x −m)).

Los intervalos de confianza son ahora regiones de Rn,definidos por P(X ∈ Ω) = PΩ.La forma de estas regiones de confianza es de elipsoides,descritos por la ecuacion (x −m)TΣ−1(x −m) = d2, donde ddepende de PΩ. Cuanto mayores sean los valores de losautovalores de Σ, mayor sera el elipsoide. Las direcciones delos ejes del elipsoide vendran dados por los autovectores de Σ.

42 / 57

Page 43: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Distribucion normal multivariante IISi por ejemplo describimos el error en posicion en ejes cuerpo,δrb = [δx δy δz ]T , como una normal multivariante con n = 3,de media cero (centrada en el avion) y con matriz decovarianzas:

Σ =

σ2x 0 0

0 σ2y 0

0 0 σ2z

Entonces σx representa la magnitud del error ATE(along-track error), σy del error XTE (cross-track error) y σzdel error VE (vertical error) y podemos asimilar el movimientodel avion al movimiento del elipsoide, que representa unaregion de incertidumbre donde se puede encontrar el avion congran probabilidad.Se verifica que si X ∼ Nn(mx ,Σx) e Y ∼ Nn(my ,Σy ) y sonindependientes, entonces si Z = X + Y resultaZ ∼ Nn(mx + my ,Σx + Σy ).Igualmente AX + b donde A y b son no-aleatorios verifica queAX + b ∼ Nn(Amx + b,AΣxA

T ).43 / 57

Page 44: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Procesos estocasticos.

Un proceso estocastico o variable estocastica no es sino unavariable aleatoria X (t) que cambia con el tiempo. Los erroresde navegacion seran este tipo de variables.

Por tanto la media y la covarianza tambien varıan con eltiempo: m(t), Σ(t).

Para un proceso, se define la autocorrelacion comoR(t, τ) = E [X (t)X (τ)T ]. La autocorrelacion permite conocerhasta que punto la historia pasada de X influye en su valoractual.

Proceso gaussiano: Un proceso gaussiano verificaX (t) ∼ Nn(m(t),Σ(t)), es decir, se distribuye como unanormal multivariante cuya media y covarianza varıan con eltiempo.

44 / 57

Page 45: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Ruido blanco.

Ruido blanco: Se define como ruido blanco un proceso ν(t)que verifica:

E [ν(t)] = 0.E [ν(t)ν(t)T ] = σ2Id.R(t, τ) = E [ν(t)ν(τ)T ] = δ(t − τ)σ2Id, donde δ(x) vale 1 six = 0 y 0 en cualquier otro caso.

La ultima condicion quiere decir que el valor del ruido blancoen un instante es independiente de su valor en cualquierinstante anterior.

Ruido blanco gaussiano: Es un proceso que cumple lascondiciones anteriores, y ademas es gaussiano.

Un buen modelo para las fuentes de error (errores de medida,errores gravitatorios) es δε(tk) = b + Dν, donde ν es ruidoblanco gaussiano. El valor de b dara la media del error (sesgo,llamado bias en ingles).

45 / 57

Page 46: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Propagacion del error.

Si en las ecuaciones de propagacion del errorδx(tk+1) = A(k)δx(tk) + δε(tk) sustituimos δε(tk) = b + Dν,obtenemos el siguiente modelo de propagacion del error:δx(tk+1) = A(k)δx(tk) + b + Dν.Observacion: tıpicamente b tambien esta sometido a un errorvariable, de forma que b(tk+1) = b(tk) + Dbνb. Parasimplificar ignoramos esta variacion.Se realizan las siguientes hipotesis:

ν es ruido blanco gaussiano con varianza σ2ν .

Inicialmente, δx(t0) ∼ Nn(m0,Σ0). Si se conocieranperfectamente, entonces Σ0 = 0.Ademas se tiene la hipotesis de que δx(t0) y ν sonindependientes.

Bajo estas condiciones, se tiene que δx(tk) es un procesogaussiano, es decir, δx(tk) ∼ Nn(mk ,Σk), donde la media y lacovarianza verifican la siguiente evolucion:

Propagacion de la media: mk+1 = Amk + b.Propagacion de la covarianza: Σk+1 = AΣkA

T + σ2νDD

T . 46 / 57

Page 47: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Propagacion del error: ejemplo sencillo

Supongamos que tuvieramos una ecuacion de propagacion delerror en una dimension (por ejemplo la posicion en el eje x)dada simplemente por: δxk+1 = δxk + ν, donde:

La variable temporal k representa minutos, es decir, x6 es elerror en posicion pasados 6 minutos.ν es ruido blanco gaussiano de varianza σ2

ν .Inicialmente, δx(t0) = 0.Ademas δx(tk) y ν son independientes.

Entonces aplicando las formulas anteriores,δx(tk) ∼ N(mk , σk), donde la media y la varianza verifican:

Propagacion de la media: mk+1 = mk . Como m0 = 0, setendra mk = 0 para todo k.Propagacion de la varianza: σ2

k+1 = σ2k + σ2

nu. Como σ20 = 0, se

tiene que σ2k = kσ2

nu. Por tanto la varianza verifica σk =√kσν .

Si por ejemplo x son metros y el ruido blanco tiene σν = 0,1metros, entonces aunque inicialmente la posicion se conocesin error, pasada una hora σ60 =

√60 · 0,1 = 0,77, es decir un

intervalo 2-σ serıa δx ∈ [−1,55, 1,55]. 47 / 57

Page 48: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Propagacion del error para un giroscopo

Si estuvieramos estimando un giro unidimensional de unangulo, θ, a partir de la medida de su velocidad angular porun giroscopo, ω, se tiene: θ = ω.Discretizando esta ecuacion obtenemos aproximadamenteθk+1 = θk + ∆Tω, donde ∆T es el periodo de muestreo.El error verificara δθk+1 = δθk + ∆T δω y suponiendo que δωes ruido blanco de varianza σ2

ν , se tiene, como antes:

Var[δθk ] = k(∆T )2σ2ν ,

y observando que k∆T = t es el tiempo transcurrido:

σθk =√

Var[δθk ] =√t(√

∆Tσν).

En las especificaciones de un giroscopo suele venir el datoARW=

√∆Tσν , en unidades de grados/

√tiempo. Para

estimar la desviacion tıpica del error en un tiempo t bastamultiplicar ARW por

√t. Existen otros errores que habrıa

tambien que anadir. 48 / 57

Page 49: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Propagacion del error para un acelerometro IPara un desplazamiento unidimensional se tiene igualmente,para la velocidad, v = a y para la posicion, x = v .Esto implica el siguiente sistema de ecuaciones para el error:

d

dt

[δvδx

]=

[0 01 0

] [δvδx

]+

[δa0

]Discretizando en el tiempo:

d

dt

[δvk+1

δxk+1

]=

[∆T 0

1 ∆T

] [δvkδxk

]+

[10

]δak

Por tanto, usando las ecuaciones de propagacion y bajo las

hipotesis habituales, tenemos que

[δvkδxk

]∼ N2 (mk ,Σk) y

suponiendo que δa es ruido blanco de varianza σ2a , se tienen

las siguientes ecuaciones para mk y Σk :

mk+1 = Amk , Σk+1 = AΣkAT + σ2

aDDT

donde A =

[∆T 0

1 ∆T

], D =

[10

]49 / 57

Page 50: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Propagacion del error para un acelerometro II

Suponiendo que el error inicial es cero y perfectante conocido,m0 = 0 y Σ0 = 02×2.Esto implica mk = 0 para todo k . Por otro lado para Σ,definimos los coeficienes como:

Σk =

[σ2vk ξkξk σ2

xk

]Insertando Σk en las ecuaciones obtenemos σ2

vk+1ξk+1

ξk+1 σ2xk+1

=

[∆T 0

1 ∆T

] σ2vk+1

ξk+1

ξk+1 σ2xk+1

[ ∆T 10 ∆T

]+σ2

a

[∆T 2 0

0 0

]

Desarrollando:

σ2vk+1

= σ2vk + ∆T 2σ2

a

ξk+1 = ξk + ∆Tσ2vk

σ2xk+1

= σ2xk + ∆T 2σ2

vk + 2∆T ξk

50 / 57

Page 51: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Propagacion del error para un acelerometro III

Resolviendo la primera ecuacion obtenemos como antesσ2vk

= k∆T 2σ2a . Introduciendo esta ecuacion en la segunda

obtenemos:

ξk+1 = ξk + k∆T 3σ2a

cuya solucion es ξk = k(k−1)(2k−1)6 ∆T 4σ2

a ≈ k3

3 ∆T 4σ2a .

Introduciendo esta ecuacion en la tercera obtenemos:

σ2xk+1

= σ2xk + k∆T 4σ2

a + k(k − 1)∆T 4σ2a = σ2

xk + k2∆T 4σ2a

cuya solucion es σ2xk

= k(k−1)(2k−1)6 ∆T 4σ2

a ≈ k3

3 ∆T 4σ2a .

Recordando k∆T = t hemos obtenido: σvk =√t√

∆Tσa y

σxk =√

t3

3

√∆Tσa.

En las especificaciones de un acelerometro suele venir el datoruido en g (aceleracion de la gravedad) partido por

√Hz .

Multiplicando este dato por 9.8 obtenemos√

∆Tσa, enunidades de m/s3/2.

51 / 57

Page 52: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Propagacion del error para un acelerometro IV

Para estimar la desviacion tıpica de la velocidad y la posicionprocederıamos como sigue:

Para la velocidad: bastarıa multiplicar el valor del ruido por√t.

Para la posicion: bastarıa multiplicar el valor del ruido por√

t3

3 .

Existen otros errores que habrıa tambien que anadir.

Ejemplo: supongamos que queremos estudiar la propagaciondel ruido de un acelerometro sabiendo que su valor es de50µg/

√Hz ≈ 500 · 10−6ms−2/3.

Entonces σv =√t500 · 10−6ms−2/3 = 310−2ms−1 y

σx =√

t3/3500 · 10−6ms−2/3 = 62m. Luego un intervalo2− σ de la velocidad serıa v ∈ [v − 0,06, v + 0,06] y unintervalo 2− σ de la posicion serıa x ∈ [x − 125, x + 125].

52 / 57

Page 53: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Medida del error en 2-D

Para el caso 2-D (por ejemplo posicion sobre un mapa) y si elerror esta distribuido como X ∼ N2(0,Σ), las regiones deconfianza serıan elipses:

Dado Σ podemos escribir Σ = Pdiagσ1, σ2PT donde P esuna matriz con autovectores y σi los autovalores. Losautovectores dan la direccion de los ejes de la elipse y losautovalores son proporcionales a su magnitud (cuyo valorexacto dependera del grado de confianza del intervalo).

53 / 57

Page 54: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Otras medidas de error en 2-D

CEP: Circular Error Probable. Sustituye la elipse por uncırculo en cuyo interior hay un 50 % de encontrar a la variable.

!"#$"%"

!"#$$%&'$(")*'+%&*+","!-"

"

&'()"*+,"-#./0/#)."12("3#44(5"#6(2"0/7(8"0'("-#./0/#)."12(".9100(2(5"#6(2"1)"12(1"5:("0#"

7(1.:2(7()0"(22#2.;"<'/."5/.-(2./#)"#$"-#/)0."/."9133(5"1".9100(2"-3#08"='/9'"*+,"

71):$190:2(2.":.("0#"9'12190(2/>("0'(/2"(?:/-7()0@."199:219A;"<'("12(1"=/0'/)"='/9'"0'("

7(1.:2(7()0."#2"(.0/710(5"-1217(0(2."12("3/B(3A"0#"C("/."9133(5"0'("9#)$/5()9("2(4/#);""

<'("9#)$/5()9("2(4/#)"/."0'()"1)13A>(5"0#"?:1)0/$A"0'("*+,"-(2$#271)9(".010/.0/9133A;"

<'("9#)$/5()9("2(4/#)"=/0'"1"215/:."5(.92/C(."0'("-2#C1C/3/0A"0'10"0'(".#3:0/#)"=/33"C("

=/0'/)"0'(".-(9/$/(5"199:219A;""

"

D/4:2("!".'#=."0'(".9100(2"-3#0"#$"0'("EF"./)43("-#/)0"-#./0/#)."#C.(26(5"CA"0'("190:13"

G#6H0(3"IJKLM*!"2(9(/6(2"$#2"!L"'#:2."1)5"/0."199:219A"215//"#$"NJ+"1)5"OPK,;"

"

"

!"

!#

!$

%

$

#

"

!" !# !$ % $ # "

!"#$ %!&&' & %()*

"D/4:2("!Q"EF",/)43("+#/)0"-#./0/#)."9#33(90(5"#)"0'("2##$0#-"#$"G#6H0(3"C:/35/)4"$#2"!L"

'#:2.":./)4"G#6H0(3"IJKLM*!"2(9(/6(2"1)5"*+,H)0())1"K#5(3"RS!;"""

+,-%./#$"012%3''$%42"0%567"&28%(.345*%%

"

OPK,"/."1"./)43("):7C(2"0'10"(T-2(..(."!O"199:219A;"U)"#25(2"0#"9#7-:0("0'("OPK,"#$"

'#2/>#)013"-#./0/#)"(22#2.8"0'(".01)5125"(22#2."V!W"$2#7"0'("B)#=)"-#./0/#)"/)"0'("

5/2(90/#)."#$"0'("9##25/)10("1T/."12("2(?:/2(5;""

"

OPK,"/."0'(".?:12("2##0"#$"0'("16(214("#$"0'(".?:12("(22#2."='/9'"/."5($/)(5"1."$#33#=.Q"

"

OPK,"X" !!

!"!! " "

!",01)5125"(22#2."V!W"#$"(.0/710(5"9##25/)10(."VT8"AW"#$"(19'"-#/)0"C(/)4"-#./0/#)(5"

91)"C("-2(5/90(5"$2#7"0'("9#22(.-#)5/)4"612/1)9(."#)"0'("5/14#)13"#$"0'("

9#612/1)9("7102/T;""

!"#$

%&'($)

*+,-$

.&%/$)$

Es mas simple de entender pero mas complejo de hallar ymenos representativo estadısticamente hablando. Siσx/3 ≤ σy ≤ 3σx , entonces CEP ' 0,59(σx + σy ).Otra medida comunmente usada (FAA) es el 2DRMS: cırculoque contiene del 95 % al 98 % de los puntos. Se calcula

DRMS =√σ2x + σ2

y . Entonces el 2DRMS es el cırculo de

radio 2 · DRMS . Igualmente existe el DRMS, 3DRMS...54 / 57

Page 55: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Algoritmo de mınimos cuadrados I

En la resolucion de problemas de navegacion es frecuenteencontrar sistemas de ecuaciones sobredeterminados (excesode medidas) o incluso incompatibles (medidas no coherentesentre sı).Puesto que las medidas contienen errores (de diferentemagnitud, segun el tipo de medida), es conveniente resolverestos sistemas teniendo en cuenta dicho error.Se puede usar un algoritmo de mınimos cuadrados, queresuelve un sistema del tipo: y = Az + b, donde:

y es de dimension n y conocido (medidas).z es de dimension m ≤ n y es desconocido (datos a calcular).A es conocido (medidas).b son los errores (desconocidos): b ∼ Nm(0,Σ)

Se busca una solucion z de forma que Az sea lo mas parecidoposible a y en el sentido de los mınimos cuadrados.Matematicamente, se busca z tal que la funcion de costeJ = (y − Az)T (y − Az) sea mınimo. 55 / 57

Page 56: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Algoritmo de mınimos cuadrados II

Se busca ∂J∂z = 0.

En primer lugar: J = yT y − 2yTAz + zTATAz

Tomando la derivada: ∂J∂z = −2yTA + 2zTATA

Igualandola a 0:yTA = zTATA

Despejando z : zT = yTA(ATA)−1 ⇒ z = (ATA)−1AT y .

Observese que (ATA)−1AT es la pseudoinversa y existesiempre que A tenga al menos m filas (medidas)independientes.

Propiedades estadısticas de la solucion:E [z] = E [(ATA)−1AT y ] = (ATA)−1AT E [y ] = (ATA)−1AT E [Az + b] =

(ATA)−1ATAE [z] = E [z] = z.

Cov [z] = Cov [(ATA)−1AT y ] = (ATA)−1ATCov [y ]A(ATA)−1 = (ATA)−1ATCov [Az +

b]A(ATA)−1 = (ATA)−1AT(ACov [z]AT + Σ

)A(ATA)−1 = (ATA)−1AT ΣA(ATA)−1

56 / 57

Page 57: Navegación Aérea - Tema 4: Sistema de navegación …aero.us.es/na/files1112/T4NA.pdf · Created Date: 3/23/2012 10:58:44 AM

Sistema de navegacion autonomo: Navegacion inercial.Errores en navegacion inercial.

Modelos de Error

Breve recordatorio de estadısticaProcesos estocasticos. Ruido blanco. Propagacion.Medidas del error.

Algoritmo de mınimos cuadrados ponderados

¿Existe alguna mejora posible del algoritmo de mınimoscuadrados que disminuya la covarianza de la estimacion?Se plantea ponderar las medidas en la funcion de coste conuna matriz de pesos W , de forma que se de mas peso a lasmedidas mas precisas y menos a las menos precisas. Portanto: J = (y − Az)TW (y − Az) donde W ha de ser unamatriz simetrica definida positiva.Procediendo como antes (se deja como ejercicio) se llega az = (ATWA)−1ATWy .Propiedades estadısticas de la solucion:

E [z] = z.

Cov [z] = (ATWA)−1ATWΣWA(ATWA)−1

Para minimizar la covarianza, tomar W = Σ−1; es simetrica ydefinida positiva, y se le da mas peso a las medidas con menorvarianza y menos peso a las de mayor varianza.Llegamos a z = (ATΣ−1A)−1ATΣ−1y ; calculando la

covarianza se obtiene: Cov [z ] = (ATΣ−1A)−1.57 / 57