fundamentos de navegacioń aérea · ángulos de euler cuaterniones sistema de referencia ejes...

Sistemas de referencia. Actitud

Ecuaciones Diferenciales Cinematicas de la Actitud

Ecuaciones Fundamentales de la Navegacion

Fundamentos de Navegacion AereaTema 7: Sistemas de referencia. Actitud. Ecuaciones de la

navegacion.




Sistemas de referencia. Tiempos

Matriz de cosenos directores

´

Angulos de Euler

Cuaterniones

Sistemas de referencia usuales en Navegacion Aerea

Para poder entender los sistemas de navegacion esimprescindible dominar los diferentes sistemas de referencia enlos que se va a trabajar. Veremos los siguientes sistemas dereferencia:

Sistema inercial geocentrico (ECI: Earth Centered Inertial).Sistema de Ejes Tierra (ECEF: Earth Centered, Earth Fixed)Sistema de referencia topocentrico.Sistema de ejes horizonte local (LLS: Local Level System,NED: North East Down).Sistema de referencia de azimut de deriva (Wander azimuthframe).Sistema de ejes cuerpo (BFS: Body Fixed System).

Ademas estudiaremos las relaciones entre los diferentessistemas de referencia y como pasar de uno a otro.En este proceso se definiran cantidades utiles, como lavelocidad respecto a Tierra y los angulos de Euler que definenla actitud de una aeronave. 2 / 62






´

Angulos de Euler

Cuaterniones

Sistema Inercial Geocentrico (ECI)

Util para el estudio del movimiento decuerpos orbitando la Tierra, porejemplo los satelites GPS, y comosistema de referencia inercial absoluto.

El eje Oz coincide con el eje derotacion de la Tierra.

El plano Oxy contiene al Ecuador yOx apunta a ⌫, el primer punto deAries (una direccion fija en lasestrellas).

No es realmente inercial (se estadespreciando el movimiento de laTierra en torno al Sol, y el movimientopropio del Sol respecto a las estrellas).

3 / 62






´

Angulos de Euler

Cuaterniones

Sistema de Ejes Tierra (ECEF)

Ligado ıntimamente a la Tierra, rota con ella.Util para referenciar posiciones terrestres.El plano Oxy contiene al Ecuador y el plano Oxz al Meridianode Greenwich.La forma de la Tierra se asimila a un elipsoide de revolucion(Elipsoide Internacional WGS84) alrededor del eje Oz (derotacion de la Tierra).

4 / 62






´

Angulos de Euler

Cuaterniones

Sistema Topocentrico

Ligado ıntimamente a la Tierra,con origen en el donde seencuentre el observador (E ).

Se usa para tomar medidasdesde Tierra.

El plano Exy es tangente al Elipsoide Internacional WGS84 enla superficie, la direccion Ex apunta al Este, la direccion Ey alNorte, y la Ez sigue la vertical local “hacia arriba” (cenit). Ladireccion local “hacia abajo” se denomina nadir.Las observaciones se componen de tres medidas: r o ⇢(distancia al objeto); A, azimut; y h, la altura o elevacionsobre el plano horizontal.

5 / 62






´

Angulos de Euler

Cuaterniones

Sistema de ejes horizonte local (LLS,NED)42 APPLIED MATHEMATICS IN INTEGRATED NAVIGATION SYSTEMS

Fig. 3.1 ECEF coordinate frame with z axis along Earth's rotation axis.

Earth-Centered, Earth-Fixed Frame The Earth-centered, Earth-fixed (ECEF) frame is fixed within the Earth and its

rotation, and it is centered at the Earth's center. Axis definitions in current use vary. Shown in Figs. 3.1, 3.2, and 3.3 are illustrations of three possible ECEF frames. In the first frame, shown in Fig. 3.1, the z axis is parallel to and aligned with the direction of the Earth's rotation. In the equatorial plane, the x axis locates the Greenwich meridian and the y axis completes the right-hand system. In Fig. 3.2, the y axis is parallel to the direction of the Earth's rotation. In the equatorial plane, the z axis locates the Greenwich meridian and the x axis completes the right- hand system. In the third frame, Fig. 3.3, the x axis is parallel to the direction of the Earth's rotation. The z axis locates the Greenwich meridian and the y axis completes the right-hand system.

Earth-Centered Inertial Frame In each of these figures, the corresponding Earth-centered inertial (ECI) frame is

established by the direction of the Earth's rotation. This inertial frame is fixed to an inertial reference. The further specification of the inertial reference is not necessary for the following developments; however, if, for example, navigation aids are based on stellar updates, then the inertial reference would have to be specified.

Local Geodetic Frame Also shown in Figs. 3.1,3.2, and 3.3 are local geodetic (geographic) frames that

are usually associated with the ECEF frame indicated.

Llamada en ingles LLS=Local LevelSystem o NED=North East Down.Tambien “ejes geodeticos ogeodesicos locales”.

Es un sistema local centrado en unpunto que puede o no estar en lasuperficie de la Tierra.

Por tanto cambia al moverse elpunto.

Esta definida respecto al elipsoide: la direccion Norte es e�, ladireccion Este es e� y la direccion abajo es �e

h

.Es el sistema de referencia fundamental usado en navegacion,aunque a veces es sustituido por el de azimut errante (versiguiente transparencia).

6 / 62






´

Angulos de Euler

Cuaterniones

Sistema de referencia de azimut de deriva

Llamada en ingles “Wanderazimuth frame”.

Se usa frecuentemente ennavegacion en vez del sistemade referencia horizonte localdebido a que, en lasproximidades de los polos, dichosistema esta mal definido yocasiona problemas numericos.

Se rota un angulo ↵ respecto a la direccion N/E. Dichoangulo y su variacion se puede definir por el disenador delsistema de navegacion.Con ↵ = ↵ = 0 recuperamos el sistema de ejes horizonte local.Tıpicamente se define ↵ = � sin�.

7 / 62






´

Angulos de Euler

Cuaterniones

Sistema de referencia ejes cuerpo (BFS)

Llamada en ingles BFS=Body Fixed System.Se utiliza para definir la actitud (orientacion) de la aeronave,respecto el sistema de ejes de navegacion (NED o wanderazimuth).

8 / 62






´

Angulos de Euler

Cuaterniones

Sistema de referencia ejes cuerpo (BFS)

Los ejes estan definidos como en lafigura.

El centro del sistema de referencia,en el centro de masas del avion.

El eje xb

contenido en el plano desimetrıa del avion, hacia el morro.El angulo rotado en torno a x

b

es '(alabeo o roll).

El eje zb

contenido en el plano de simetrıa del avion, haciaabajo. El angulo rotado en torno a z

b

es (guinada o yaw).El eje y

b

completa el triedro (direccion aproximada del aladerecha). El angulo rotado en torno a y

b

es ✓ (cabeceo opitch).

9 / 62






´

Angulos de Euler

Cuaterniones

Relacion entre sistemas de referencia

Dado un sistema de referencia A y un sistema de referencia B ,para pasar de uno a otro habra que tener en cuenta doshechos:

Cuando no coinciden los orıgenes de A y B , habra que realizaruna translacion: rA = rB + r

BA

.Cuando A y B estan rotados entre sı, habra que realizar unarotacion: rA = CA

B

rB , donde CA

B

sera la matriz del cambio debase entre A y B (ortogonal).

Ademas, a la hora de estudiar derivadas, hay que tener encuenta que la derivada tomada en dos sistema de referenciadistintos cambia si dichos sistemas rotan uno en relacion alotro con velocidad angular !

B/A. Lo estudiaremos masadelante.

10 / 62






´

Angulos de Euler

Cuaterniones

Algunas definiciones de interes

Velocidad inercial: es la derivada de la posicion, tomada en elsistema de referencia inercial, es decir, v i = r i .Velocidad respecto a Tierra: es la derivada de la posicion,tomada en el sistema de referencia ejes Tierra, es decir,v e = r e .Observese que ambas definiciones no coinciden puesto que laTierra rota; ademas v e 6= C e

i

v i porque las derivadas no estantomadas en el mismo sistema de referencia. Mas adelanteveremos como estan relacionadas ambas cantidades.Posicion en los ejes de navegacion: es la posicion respecto aTierra r e tomada en el sistema de referencia de navegacion, esdecir, rn = Cn

e

r e .Velocidad en los ejes de navegacion: es la velocidad respecto aTierra v e tomada en el sistema de referencia de navegacion,es decir, vn = Cn

e

v e . Observese que vn 6= rn!11 / 62






´

Angulos de Euler

Cuaterniones

Algunas definiciones de interes

Esta velocidad vn es la velocidad “percibida” en el avion.Cuando n es el sistema de referencia horizonte local, estavelocidad se suele descomponer en:

Modulo: velocidad respecto a Tierra, a veces llamada Vg

. Serıala velocidad real del avion respecto al suelo.Angulo formado entre vn y el plano horizonte local: angulo detrayectoria � (flight path angle).Angulo formado entre la proyeccion de vn en el plano horizontelocal y la direccion Norte: angulo de rumbo � (heading angle).

Hay que tener en cuenta que el angulo de rumbo � y el deguinada pueden no coincidir, especialmente en presencia deviento.

12 / 62






´

Angulos de Euler

Cuaterniones

Relacion entre ECEF y ECI.

Para encontrar C e

i

, hay que tener en cuenta que la Tierra giracon velocidad angular !

i/e = [0 0 !E

]T , es decir, ambossistemas de referencia estaran rotados una cantidad✓E

= ✓E0

+ !E

t. Luego:

ECI✓E�!z

i

ECEF

Por tanto:

C e

i

=

2

4c✓

E

s✓E

0�s✓

E

c✓E

00 0 1

3

5

Donde c = cos y s = sen.

13 / 62






´

Angulos de Euler

Cuaterniones

Relacion entre LLS y ECEF.

Para encontrar C g

e

(donde g hace referencia al caractergeodesico de LLS), hay que tener en cuenta la posicion (�,�)y realizar las siguientes operaciones:

Rotar � grados en torno a ze .Rotar �� grados en torno al nuevo eje y .El sistema resultante tiene x en la direccion �z y z en ladireccion x . Por tanto girar -90 grados adicionales.

ECEF��!z

e

S��!y

S

S 0 �90�!y

S

0LLS

Por tanto:

C

S

e

=

2

4c� s� 0

�s� c� 0

0 0 1

3

5C

S

0S

=

2

4c� 0 s�0 1 0

�s� 0 c�

3

5C

g

S

0 =

2

40 0 1

0 1 0

�1 0 0

3

5

C

g

e

= C

g

S

0CS

0S

C

S

e

=

2

4�s�c� �s�s� c��s� c� 0

�c�c� �c�s� �s�

3

5

14 / 62






´

Angulos de Euler

Cuaterniones

Relacion entre LLS y azimut errante (n).

Para encontrar Cn

g

, hay que tener en cuenta que la rotacion deangulo ↵ en torno al eje z . Por tanto:

LLS↵�!z

WA

Por tanto:

Cn

g

=

2

4c↵ s↵ 0�s↵ c↵ 00 0 1

3

5

15 / 62






´

Angulos de Euler

Cuaterniones

Relacion entre n y BFS

Para encontrar Cb

n

hay que tener en cuenta los angulos deEuler ( , ✓,').

MATHEMATICAL PRELIMINARIES

Fig. 2.3 Single rotation in three-axis coordinate frame.

A vector's components described in one frame can be described in another frame of arbitrary orientation with respect to the original frame by a transformation ma- 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 are used to represent the corresponding transformed axis. The final y frame cor- responds to the triple primed x axes. Written in vector form, the transformation is

where the transformation DCM, c:, transforms the components of the r vector from the x frame to the y frame.

Fig. 2.4 Three rotations in three-axis coordinate frame.

Las operaciones son:Rotar grados en torno a zn.Rotar ✓ grados en torno al nuevo eje y .Rotar ' grados en torno al nuevo eje x .

n �!z

n

S✓�!y

S

S 0 '�!x

S

0BFS

Se llega a:

C

b

n

= C

b

S

0CS

0S

C

S

n

=

2

4c✓c c✓s �s✓

�c's + s's✓c c'c + s's✓s s'c✓s's + c's✓c �s'c + c's✓s c'c✓

3

5

16 / 62






´

Angulos de Euler

Cuaterniones

Tiempos de interes en Navegacion Aerea

Tiempo Universal Coordinado (UTC):Medido por relojes atomicos a lo largo del mundo.Cada cierto tiempo (a lo largo de anos) se anaden o restansegundos para compensar la pequena irregularidad de larotacion de la Tierra.El huso horario se define como UTC±n. Ademas hay que teneren cuenta el cambio de horario de verano. Por ejemplo, Sevillaes UTC+1, y en verano UTC+2.A efectos practicos UTC coincide con el viejo GMT.

Tiempo GPS (GPST):Sirve de referencia para las aplicaciones relacionadas con GPS.Medido en los relojes atomicos a bordo de los Navstar.No se anaden ni restan segundos: no coincide con UTC (difiereen segundos).

17 / 62






´

Angulos de Euler

Cuaterniones

Husos horarios

18 / 62






´

Angulos de Euler

Cuaterniones

La actitud de la aeronave

La actitud de la aeronave es su orientacion respecto al sistemade referencia de navegacion (tıpicamente el sdr horizonte localo el de azimut errante).En realidad, es suficiente conocer la orientacion de un sistemade referencia solidario a la aeronave (los ejes cuerpo).Los angulos de Euler cabeceo, guinada y alabeo son larepresentacion clasica, pero no la unica; existen otrasrepresentaciones con diferentes ventajas e inconvenientes.Estudiaremos cuatro representaciones diferentes:

Matriz de cosenos directores.Angulos de Euler.Angulo y eje de Euler.Cuaterniones.

Nota: La posicion (�,�) o (�,�,↵) tambien se puedeconsiderar una “orientacion” del sistema de referencia denavegacion respecto al ECEF.

19 / 62






´

Angulos de Euler

Cuaterniones

Matriz de cosenos directores (DCM) IDado un sistema de referencia S (determinado por una basede vectores unitarios (e

x

, ey

, ez

) y otro S’ (determinado poruna base de vectores unitarios (e

x

0 , ey

0 , ez

0), la orientacion deS respecto a S’ esta totalmente determinada por la matriz decambio de base CS

0S

, que para un vector generico v permitecambiar de base: vS

0= CS

0S

vS . Denotemos:

C

S

0S

=

2

4c

11

c

12

c

13

c

21

c

22

c

23

c

31

c

32

c

33

3

5

Observese: eS0

x

= C S

0S

eSx

= C S

0S

[1 0 0]T = [c11

c21

c31

]T .Luego: e

x

0 · ex

= (eS0

x

0 )T eS0

x

= [1 0 0][c11

c21

c31

]T = c11

.Igualmente:

c

21

= e

y

0 · ex

, c

31

= e

z

0 · ex

c

12

= e

x

0 · ey

, c

22

= e

y

0 · ey

, c

32

= e

z

0 · ey

c

13

= e

x

0 · ez

, c

23

= e

y

0 · ez

, c

32

= e

z

0 · ez

20 / 62






´

Angulos de Euler

Cuaterniones

Matriz de cosenos directores (DCM) IIPor tanto:

C

S

0S

=

2

4e

x

0 · ex

e

x

0 · ey

e

x

0 · ez

e

y

0 · ex

e

y

0 · ey

e

y

0 · ez

e

z

0 · ex

e

z

0 · ey

e

z

0 · ez

3

5

Observese que razonando igualmente:

C

S

S

0 =

2

64e

x

0 · ex

e

y

0 · ex

e

z

0 · ex

e

x

0 · ey

e

y

0 · ey

e

z

0 · ey

e

x

0 · ez

e

y

0 · ez

e

z

0 · ez

3

75 = (C

S

0S

)

T

Y por tanto, puesto que C S

S

0 = (C S

0S

)�1, obtenemos queC S

S

0 es ortogonal, es decir: (C S

0S

)�1 = (C S

0S

)T . Tambien sejustifica el nombre “matriz de cosenos directores”.Otra propiedad es det(C S

S

0) = 1. Esto se debe a que1 = det(Id) = det((C S

S

0)(C S

S

0)�1) = det((C S

S

0)(C S

S

0)T ) =�det(C S

S

0)�2

. Por tanto det(C S

S

0) = ±1. El signo +corresponde a los sistemas de referencia que son triedros“a derechas”.

21 / 62






´

Angulos de Euler

Cuaterniones

Matriz de cosenos directores (DCM) III

Es una representacion de la actitud con 9 parametros. Estosparametros son dependientes entre sı, es decir, las entradas dela matriz C no pueden ser cualesquiera (la matriz ha de serortogonal y con determinante +1).

Supongamos que la actitud de S2

respecto a S1

viene dadapor CS

2

S

1

y que la actitud de S3

respecto a S2

viene dada por

CS

3

S

2

. La actitud de S3

respecto a S1

viene dada por

CS

3

S

1

= CS

3

S

2

CS

2

S

1

. Por tanto la “composicion” de actitudes vienedada por un simple producto matricial.

22 / 62






´

Angulos de Euler

Cuaterniones

Angulos de Euler I

En general una actitud se puede describir mediante tresrotaciones, en ejes no consecutivos.Por ejemplo, la rotacion clasica:

n �!z

n

S✓�!y

S

S 0 '�!x

S

0BFS

Existen otras posibilidades:

n✓1�!

x

n

S✓2�!

y

S

S 0 ✓3�!

z

S

0BFS n

⌦�!z

n

Si�!x

S

S 0 !�!z

S

0BFS

Existen hasta 12 posibles secuencias de angulos de Euler pararepresentar la actitud.El numero de parametros de cada secuencia es siempre 3.Se puede obtener la DCM a partir de los angulos de Eulermediante multiplicacion de matricies de rotacion elementales.Por ejemplo: Cb

n

( , ✓,') = Cb

S

0(')CS

0S

(✓)CS

n

( ).23 / 62






´

Angulos de Euler

Cuaterniones

Angulos de Euler II

Como ya vimos, para el caso ( , ✓,'):

C

b

n

=

2

4c✓c c✓s �s✓

�c's + s's✓c c'c + s's✓s s'c✓s's + c's✓c �s'c + c's✓s c'c✓

3

5

Observese que (180o + , 180o � ✓, 180o + ') es la mismaactitud que ( , ✓,'). Por ello se suelen limitar losangulos, tıpicamente ✓ 2 [�90o, 90o].

n �!z

n

S✓�!y

S

S 0 '�!x

S

0BFS

Para obtener los angulos de la DCM:1 ✓ = � arc sen c

13

.2 Con cos = c

11

/ cos ✓, sen = c12

/ cos ✓, obtener .3 Con sen' = c

23

/ cos ✓, cos' = c33

/ cos ✓, obtener '.

24 / 62






´

Angulos de Euler

Cuaterniones

Angulos de Euler III

Su mayor ventaja es su significado fısico.

No obstante, hay que tener cuidado a la hora de componerdos actitudes.

Supongamos que la actitud de S2

respecto a S1

viene dadapor (

1

, ✓1

,'1

) y que la actitud de S3

respecto a S2

vienedada por (

2

, ✓2

,'2

). Denotemos como ( 3

, ✓3

,'3

) la actitudde S

3

respecto a S1

. En general: 3

6= 1

+ 2

, ✓3

6= ✓1

+ ✓2

,'3

6= '1

+ '2

.

Para obtener ( 3

, ✓3

,'3

) hay que calcular los angulos de Eulera partir de CS

3

S

1

= CS

3

S

2

( 2

, ✓2

,'2

)CS

2

S

1

( 1

, ✓1

,'1

).

Por tanto es complicado operar con angulos de Euler.

25 / 62






´

Angulos de Euler

Cuaterniones

Angulo y eje de Euler I

Teorema de Euler: “el movimiento mas general posible de unsolido con un punto fijo es una rotacion alrededor de un unicoeje”.Nota: De momento consideramos la actitud en un instante detiempo concreto, es decir, no estudiamos cuando hay unarotacion que cambia con el tiempo.Denominemos a un vector unitario en la direccion de dicho eje(Eje de Euler) como e

S/S 0 y a la magnitud de la rotacion

(Angulo de Euler) como ✓.Por tanto ke

S/S 0k = 1 y si escribimos eS0

S/S 0 = [ex

ey

ez

]T , se

tiene que e2x

+ e2y

+ e2z

= 1.

Dado un vector v = [vx

vy

vz

]T definimos el operador v⇥como:

v

⇥=

2

40 �v

z

v

y

v

z

0 �v

x

�v

y

v

x

0

3

5

26 / 62






´

Angulos de Euler

Cuaterniones

Angulo y eje de Euler II

El operador v⇥ sirve para escribir facilmente el productovectorial v ⇥ w , para cualquier vector w , en un sistema dereferencia dado S : (v ⇥ w)S =

�vS

�⇥wS .

Por tanto la actitud con el angulo y eje de Euler quedarepresentada con los parametros (eS

0

S/S 0 , ✓). ¿Como se puedepasar de estos parametros a la DCM y viceversa?Se tiene que

CS

0S

= cos ✓Id+ (1� cos ✓)eS0

S/S 0(eS0

S/S 0)T � sen ✓⇣eS

0

S/S 0

⌘⇥.

Esta es la llamada formula de Euler-Rodrigues.Por otro lado, dada CS

0S

, se tiene que:

cos ✓ =Tr(CS

0S

)� 1

2⇣eS

0

S/S 0

⌘⇥=

1

2 sen ✓

⇣(CS

0S

)T � CS

0S

⌘

27 / 62






´

Angulos de Euler

Cuaterniones

Angulo y eje de Euler III

Por tanto se representa la actitud con cuatro parametros: trescomponentes de un vector unitario y un angulo. Estosparametros tienen un claro significado fısico.Observese que la actitud dada por (eS

0

S/S 0 , ✓) y por

(�eS0

S/S 0 , 360o � ✓) es exactamente la misma. Para evitar esta

ambiguedad, se restringe ✓ al intervalo [0, 180o].La actitud inversa (la de S respecto a S 0) vendra dada por(�eS

S

0/S , ✓). Nota: Observese que eSS

0/S = eS0

S/S 0 .Finalmente si la actitud de S

2

respecto a S1

viene dada por(eS2

S

1

/S2

, ✓1

) y que la actitud de S3

respecto a S2

viene dada

por (eS3S

2

/S3

, ✓2

), si denotamos como (eS3S

1

/S3

, ✓3

) la actitud deS3

respecto a S1

, viene dada por:cos ✓

3

= � cos ✓1

cos ✓2

+ sen ✓1

sen ✓2

(e

S

1

/S2

· eS

2

/S3

)

e

S

3

S

1

/S3

=

1

sen ✓3

⇣sen ✓

1

cos ✓2

e

S

1

/S2

+ cos ✓1

sen ✓2

e

S

2

/S3

+ sen ✓1

sen ✓2

(e

S

1

/S2

⇥ e

S

2

/S3

)

⌘

28 / 62






´

Angulos de Euler

Cuaterniones

Cuaterniones

Los cuaterniones son una creacion de Hamilton (siglo XIX),que los consideraba su mayor invento; penso serıan como el“lenguaje universal” de la fısica. Pero fueron sustituidospronto por los vectores (Gibbs) y las matrices (Cayley).Recordemos que un numero complejo z es como un “vector2-D”, que se puede escribir como z = x + iy . Los numeroscomplejos de modulo unidad se pueden usar para representaruna rotacion 2-D, ya que en el caso de que |z | = 1, se puedeescribir z = ei✓, y en tal caso representa una rotacion 2-D deangulo ✓.Los cuaterniones son una extension de los numeros complejosa “4 dimensiones”. Escribimos un cuaternion q como:q = q

0

+ iq1

+ jq2

+ kq3

.En ocasiones q

0

se denomina la “parte escalar” de q y sedefine q = [q

1

q2

q3

]T como la “parte vectorial” de q.Algunos autores escriben q

4

en vez de q0

. 29 / 62






´

Angulos de Euler

Cuaterniones

Algebra de cuaterniones I

Para poder entender los cuaterniones es importante conocersu algebra, es decir, como se opera con cuaterniones.

Suma: la suma es componente a componente, es decir, dadoq = q

0

+ iq1

+ jq2

+ kq3

y q0 = q00

+ iq01

+ jq02

+ kq03

, se tieneque q00 = q + q0 = q00

0

+ iq001

+ jq002

+ kq003

viene dado por lasformulas:q000

= q0

+ q00

, q001

= q1

+ q01

, q002

= q2

+ q02

, q003

= q3

+ q03

.

Producto: el producto es componente a componente,conociendo las siguientes reglas de multiplicacion:i · i = �1, i · j = k , i · k = �j , j · i = �k , j · j = �1, j · k = i ,k · i = j , k · j = �i , k · k = �1.

Se tiene la formula de Hamilton: i · j · k = �1.

Observese que en general qq0 6= q0q: La multiplicacion no esconmutativa!

30 / 62






´

Angulos de Euler

Cuaterniones

Algebra de cuaterniones II

Forma matricial del producto: Es posible escribir el productoq00 = q0q en forma matricial.

2

664

q000

q001

q002

q003

3

775 =

2

664

q00

�q01

�q02

�q03

q01

q00

�q03

q02

q02

q03

q00

�q01

q03

�q02

q01

q00

3

775

2

664

q0

q1

q2

q3

3

775

Forma “vectorial” del producto: q000

= q00

q0

� q0Tq,q00 = q

0

q0 + q00

q + q0 ⇥ q.Conjugado: Como para los numeros complejos, dadoq = q

0

+ iq1

+ jq2

+ kq3

se define el conjugado de q comoq⇤ = q

0

� iq1

� jq2

� kq3

.Modulo: Se define el modulo de q = q

0

+ iq1

+ jq2

+ kq3

como |q|2 = qq⇤ = q20

+ q21

+ q22

+ q23

Division: Se define la division usando el conjugado:q0/q = q0/q · q⇤/q⇤ = (q0q⇤)/|q|2.

31 / 62






´

Angulos de Euler

Cuaterniones

Representacion de la actitud mediante cuaterniones I

Dada la actitud representada mediante el eje y angulo deEuler, e y ✓, se “codifica” dicha actitud en forma decuaterniones mediante:q0

= cos ✓/2, q = sen ✓/2e.Observese que si un cuaternion q representa una actitud,entonces |q| = 1.Recordemos el operador q⇥:

q

⇥=

2

40 �q

3

q

2

q

3

0 �q

1

�q

2

q

1

0

3

5

Para pasar de la DCM C a cuaterniones, se utilizan las

formulas: q0

=p

1+Tr(C)

2

y q⇥ = 1

4q

0

�CT � C

�.

Para pasar de cuaterniones a DCM se utiliza la formula deEuler-Rodrigues para cuaterniones:C =

�q2

0

� qTq�Id+ 2qqT � 2q

0

q⇥.32 / 62






´

Angulos de Euler

Cuaterniones

Representacion de la actitud mediante cuaterniones II

Formula de Euler-Rodrigues en forma matricial:

C(q) =

2

4q

2

0

+ q

2

1

� q

2

2

� q

2

3

2(q

1

q

2

+ q

0

q

3

) 2(q

1

q

3

� q

0

q

2

)

2(q

1

q

2

� q

0

q

3

) q

2

0

� q

2

1

+ q

2

2

� q

2

3

2(q

2

q

3

+ q

0

q

1

)

2(q

1

q

3

+ q

0

q

2

) 2(q

2

q

3

� q

0

q

1

) q

2

0

� q

2

1

� q

2

2

+ q

2

3

3

5

Los cuaterniones son una representacion de la actitud querequiere 4 parametros, con la relacion |q| = 1.

Tienen la desventaja de ser una representacionmatematica sin sentido fısico.

Para pasar de la DCM a cuaterniones y viceversa no esnecesario usar formulas trigonometricas.Si q

S

0S

representa la actitud de S’ respecto a S y qS

00S

0

representa la actitud de S” respecto a S’, entonces qS

00S

,la actitud de S” respecto a S, se calcula comoqS

00S

= qS

0S

· qS

00S

0 (al reves que la DCM).

33 / 62






´

Angulos de Euler

Cuaterniones

Calculo de cuaterniones dados los angulos de Euler

Observese que:A los angulos de Euler ( , 0, 0) les corresponde el cuaternionq = cos /2 + k sen /2.A los angulos de Euler (0, ✓, 0) les corresponde el cuaternionq✓ = cos ✓/2 + j sen ✓/2.A los angulos de Euler (0, 0,') les corresponde el cuaternionq' = cos'/2 + i sen'/2.

Por tanto, a los angulos de Euler ( , ✓,') les correspondera elcuaternion q = q q✓q'.

Realizando el producto, se obtiene:

q = (cos /2 cos ✓/2 cos'/2 + sen /2 sen ✓/2 sen'/2)

+i (cos /2 cos ✓/2 sen'/2� sen /2 sen ✓/2 cos'/2)

+j (cos /2 sen ✓/2 cos'/2 + sen /2 cos ✓/2 sen'/2)

+k (sen /2 cos ✓/2 cos'/2� cos /2 sen ✓/2 sen'/2) .

34 / 62




DCM

´

Angulos de Euler

Cuaterniones


Para el caso de la posicion, las ecuaciones cinematicasrelacionan el vector posicion con el vector velocidad, mientrasque las ecuaciones dinamicas relacionan el vector velocidadcon el vector fuerza.

Para el caso de la actitud, las ecuaciones diferencialescinematicas (EDC) relacionan la representacion de la actitud(DCM, angulos de Euler, cuaterniones) con la velocidadangular !. Tıpicamente estas ecuaciones son no-lineales.

En el sistema de navegacion inercial, los giroscopos nos daran!, y habra que utilizar las EDC, es decir, integrar lasecuaciones, para calcular la actitud.

Por tanto es importante conocer las diferentes EDC para lasdiferentes representaciones, para ver cual es la mas ventajosadesde un punto de vista computacional.

35 / 62




DCM

´

Angulos de Euler

Cuaterniones

DCM para angulos pequenos I

Supongamos que tenemos dos sistemas de referencia A y B ,relacionados de la siguiente forma:

Ad✓

1�!x

A

S1

d✓2�!

y

S

1

S2

d✓3�!

z

S

2

B

donde suponemos que d✓i

son angulos pequenos, de formaque podemos aproximar cos d✓

i

' 1 y sen d✓i

' d✓i

.Si escribimos las matrices de rotacion teniendo en cuenta laaproximacion anterior, obtenemos:

C

S

1

A

=

2

41 0 0

0 1 d✓1

0 �d✓1

1

3

5 , C

S

2

S

1

=

2

41 0 �d✓

2

0 1 0

d✓2

0 1

3

5 , C

B

S

2

=

2

41 d✓

3

0

�d✓3

1 0

0 0 1

3

5 .

Si escribimos CB

A

= CB

S

2

C S

2

S

1

C S

1

A

y despreciamos todos losproductos dobles de angulos, es decir, d✓

i

d✓j

' 0,obtenemos:

C

B

A

=

2

41 d✓

3

�d✓2

�d✓3

1 d✓1

d✓2

�d✓1

1

3

5= Id �

2

40 �d✓

3

d✓2

d✓3

0 �d✓1

�d✓2

d✓1

0

3

5= Id � d✓⇥,

36 / 62




DCM

´

Angulos de Euler

Cuaterniones

DCM para angulos pequenos II

En la anterior transparencia, se ha definidod✓ = [d✓

1

d✓2

d✓3

]T y la matriz

d✓⇥ =

2

40 �d✓

3

d✓2

d✓3

0 �d✓1

�d✓2

d✓1

0

3

5 ,

que es la matriz antisimetrica que se emplea para efectuar elproducto vectorial.

Observese que bajo estas hipotesis (angulos pequenos) noimporta el orden de las rotaciones y los angulos se suman.

37 / 62




DCM

´

Angulos de Euler

Cuaterniones

EDC para la DCM I

Supongamos que quiero calcular la actitud de B respecto a A,mediante la DCM CB

A

(t), sabiendo que B gira con respecto aA con una velocidad angular !B

B/A.

Por definicion: d

dt

CB

A

=C

B

A

(t+dt)�C

B

A

(t)

dt

Suponiendo A fijo, entonces podemos imaginar que es Bquien se mueve en el tiempo, y por tanto podrıamos escribir

B = B(t) y por tanto CB

A

(t) = CB(t)

A

.Usando este razonamiento,CB

A

(t + dt) = CB(t+dt)

A

= CB(t+dt)

B(t)

CB(t)

A

. Por tanto:

A�!B(t)�!B(t + dt)

En el tiempo dt, el sistema de referencia B habra giradorespecto a sı mismo un angulo muy pequeno en cada eje; porlo que hemos visto en la anterior transparencia, por tanto,

CB(t+dt)

B(t)

= Id��d✓B

�⇥, donde d✓B es como antes se definio.

38 / 62




DCM

´

Angulos de Euler

Cuaterniones

EDC para la DCM II

Siguiendo el razonamiento: ddt

CB

A

=C

B

A

(t+dt)�C

B

A

(t)

dt

=C

B(t+dt)

B(t)

C

B

A

(t)�C

B

A

(t)

dt

=(Id�(d✓B)⇥)C

B

A

(t)�C

B

A

(t)

dt

= �(d✓B)⇥

dt

CB

A

(t)

La matriz(d✓B)⇥

dt

se escribirıa

�d✓B

�⇥

dt=

2

40 �d✓

3

dt

d✓2

dt

d✓3

dt

0 �d✓1

dt

�d✓2

dt

d✓1

dt

0

3

5 =

2

40 �!

3

!2

!3

0 �!1

�!2

!1

0

3

5 ,

donde !B

B/A = [!1

!2

!3

]T ya que d✓B representaba elangulo girado por B en un dt, y por definicion de velocidadangular. Se tiene entonces:

⇣!B

B/A

⌘⇥=

"0 �!

3

!2

!3

0 �!1

�!2

!1

0

#,

Por tanto: d

dt

CB

A

= ˙CB

A

= �⇣!B

B/A

⌘⇥CB

A

. 39 / 62




DCM

´

Angulos de Euler

Cuaterniones

EDC para la DCM III

¿Que sucede si lo que conocemos es !A

B/A? Tenemos que

estudiar como se transforman estos operadores⇣!B

B/A

⌘⇥al

cambiar de sistema de referencia.Observese que si z = v ⇥ w , se tiene que en el sdr B ,zB =

�vB

�⇥wB . Por otro lado en el sdr A, se tendra que

zA =�vA

�⇥wA.

La primera expresion tambien se puede escribir:zB = CB

A

zA = CB

A

�vA

�⇥wA = CB

A

�vA

�⇥CA

B

wB , y puestoque esta expresion tiene que ser igual a la anterior:�vB

�⇥= CB

A

�vA

�⇥CA

B

.

Sustituyendo esto en la ecuacion cinematica: ˙CB

A

=

�⇣!B

B/A

⌘⇥CB

A

= �CB

A

⇣!A

B/A

⌘⇥CA

B

CB

A

= �CB

A

⇣!A

B/A

⌘⇥

Finalmente puesto que !B/A = �!

A/B :˙CB

A

= CB

A

⇣!A

A/B

⌘⇥

40 / 62




DCM

´

Angulos de Euler

Cuaterniones

EDC para la DCM IV

Otra variacion: trasponiendo ambos miembros de˙CB

A

= �⇣!B

B/A

⌘⇥CB

A

llegamos a CA

B

= CA

B

⇣!B

B/A

⌘⇥

En general, la EDC es una ecuacion diferencial matricial, quehabra que resolver componente a componente: nueveecuaciones diferenciales acopladas.El principal problema de resolver numericamente esta ecuaciones garantizar que la matriz resultante de integrar seaortogonal. Observese que en teorıa la ecuacion diferencialrespeta la ortogonalidad: I = (CB

A

)(CB

A

)T , derivando:d

dt(CB

A

)

�(CB

A

)T + CB

A

d

dt(CB

A

)T

= �⇣!B

B/A

⌘⇥CB

A

(CB

A

)T + CB

A

CA

B

⇣!B

B/A

⌘⇥

= �⇣!B

B/A

⌘⇥+

⇣!B

B/A

⌘⇥= 0

41 / 62




DCM

´

Angulos de Euler

Cuaterniones

La ecuacion de Coriolis

La EDC de la DCM nos permite demostrar la ecuacion deCoriolis que luego sera util:

�d

dt

v�A

=�d

dt

v�B

+ !B/A ⇥ v

Si escribimos (mecanizamos) esta ecuacion en el sistema de

referencia B : CB

A

˙vA = vB +⇣!B

B/A

⌘⇥vB , donde el punto

quiere decir derivada en el mismo sistema de referencia dondeesta escrito.En efecto: CB

A

˙vA = CB

A

d

dt(CA

B

vB)

= vB + CB

A

CA

B

vB

= vB + CB

A

CA

B

⇣!B

B/A

⌘⇥vB

= vB +⇣!B

B/A

⌘⇥vB

Esta ecuacion sera utilizada con mucha frecuencia en estetema.

42 / 62




DCM

´

Angulos de Euler

Cuaterniones

EDC para los angulos de Euler I

Partimos de la definicion de los angulos de Euler:

n �!z

n

S✓�!y

S

S 0 '�!x

S

0b

La velocidad angular tiene la propiedad de que!b/n = !

b/S 0 + !S

0/S + !S/n.

Si mecanizamos esta ecuacion en b:!b

b/n = !b

b/S 0 + !b

S

0/S + !b

S/n

Por otro lado esta claro que:!b

b/S 0 = [' 0 0]T , !S

0

S

0/S = [0 ✓ 0]T , !S

S/n = [0 0 ]T .

Luego: !b

b/n = !b

b/S 0 + Cb

S

0!S

0

S

0/S + Cb

S

!S

S/n y puesto que

Cb

S

= Cb

S

0CS

0S

, podemos escribir:!b

b/n = !b

b/S 0 + Cb

S

0!S

0

S

0/S + Cb

S

0CS

0S

!S

S/n

43 / 62




DCM

´

Angulos de Euler

Cuaterniones

EDC para los angulos de Euler II

Desarrollando esta ecuacion:

!b

b/n =

2

4'00

3

5+

2

41 0 00 c' s'0 �s' c'

3

5

2

40✓0

3

5

+

2

41 0 00 c' s'0 �s' c'

3

5

2

4c✓ 0 �s✓0 1 0s✓ 0 c✓

3

5

2

400

3

5

=

2

4'00

3

5+

2

40

c'✓�s'✓

3

5+

2

4�s✓ s'c✓ c'c✓

3

5

=

2

41 0 �s✓0 c' s'c✓0 �s' c'c✓

3

5

2

4'✓

3

5

44 / 62




DCM

´

Angulos de Euler

Cuaterniones

EDC para los angulos de Euler III

Observese que lo que realmente se quiere es una expresionpara las derivadas de los angulos en funcion de!b

b/n = [!1

!2

!3

]T , y por tanto hay que invertir la matriz:

2

4'✓

3

5 =

2

41 0 �s✓0 c' s'c✓0 �s' c'c✓

3

5�1

2

4!1

!2

!3

3

5

=1

c✓

2

4c✓ s✓s' s✓c'0 c'c✓ �s'c✓0 s' c'

3

5

2

4!1

!2

!3

3

5

Observese que se trata de 3 ecuaciones diferenciales nolineales, con multitud de funciones trigonometricas.Posee una singularidad para ✓ = ±90o. En realidad losangulos de Euler no estan bien definidos para esta situacion.Por ello no se suelen usar en navegacion inercial.

45 / 62




DCM

´

Angulos de Euler

Cuaterniones

EDC para el eje y angulo de Euler

La representacion en forma de eje y angulo de Euler, (ebb/n, ✓),

tiene las siguientes EDC:

Para el angulo de Euler: ✓ = (ebb/n)

T!b

b/n

Para el eje de Euler:

ebb/n =

1

2

⇣ebb/n

⌘⇥+

1

tan ✓/2

⇣Id� eb

b/n(eb

b/n)T

⌘�!b

b/n

Son cuatro ecuaciones diferenciales, no lineales.

Poseen una singularidad para ✓ = 0.

En la practica no se utilizan directamente; las usamos parahallar las EDC para los cuaterniones.

46 / 62




DCM

´

Angulos de Euler

Cuaterniones

EDC para cuaterniones I

Recordemos la definicion de cuaterniones en funcion de anguloy eje de Euler: q

0

= cos ✓/2, q = sen ✓/2ebb/n.

Derivando en la ecuacion de q0

y sustituyendo la EDC de ✓,obtenemos:q0

= �1

2

sen ✓/2✓ = �1

2

sen ✓/2(ebb/n)

T!b

b/n = �1

2

qT!b

b/nDerivando en la ecuacion de q:

q =1

2cos ✓/2eb

b/n✓ + sen ✓/2ebb/n

Sustituyendo las EDC de angulo y eje de Euler:

q =1

2cos ✓/2eb

b/n(eb

b/n)T!b

b/n

+1

2sen ✓/2

⇣ebb/n

⌘⇥+

1

tan ✓/2

⇣Id� eb

b/n(eb

b/n)T

⌘�!b

b/n

=1

2

⇥q⇥ + q

0

Id⇤!b

b/n47 / 62




DCM

´

Angulos de Euler

Cuaterniones

EDC para cuaterniones II

Podemos escribir esta ecuacion en forma matricial:

d

dt

2

664

q0

q1

q2

q3

3

775 =1

2

2

664

�q1

�q2

�q3

q0

�q3

q2

q3

q0

�q1

�q2

q1

q0

3

775

2

4!x

!y

!z

3

5

donde !b

b/n = [!x

!y

!z

]T .

Son cuatro ecuaciones diferenciales, bilineales, sinsingularidades.

No es necesario realizar ningun tipo de operaciontrigonometrica (senos o cosenos), todo son multiplicacionesmatriciales.

Por estas razones, la representacion mediante cuaterniones esla representacion de actitud mas usada.

48 / 62




DCM

´

Angulos de Euler

Cuaterniones

EDC para cuaterniones IIIDefinamos de la siguiente forma el “cuaternion velocidadangular”:

q! =

0!

�

es decir, un cuaternion con parte escalar cero y parte vectorialigual a a la velocidad angular.Entonces las ecuaciones diferenciales cinematicas se puedenescribir de forma compacta usando el producto decuaterniones: q = 1

2

qq!.Cuando se resuelve numericamente la EDC de loscuaterniones, eventualmente los errores numericos provocaranque el modulo del cuaternion resultante difiera de la unidad.Esto se puede resolver mediante un procedimiento llamadorenormalizacion, que simplemente consiste en dividir elcuaternion por su modulo.

49 / 62




Velocidad

Velocidades angulares entre sistemas de referencia

Posicion


Las ecuaciones fundamentales de la navegacion son lasecuaciones del movimiento de la aeronave, expresada en ejesde navegacion.

Puesto que en navegacion es necesario determinar 9 variables(3 de posicion, 3 de actitud, y 3 de velocidad), serannecesarias 9 ecuaciones dadas como 3 conjuntos de 3ecuaciones diferenciales.

El primer conjunto de ecuaciones es la EDC de la actitud, queya hemos visto.

Queda determinar el conjunto de ecuaciones que verifica laposicion y el conjunto de ecuaciones que verifica la velocidad.

La llamada “ecuacion fundamental de la navegacion” (FEN)es la ecuacion vectorial de la velocidad.

50 / 62




Velocidad


Posicion

Ecuacion Fundamental de la Navegacion I

La segunda ley de Newton aplicada al centro de masas delavion y expresada en el sistema de referencia inercial es:m d

dt

v i =P

F = F i

NG

+mG i , donde se desprecia la variacionde masa del avion.Hemos separado las fuerzas en gravitatorias (G ) y nogravitatorias (F

NG

).Es decir: d

dt

v i = 1

m

F i

NG

+ G i .

La definicion de v i es v i = d

dt

r i .Por otro lado, en el sistema de ejes Tierra, tenemos quev e = d

dt

r e .

Por tanto: v e = d

dt

�C e

i

r i�= C e

i

r i + C e

i

d

dt

r i = C e

i

r i + C e

i

v i .

Usando la EDC C e

i

= �⇣!e

e/i

⌘⇥C e

i

llegamos a:

v e = �⇣!e

e/i

⌘⇥C e

i

r i + C e

i

v i .

51 / 62




Velocidad


Posicion

Ecuacion Fundamental de la Navegacion II

Igualmente, asumiendo la rotacion de la Tierra constante:d

dt

v e = �⇣!e

e/i

⌘⇥C e

i

r i �⇣!e

e/i

⌘⇥C e

i

r i + C e

i

v i + C e

i

v i .

Por tanto:d

dtv e =

⇣!e

e/i

⌘⇥ ⇣!e

e/i

⌘⇥C e

i

r i �⇣!e

e/i

⌘⇥C e

i

v i �⇣!e

e/i

⌘⇥C e

i

v i

+C e

i

v i

=⇣!e

e/i

⌘⇥ ⇣!e

e/i

⌘⇥r e � 2

⇣!e

e/i

⌘⇥C e

i

v i + C e

i

v i

Puesto que v e = �⇣!e

e/i

⌘⇥C e

i

r i + C e

i

v i , se tiene que

C e

i

v i = v e +⇣!e

e/i

⌘⇥r e . Por tanto:

d

dtv e = �

⇣!e

e/i

⌘⇥ ⇣!e

e/i

⌘⇥r e � 2

⇣!e

e/i

⌘⇥v e + C e

i

v i

El primer termino representa la aceleracion centrıfuga acent

y

el segundo la de Coriolis, luego aecent

= �⇣!e

e/i

⌘⇥ ⇣!e

e/i

⌘⇥r e . 52 / 62




Velocidad


Posicion

Ecuacion Fundamental de la Navegacion IIISustituyendo la Ley de Newton en la ecuacion antes obtenida:

d

dtv e = ae

cent

� 2⇣!e

e/i

⌘⇥v e + C e

i

✓1

mF i

NG

+ G i

◆

= aecent

� 2⇣!e

e/i

⌘⇥v e +

1

mF e

NG

+ G e

Finalmente recordemos que la aceleracion del geopotencial sedefinıa como g = G + a

cent

, llegamos a:d

dtv e = �2

⇣!e

e/i

⌘⇥v e +

1

mF e

NG

+ g e

Finalmente, en ejes navegacion n y puesto que vn = Cn

e

v e :d

dtvn = Cn

e

v e + Cn

e

d

dtv e

= �⇣!n

n/e

⌘⇥Cn

e

v e + Cn

e

✓�2

⇣!e

e/i

⌘⇥v e +

1

mF e

NG

+ g e

◆

53 / 62




Velocidad


Posicion

Ecuacion Fundamental de la Navegacion IV

Es decir:d

dtvn = �

⇣!n

n/e

⌘⇥vn � 2Cn

e

⇣!e

e/i

⌘⇥v e +

1

mF n

NG

+ gn

Y puesto que v e = C e

n

vn:

d

dtvn = �

⇣!n

n/e

⌘⇥vn � 2Cn

e

⇣!e

e/i

⌘⇥C e

n

vn +1

mF n

NG

+ gn

Recordemos que para el “operador producto vectorial”, secumple que C a

b

�zb�⇥

Cb

a

= (za)⇥. Por tanto la FEN queda:

d

dtvn = �

⇣!n

n/e

⌘⇥vn � 2

⇣!n

e/i

⌘⇥vn +

1

mF n

NG

+ gn

= �⇣!n

n/e + 2!n

e/i

⌘⇥vn +

1

mF n

NG

+ gn

La FEN es una ecuacion totalmente expresada(“mecanizada”) en ejes n. vn es lo que se quiere estimar.Observemos no obstante que son necesarios !n

n/e y !n

e/i . 54 / 62




Velocidad


Posicion

Velocidades angulares entre sistemas de referencias

Necesitamos obtener valores para !n

n/e y !n

e/i .En primer lugar consideremos el caso simple de que ↵ = 0,por tanto g = n.Recordemos las matrices de transformacion:

C

e

i

=

2

4c!

E

t s!E

t 0

�s!E

t c!E

t 0

0 0 1

3

5 , Cg

e

=

2

4�s�c� �s�s� c��s� c� 0

�c�c� �c�s� �s�

3

5

Recordemos que !e

e/i = [0 0 !E

]T .Por tanto:

!g

e/i = C g

e

!e

e/i =

2

4!E

c�0

�!E

s�

3

5

Por otro lado siguiendo el procedimiento con el que se hallaron

las DCM para angulos de Euler, llegamos a !g

g/e =

2

4�c��s�

3

5

55 / 62




Velocidad


Posicion

Velocidades angulares entre sistemas de referencias conangulo de deriva

Si ahora ↵ 6= 0, recordemos la matriz de transformacion:

C

n

g

=

2

4c↵ s↵ 0

�s↵ c↵ 0

0 0 1

3

5

Por tanto: !n

e/i = Cn

g

!g

e/i =

2

4!E

c�c↵�!

E

c�s↵�!

E

s�

3

5

Igualmente !n

g/e = Cn

g

!g

g/e =

2

4�c�c↵� �s↵��c�s↵� �c↵

��s�

3

5

Finalmente

!n

n/e = !n

g/e + !n

n/g = !n

g/e +

2

400↵

3

5 =

2

4�c�c↵� �s↵��c�s↵� �c↵

��s�+ ↵

3

5

56 / 62




Velocidad


Posicion

Ecuaciones Diferenciales Cinematicas de la Posicion I

Necesitamos obtener ecuaciones para �, � y h; tambien para↵, si se usa un angulo de deriva.En primer lugar para simplificar consideremos el caso massimple posible: no hay angulo de deriva (↵ = 0 luego n = g) yla Tierra es esferica de radio R

e

.En tal caso, se tiene: ˙r e = v e y recordemos vg = C g

e

v e 6= ˙rg .Pero el valor de rg = [0 0 � (R

e

+ h)]T , luego es facil dederivar.Se tiene: [0 0 � h]T = ˙rg = C g

e

r e + C g

e

˙r e =

�⇣!g

g/e

⌘⇥C g

e

r e + C g

e

v e = �⇣!g

g/e

⌘⇥rg + vg

Por otro lado vg = [vx

vy

vz

]T = [vN

vE

vD

]T teniendo encuenta la orientacion delos ejes NED. Despejando lavelocidad, la ecuacion matricial queda:

2

4v

N

v

E

v

D

3

5=

2

40

˙�s� � ˙�� ˙�s� 0 � ˙�c�

˙� ˙�c� 0

3

5

2

40

0

�R

e

� h

3

5+

2

40

0

� ˙

h

3

5

57 / 62




Velocidad


Posicion

EDC de la Posicion IIDesarrollando:

v

N

=

˙�(Re

+ h)

v

E

=

˙�c�(Re

+ h)

v

D

= � ˙

h

Es decir:˙� =

v

N

R

e

+ h

˙� =

v

E

c�(Re

+ h)

˙

h = �v

D

Estas ecuaciones me permiten obtener la posicion conocida lavelocidad en todo instante. Observese que son singulares en� = ±90o.Por ese motivo se introduce el azimuth de deriva.

Sustituyendo en !g

g/e obtenemos: !g

g/e =

2

64

vER

e

+h

� vNR

e

+h

� vE tan�R

e

+h

3

75

58 / 62




Velocidad


Posicion

EDC de la Posicion: caso elipsoidal

En el caso elipsoidal se tiene

˙� =

v

N

R

M

+ h

˙� =

v

E

c�(RN

+ h)

˙

h = �v

D

Donde RN

y RM

son respectivamente los radios locales decurvatura normal (de un paralelo) y meridional (delmeridiano), que fueron definidos en el primer tema; dichosradios dependen de la latitud en la que se encuentre el avion.

Y por tanto: !g

g/e =

2

64

vER

N

+h

� vNR

M

+h

� vE tan�R

N

+h

3

75

59 / 62




Velocidad


Posicion

EDC de la Posicion con Azimuth de Deriva I

Trabajamos con tierra esferica. Si ↵ 6= 0 entonces n 6= g y launica ecuacion que se mantiene es h = �v

D

, mientras que elresto de las ecuaciones cambian.Si escribimos vn = [v

x

vy

vD

]T y !n

n/e = [⇢x

⇢y

⇢z

]T ,siguiendo el mismo procedimiento de antes hallamos:

vn =⇣!n

n/e

⌘⇥rn + ˙rn

La ecuacion matricial queda:2

4v

x

v

y

v

D

3

5=

2

40 �⇢

z

⇢y

⇢z

0 �⇢x

�⇢y

⇢x

0

3

5

2

40

0

�R

e

� h

3

5+

2

40

0

� ˙

h

3

5

donde recordemos que ya calculamos ⇢x

= �c�c↵� �s↵,⇢y

= ��c�s↵� �c↵, ⇢z

= ��s�+ ↵.Se llega a:

v

x

=

⇣˙�c�s↵ +

˙�c↵⌘(R

e

+ h)

v

y

=

⇣˙�c�c↵� ˙�s↵

⌘(R

e

+ h)

v

D

= � ˙

h

60 / 62




Velocidad


Posicion

EDC de la Posicion con Azimuth de Deriva IIDespejando � y �:

˙� =

v

x

cos↵� v

y

sen↵

R

e

+ h

˙� =

v

x

sen↵ + v

y

cos↵

cos�(Re

+ h)

˙

h = �V

D

Usando estas definiciones en !n

n/e se llega a:

!n

n/e =

2

4˙�c�c↵� ˙�s↵

� ˙�c�s↵� ˙�c↵� ˙�s� + ↵

3

5=

2

664

v

y

R

e

+h

� v

x

R

e

+h

� v

x

sen↵+v

y

cos↵R

e

+h

tan� + ↵

3

775 , donde ↵ se

puede elegir como se quiera.Se suele fijar por definicion ↵ = �s� = v

x

sen↵+v

y

cos↵R

e

+h

tan�,

de donde: !n

n/e =

2

4v

y

R

e

+h

� v

x

R

e

+h

0

3

5 ,

Observese que ha desaparecido la singularidad en !n

n/e ! (a

costa de un grado de libertad adicional, ↵).61 / 62




Velocidad


Posicion

EDC de la Posicion con Azimuth de Deriva III

Usando ↵ se mantiene la singularidad a la hora de calcular �,pero al menos se puede seguir computando !n

n/e , que esnecesaria para poder calcular vn.Interpretacion fısica: Esta definicion de ↵ equivale a tener unaplataforma a bordo, a la que se permite girar en lasdirecciones xn y yn pero se le impide girar en zn. El anguloque forma una direccion fija de la plataforma con el N serıa ↵.Observacion: puesto que la posicion viene dada por losangulos (�,�,↵), se puede tratar como una “actitud”, Cn

e

.En tal caso las ecuaciones cinematicas de la posicion podrıan

darse como EDC de actitud, por ejemplo Cn

e

= �⇣!n

n/e

⌘⇥Cn

e

o incluso tratarse como cuaterniones.Ası eliminamos totalmente la singularidad, y podemossobrevolar cualquier punto del planeta.Habrıa que anadir la ecuacion de la altitud, h = �v

D

.62 / 62

fundamentos de navegacioń aérea · ángulos de euler cuaterniones sistema de referencia ejes...

Documents