Geodesia. Cartografía. Sistemas de referencia. Tiempos.

Geodesia. Cartografía. Sistemas de referencia. Tiempos. Geodesia. Cartografía. Sistemas de referencia. Tiempos.

03.06.2013 Views

Ecuaciones Diferenciales Cinemáticas de la Actitud Ecuaciones Fundamentales de la Navegación Velocidad Velocidades angulares entre sistemas de referencia Posición 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 transformación: C e i = 2 4 cω E t sω E t 0 −sω E t cω E t 0 0 0 1 3 2 5 , C g e = 4 Recordemos que ω e e/i = [0 0 ωE ] T . Por tanto: ω g e/i = C g e ω e e/i = ⎡ ⎣ −sφcλ −sφsλ cφ −sλ cλ 0 −cφcλ −cφsλ −sφ ωE cφ 0 −ωE sφ Por otro lado siguiendo el procedimiento con el que se hallaron las DCM para ángulos de Euler, llegamos a ω g g/e = ⎡ ˙λcφ ⎣ − ˙φ − ˙ ⎤ ⎦ λsφ Ecuaciones Diferenciales Cinemáticas de la Actitud Ecuaciones Fundamentales de la Navegación ⎤ ⎦ Velocidad Velocidades angulares entre sistemas de referencia Posición Velocidades angulares entre sistemas de referencias con ángulo de deriva Si ahora α = 0, recordemos la matriz de transformación: C n g = Por tanto: ω n e/i = C n g ω g e/i = 2 4 cα sα 0 −sα cα 0 0 0 1 ⎡ ⎣ Igualmente ω n g/e = C n g ω g g/e = Finalmente ω n n/e = ωn g/e + ωn n/g = ωn g/e + 3 5 ⎤ ωE cφcα −ωE cφsα ⎦ −ωE sφ ⎡ ˙λcφcα − ⎣ ˙ φsα − ˙λcφsα − ˙φcα − ˙λsφ ⎡ ⎣ 0 0 ˙α ⎤ ⎡ ⎦ = ⎣ ⎤ ⎦ 3 5 ˙λcφcα − ˙φsα − ˙λcφsα − ˙φcα − ˙ λsφ + ˙α ⎤ ⎦ 21 / 28 22 / 28 Ecuaciones Diferenciales Cinemáticas de la Actitud Ecuaciones Fundamentales de la Navegación Velocidad Velocidades angulares entre sistemas de referencia Posición Ecuaciones Diferenciales Cinemáticas de la Posición I Necesitamos obtener ecuaciones para λ, φ y h; también para α, si se usa un ángulo de deriva. En primer lugar para simplificar consideremos el caso más simple posible: no hay ángulo de deriva (α = 0 luego n = g) y la Tierra es esférica de radio Re. En tal caso, se tiene: r˙e = v e . Expresado en ejes g: r e = C e g r g . El valor de r g = [0 0 − (Re + h)] T . Se tiene: v g = C g e v e = C g e ˙ r e = C g ˙ e C e g r g + C g e C e g ˙ −C g e ω e e/g × C e g r g + ˙ r g = ω g g/e × r g + r˙g r g = Por otro lado v g = [vx vy vz] T = [vN vE vD] T . La ecuación matricial queda: 2 4 v N v E v D 3 2 5 = 4 0 ˙λsφ − ˙φ − ˙ λsφ 0 − ˙ λcφ ˙φ ˙ λcφ 0 Ecuaciones Diferenciales Cinemáticas de la Actitud Ecuaciones Fundamentales de la Navegación EDC de la Posición II Desarrollando: Es decir: 3 2 5 4 0 0 −Re − h 3 2 5 + 4 0 0 − ˙ h Velocidad Velocidades angulares entre sistemas de referencia Posición v N = ˙ φ(Re + h) v E = ˙ λcφ(Re + h) v D = − ˙ h ˙φ = ˙λ = v N Re + h vE ˙h = −v D cφ(Re + h) Éstas ecuaciones me permiten obtener la posición conocida la velocidad en todo instante. Obsérvese que son singulares en φ = ±90 o . Por ese motivo se introduce el azimuth dederiva. Sustituyendo en ω g g/e obtenemos: ωg g/e = ⎢ ⎣ 3 5 vE Re+h − vN Re+h − vE tan φ Re+h ⎤ ⎥ ⎦ 23 / 28 24 / 28

Ecuaciones Diferenciales Cinemáticas de la Actitud Ecuaciones Fundamentales de la Navegación EDC de la Posición: caso elipsoidal En el caso elipsoidal se tiene ˙φ = ˙λ = ˙h = −v D Velocidad Velocidades angulares entre sistemas de referencia Posición vN RM + h vE cφ(RN + h) Donde RN y RM son respectivamente los radios locales de curvatura normal (de un paralelo) y meridional (del meridiano), que fueron definidos en el primer tema; dichos radios dependen de la latitud en la que se encuentre el avión. Y por tanto: ω g g/e = ⎡ vE RN+h ⎢ ⎣ − vN RM+h − vE ⎤ ⎥ ⎦ tan φ RN+h Ecuaciones Diferenciales Cinemáticas de la Actitud Ecuaciones Fundamentales de la Navegación Velocidad Velocidades angulares entre sistemas de referencia Posición EDC de la Posición con Azimuth de Deriva I Trabajamos con tierra esférica. Si α = 0 entonces n = g y la única ecuación que se mantiene es ˙h = −vD, mientras que el resto de las ecuaciones cambian. Si escribimos v n = [vx vy vD] T y ω n n/e = [ρx ρy ρz] T , siguiendo el mismo procedimiento de antes hallamos: v n = ωn × n/e r n + r˙n La ecuación matricial queda: 2 4 vx vy v D 3 2 5 = 4 0 −ρz ρy ρz 0 −ρx −ρy ρx 0 3 2 5 4 0 0 −Re − h 3 2 5 + 4 donde recordemos que ya calculamos ρx = ˙λcφcα − ˙φsα, ρy = − ˙λcφsα − ˙φcα, ρz = − ˙λsφ + ˙α. Se llega a: vx vy = = v D = − ˙h “ ” ˙λcφsα + ˙φcα (Re + h) “ ” ˙λcφcα − ˙φsα (Re + h) 0 0 − ˙ h 3 5 25 / 28 26 / 28 Ecuaciones Diferenciales Cinemáticas de la Actitud Ecuaciones Fundamentales de la Navegación Velocidad Velocidades angulares entre sistemas de referencia Posición EDC de la Posición con Azimuth de Deriva II Despejando ˙φ y ˙λ: ˙φ = ˙λ = ˙h = −V D vx cos α − vy sen α Re + h vx sen α + vy cos α cos φ(Re + h) Usando estas definiciones en ωn n/e ω n n/e = 2 ˙λcφcα − 4 ˙ φsα − ˙ λcφsα − ˙ 2 3 vy 6 Re +h φcα 5 = 6 − 4 − ˙λsφ + ˙α vx 3 7 Re +h 5 vx sen α+vy cos α − tanφ + ˙α cos φ(Re +h) puede elegir como se quiera. Se suele fijar por definición ˙α = ˙λsφ = de donde: ωn n/e = ⎡ vy Re+h ⎣ − vx ⎤ ⎦ Re+h , 0 se llega a: , donde ˙α se vx sen α+vy cos α cos φ(Re+h) tanφ, Obsérvese que ha desaparecido la singularidad en ω n n/e costa de un grado de libertad adicional, α). Ecuaciones Diferenciales Cinemáticas de la Actitud Ecuaciones Fundamentales de la Navegación ! (a Velocidad Velocidades angulares entre sistemas de referencia Posición EDC de la Posición 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 es necesaria para poder calcular v n . Interpretación física: Ésta definición de α equivale a tener una plataforma a bordo, a la que se permite girar en las direcciones x n y y n pero se le impide girar en z n . El ángulo que forma una dirección fija de la plataforma con el N sería α. Observación: puesto que la posición viene dada por los ángulos (φ, λ, α), se puede tratar como una “actitud”, C n e . En tal caso las ecuaciones cinemáticas de la posición podrían darse como EDC de actitud, por ejemplo ˙ C n e = − ω n n/e × C n e 27 / 28 o incluso tratarse como cuaterniones. Así eliminamos totalmente la singularidad, y podemos sobrevolar cualquier punto del planeta. En cualquier caso habría que añadir la ecuación para la altitud, ˙h = −vD. 28 / 28

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong>s<br />

Necesitamos obtener valores para ω n n/e y ωn e/i .<br />

En primer lugar consi<strong>de</strong>remos el caso simple <strong>de</strong> que α = 0,<br />

por tanto g = n.<br />

Recor<strong>de</strong>mos las matrices <strong>de</strong> transformación:<br />

C e<br />

i =<br />

2<br />

4 cω E t sω E t 0<br />

−sω E t cω E t 0<br />

0 0 1<br />

3<br />

2<br />

5 , C g<br />

e = 4<br />

Recor<strong>de</strong>mos que ω e e/i = [0 0 ωE ] T .<br />

Por tanto:<br />

ω g<br />

e/i = C g e ω e e/i =<br />

⎡<br />

⎣<br />

−sφcλ −sφsλ cφ<br />

−sλ cλ 0<br />

−cφcλ −cφsλ −sφ<br />

ωE cφ<br />

0<br />

−ωE sφ<br />

Por otro lado siguiendo el procedimiento con el que se hallaron<br />

las DCM para ángulos <strong>de</strong> Euler, llegamos a ω g<br />

g/e =<br />

⎡<br />

˙λcφ<br />

⎣ − ˙φ<br />

− ˙ ⎤<br />

⎦<br />

λsφ<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

⎤<br />

⎦<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong>s con<br />

ángulo <strong>de</strong> <strong>de</strong>riva<br />

Si ahora α = 0, recor<strong>de</strong>mos la matriz <strong>de</strong> transformación:<br />

C n<br />

g =<br />

Por tanto: ω n e/i = C n g ω g<br />

e/i =<br />

2<br />

4<br />

cα sα 0<br />

−sα cα 0<br />

0 0 1<br />

⎡<br />

⎣<br />

Igualmente ω n g/e = C n g ω g<br />

g/e =<br />

Finalmente<br />

ω n n/e = ωn g/e + ωn n/g = ωn g/e +<br />

3<br />

5<br />

⎤<br />

ωE cφcα<br />

−ωE cφsα ⎦<br />

−ωE sφ<br />

⎡<br />

˙λcφcα −<br />

⎣<br />

˙ φsα<br />

− ˙λcφsα − ˙φcα<br />

− ˙λsφ<br />

⎡<br />

⎣<br />

0<br />

0<br />

˙α<br />

⎤<br />

⎡<br />

⎦ = ⎣<br />

⎤<br />

⎦<br />

3<br />

5<br />

˙λcφcα − ˙φsα<br />

− ˙λcφsα − ˙φcα<br />

− ˙ λsφ + ˙α<br />

⎤<br />

⎦<br />

21 / 28<br />

22 / 28<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Posición I<br />

Necesitamos obtener ecuaciones para λ, φ y h; también para<br />

α, si se usa un ángulo <strong>de</strong> <strong>de</strong>riva.<br />

En primer lugar para simplificar consi<strong>de</strong>remos el caso más<br />

simple posible: no hay ángulo <strong>de</strong> <strong>de</strong>riva (α = 0 luego n = g) y<br />

la Tierra es esférica <strong>de</strong> radio Re.<br />

En tal caso, se tiene: r˙e = v e . Expresado en ejes g:<br />

r e = C e g r g . El valor <strong>de</strong> r g = [0 0 − (Re + h)] T .<br />

Se tiene: v g = C g e v e = C g e ˙ r e = C g ˙ e C e g r g + C g e C e g ˙<br />

−C g e<br />

<br />

ω e e/g<br />

×<br />

C e g r g + ˙<br />

r g =<br />

<br />

ω g<br />

g/e<br />

×<br />

r g + r˙g r g =<br />

Por otro lado v g = [vx vy vz] T = [vN vE vD] T . La ecuación<br />

matricial queda:<br />

2<br />

4 v N<br />

v E<br />

v D<br />

3<br />

2<br />

5 = 4<br />

0 ˙λsφ − ˙φ<br />

− ˙ λsφ 0 − ˙ λcφ<br />

˙φ ˙ λcφ 0<br />

Ecuaciones Diferenciales Cinemáticas <strong>de</strong> la Actitud<br />

Ecuaciones Fundamentales <strong>de</strong> la Navegación<br />

EDC <strong>de</strong> la Posición II<br />

Desarrollando:<br />

Es <strong>de</strong>cir:<br />

3 2<br />

5 4<br />

0<br />

0<br />

−Re − h<br />

3<br />

2<br />

5 + 4<br />

0<br />

0<br />

− ˙ h<br />

Velocidad<br />

Velocida<strong>de</strong>s angulares entre sistemas <strong>de</strong> <strong>referencia</strong><br />

Posición<br />

v N = ˙ φ(Re + h)<br />

v E = ˙ λcφ(Re + h)<br />

v D = − ˙ h<br />

˙φ =<br />

˙λ =<br />

v N<br />

Re + h<br />

vE ˙h = −v D<br />

cφ(Re + h)<br />

Éstas ecuaciones me permiten obtener la posición conocida la<br />

velocidad en todo instante. Obsérvese que son singulares en<br />

φ = ±90 o .<br />

Por ese motivo se introduce el azimuth <strong>de</strong>⎡<strong>de</strong>riva. Sustituyendo en ω g<br />

g/e obtenemos: ωg<br />

g/e =<br />

⎢<br />

⎣<br />

3<br />

5<br />

vE<br />

Re+h<br />

− vN<br />

Re+h<br />

− vE tan φ<br />

Re+h<br />

⎤<br />

⎥<br />

⎦<br />

23 / 28<br />

24 / 28

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!