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 />

EDC <strong>de</strong> la Posición: caso elipsoidal<br />

En el caso elipsoidal se tiene<br />

˙φ =<br />

˙λ =<br />

˙h = −v D<br />

Velocidad<br />

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

Posición<br />

vN RM + h<br />

vE cφ(RN + h)<br />

Don<strong>de</strong> RN y RM son respectivamente los radios locales <strong>de</strong><br />

curvatura normal (<strong>de</strong> un paralelo) y meridional (<strong>de</strong>l<br />

meridiano), que fueron <strong>de</strong>finidos en el primer tema; dichos<br />

radios <strong>de</strong>pen<strong>de</strong>n <strong>de</strong> la latitud en la que se encuentre el avión.<br />

Y por tanto: ω g<br />

g/e =<br />

⎡<br />

vE<br />

RN+h<br />

⎢<br />

⎣ − vN<br />

RM+h<br />

− vE<br />

⎤<br />

⎥<br />

⎦<br />

tan φ<br />

RN+h<br />

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

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

Velocidad<br />

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

Posición<br />

EDC <strong>de</strong> la Posición con Azimuth <strong>de</strong> Deriva I<br />

Trabajamos con tierra esférica. Si α = 0 entonces n = g y la<br />

única ecuación que se mantiene es ˙h = −vD, mientras que el<br />

resto <strong>de</strong> las ecuaciones cambian.<br />

Si escribimos v n = [vx vy vD] T y ω n n/e = [ρx ρy ρz] T ,<br />

siguiendo el mismo procedimiento <strong>de</strong> antes hallamos:<br />

v n <br />

= ωn ×<br />

n/e r n + r˙n La ecuación matricial queda:<br />

2<br />

4 vx<br />

vy<br />

v D<br />

3<br />

2<br />

5 = 4<br />

0 −ρz ρy<br />

ρz 0 −ρx<br />

−ρy ρx 0<br />

3 2<br />

5 4<br />

0<br />

0<br />

−Re − h<br />

3<br />

2<br />

5 + 4<br />

don<strong>de</strong> recor<strong>de</strong>mos que ya calculamos ρx = ˙λcφcα − ˙φsα,<br />

ρy = − ˙λcφsα − ˙φcα, ρz = − ˙λsφ + ˙α.<br />

Se llega a:<br />

vx<br />

vy<br />

=<br />

=<br />

v D = − ˙h<br />

“ ”<br />

˙λcφsα + ˙φcα (Re + h)<br />

“ ”<br />

˙λcφcα − ˙φsα (Re + h)<br />

0<br />

0<br />

− ˙ h<br />

3<br />

5<br />

25 / 28<br />

26 / 28<br />

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

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

Velocidad<br />

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

Posición<br />

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

Despejando ˙φ y ˙λ:<br />

˙φ =<br />

˙λ =<br />

˙h = −V D<br />

vx cos α − vy sen α<br />

Re + h<br />

vx sen α + vy cos α<br />

cos φ(Re + h)<br />

Usando estas <strong>de</strong>finiciones en ωn n/e<br />

ω n n/e =<br />

2<br />

˙λcφcα −<br />

4<br />

˙ φsα<br />

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

3<br />

vy<br />

6<br />

Re +h<br />

φcα 5 = 6<br />

−<br />

4<br />

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

vx<br />

3<br />

7<br />

Re +h<br />

5<br />

vx sen α+vy cos α<br />

− tanφ + ˙α<br />

cos φ(Re +h)<br />

pue<strong>de</strong> elegir como se quiera.<br />

Se suele fijar por <strong>de</strong>finición ˙α = ˙λsφ =<br />

<strong>de</strong> don<strong>de</strong>: ωn n/e =<br />

⎡ vy<br />

Re+h<br />

⎣ − vx<br />

⎤<br />

⎦<br />

Re+h ,<br />

0<br />

se llega a:<br />

, don<strong>de</strong> ˙α se<br />

vx sen α+vy cos α<br />

cos φ(Re+h) tanφ,<br />

Obsérvese que ha <strong>de</strong>saparecido la singularidad en ω n n/e<br />

costa <strong>de</strong> un grado <strong>de</strong> libertad adicional, α).<br />

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

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

! (a<br />

Velocidad<br />

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

Posición<br />

EDC <strong>de</strong> la Posición con Azimuth <strong>de</strong> Deriva III<br />

Usando α se mantiene la singularidad a la hora <strong>de</strong> calcular λ,<br />

pero al menos se pue<strong>de</strong> seguir computando ωn n/e , que es<br />

necesaria para po<strong>de</strong>r calcular v n .<br />

Interpretación física: Ésta <strong>de</strong>finición <strong>de</strong> α equivale a tener una<br />

plataforma a bordo, a la que se permite girar en las<br />

direcciones x n y y n pero se le impi<strong>de</strong> girar en z n . El ángulo<br />

que forma una dirección fija <strong>de</strong> la plataforma con el N sería α.<br />

Observación: puesto que la posición viene dada por los<br />

ángulos (φ, λ, α), se pue<strong>de</strong> tratar como una “actitud”, C n e .<br />

En tal caso las ecuaciones cinemáticas <strong>de</strong> la posición podrían<br />

darse como EDC <strong>de</strong> actitud, por ejemplo ˙<br />

C n e = −<br />

<br />

ω n n/e<br />

×<br />

C n e<br />

27 / 28<br />

o incluso tratarse como cuaterniones.<br />

Así eliminamos totalmente la singularidad, y po<strong>de</strong>mos<br />

sobrevolar cualquier punto <strong>de</strong>l planeta.<br />

En cualquier caso habría que añadir la ecuación para la<br />

altitud, ˙h = −vD. 28 / 28

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

Saved successfully!

Ooh no, something went wrong!