discussions, stats, and author profiles for this publication at: https://www.researchgate.net/publication/28141892
CITATIONS READS
2 644
2 authors:
Some of the authors of this publication are also working on these related projects:
All content following this page was uploaded by Ricardo S. Snchez-Pea on 14 May 2014.
Sistemas Avanzados de Control, ESAII, Universidad Politcnica de
Catalunya, Terrassa, Barcelona, Espaa.
E-mail: ricardo.sanchez-pena@upc.edu
Comisin Nacional de Actividades Espaciales (CONAE), Argentina.
E-mail: beto@conae.gov.ar
Resumen: Este trabajo presenta una visin general del Control de orientacin, indistintamente
denominado de actitud, y de traslacin utilizado en vehculos aeroespaciales (satlites,
cohetes de sondeo, lanzadores, aeronaves). Se presentan los problemas de la cinemtica y
la dinmica, as como los distintos tipos de sensores y actuadores usualmente utilizados en
misiones espaciales. El trabajo concluye con dos ejemplos tomados de aplicaciones prcticas:
el control de orientacin de un cohete sonda y el de el satlite de observacin de la Tierra
SAC-C. Copyright
2005
c CEAIFAC
El objetivo de este trabajo es el de presentar el proble- seccin 8 se presentan dos tipos de estabilizacin de
ma de orientacin de satlites tomados como un cuer- satlites: los pasivos y los activos. Los algoritmos de
po rgido o no (cuando se hallan elementos rotantes en control para los satlites activos no se detallan en esta
su interior) y el de traslacin de cohetes impulsados seccin, ya que provienen de todas las reas de la Au-
por motores de eyeccin de masa. La presentacin tomtica, sin embargo se detallan en las secciones 9 y
incluye las ecuaciones del modelo, los sensores y ac- 10 para 2 ejemplos tomados de aplicaciones prcticas
tuadores necesarios y 2 ejemplos prcticos. de los autores del presente trabajo: un cohete sonda y
el satlite de observacin de la Tierra SAC-C.
El movimiento de un cuerpo en el espacio esta descrito
por un conjunto de ecuaciones diferenciales ordinarias
no lineales. La solucin de la mismas permiten cono- 2. REPRESENTACIN DE LA ACTITUD
cer el momento de la cantidad de movimiento (mo-
mento angular) y la orientacin (actitud) del cuerpo Este es uno de los problemas ms ricos en el rea de
respecto a una terna de referencia (ver seccin 2). El la ingeniera espacial y recibi un fuerte impulso a
problema de la dinmica de actitud es considerado principios de los 80 por un grupo de fsicos atmicos,
en detalle, basndose en un satlite en rbita como entre los que se hallaban los Dres. Malcolm Shus-
elemento testigo y se presenta en la seccin 4. En el ter, Landis Markley, James Wertz, y recientemente
caso de cohetes, adems se conoce el impulso lineal Daniele Mortari. Todos ellos tomaron sus conocimien-
y la posicin espacial del punto respecto a una terna tos de la fsica cuntica y lo trasladaron a esta nueva
de referencia. Por lo tanto, se incluyen las ecuaciones disciplina. La mejor referencia para esta seccin es el
de traslacin de un sistema de masa abierto que inter- trabajo de uno de ellos (Shuster, 1993).
cambia materia con el medio exterior en la seccin 5.
El problema fundamental de la representacin de la
El movimiento del satlite se puede dividir de acuer- actitud, es brindar una orientacin entre una terna de
do al tipo de variables involucradas en: cinemtica representacin fija al cuerpo y otra terna de referencia
y dinmica, descritas en las secciones 3 y 4, respec- asociada a la Tierra o a la rbita (subseccin 2.1). Esta
tivamente. La cinemtica relaciona la velocidad an- parametrizacin se logra mediantes varios mtodos, en
gular del satlite y su orientacin en el espacio. El particular: ngulos de Euler, el cuaternin unitario y
mnimo nmero de parmetros locales que identifi- la matriz de rotacin son las ms difundidas, (Wertz,
can la actitud son tres ngulos (de Euler) que per- 1978), todas ellas descritas en el Apndice A.
miten reconstruir la orientacin antes y despus de una
rotacin. Sin embargo son necesarios cuatro parmet- La representacin ms natural de la actitud es la
ros para representar globalmente la misma (cuaternin matriz de rotacin. Esta utiliza 9 componentes con
unitario). A tal efecto se presentan diversas representa- seis restricciones entre ellas, de esta manera la acti-
ciones en la seccin 2. tud puede ser especificada por solo tres parmetros
independientes. Los ngulos de Euler se basan en
La dinmica describe la dependencia entre los pares este hecho y adems de utilizar el mnimo nmero de
externos que actan sobre el cuerpo y la velocidad parmetros tienen una clara identificacin geomtrica.
angular del mismo. Los pares externos son las pertur- De (Jurdjevic, 1997) se sabe que el mnimo conjun-
baciones ambientales, asi como los pares de control. to de parmetros necesarios para una representacin
Las perturbaciones principales se deben al gradiente global (sin ningn tipo de ambigedades) de la actitud
gravitatorio, al frenado aerodinmico (drag), pares son cuatro. El cuaternin unitario es el ms popular
magnticos, radiacin solar, etc. Los pares de control, de las representaciones de cuatro componentes con la
en general son generados por los mismos mecanis- restriccin en la amplitud.
mos que los de perturbacin, solo que se maximiza
el efecto deseado. Por ejemplo, una bobina elctrica
genera un dipolo comandable que interacta con el 2.1 Sistemas de Coordenadas
campo magntico terrestre y genera un par deseado del
mismo tipo que el de perturbacin del dipolo residual El movimiento de un satlite en su rbita est rela-
del satlite. cionado a cuatro sistemas principales de coordenadas,
El problema de la orientacin de los satlites brinda la todos ortogonales y orientados segn la regla de la
teora bsica para entender el problema de actitud de mano derecha (ver (Wiesel, 1997)):
cualquier otro vehculo, en particular un vehculo au- 1. Principal de Coordenadas: el origen es el centro
topropulsado. Por eso lo expresado para satlites vale de masa del satlite, y los ejes se alinean con los
en forma indistinguible para cohetes. Las diferencias ejes principales de inercia del cuerpo. En general
se hallan en algunos sensores, adems del hecho que el se asume Iy > Ix > Iz y la terna se indica con
cohete incorpora la traslacin de su centro de masa co- subndices p.
mo accin principal. En realidad esto ltimo tambin 2. Coordenas Asociadas al Cuerpo: igual que el
se aplica a muchos satlites, en los casos de maniobras anterior, est referido al cuerpo. El origen en el
de control de rbita. Los actuadores y sensores se centro de masa, y su orientacin coincide con
detallan en las secciones 6 y 7, respectivamente. En la la estructura del satlite. Es una terna tangible
8 Control de Vehculos Espaciales
que est asociada a elementos fsicos. Aqu se por el cuaternin qsr (t). Luego de un tiempo infinites-
referencia la actitud del hardware bajo control imal t, la representacin de la rotacin se expresa
(ejes mecnicos u pticos de los instrumentos). como qsr (t + t). El cambio de orientacin desde el
En este trabajo esta terna se indica como B, con sistema s(t) hasta el s(t + t) se describe por,
subndices b. Muchas veces la terna p se hace
coincidir con la b, por simplicidad (ver Figura 3). qsr (t) = q qsr (t + t) (1)
3. Coordenadas de Navegacin Local,(LVLH): El
donde, q = cos 2 e + sin 2 .
origen se halla en el centro de masa del satlite,
el eje Z (vertical local) est alineado con el radio El vector unitario define el eje de rotacin y el
vector que une el centro de masa del cuerpo y ngulo de rotacin. Para una rotacin infinitesimal, se
el centro de la Tierra, el eje positivo Y apunta tiene,
en la direccin opuesta al vector momento de la sr t
cantidad de movimiento orbital. El vector X que q = e + cos = e+ , (2)
2 2
establece la horizontal local, completa la terna donde, sr indica la velocidad angular de la terna
derecha y se encuentra en el plano orbital, en r respecto a la terna s. La ecuacin cinemtica del
la direccin del vector velocidad (para rbitas vehculo se puede escribir de la siguiente manera:
circulares). Puede observarse en la Figura 23 en
la que el sistema de control la hace coincidir con dqsr qs (t + t) qsr (t)
= lm r qsr
la terna del cuerpo. dt t0 t
4. Coordenadas Inerciales, centradas en la Tierra sr t s
= lm qr
(ECI): Esta terna de referencia, tiene su origen en t0 2 t
el centro de la Tierra. El eje Z es paralelo al eje 1
qsr = sr qsr , (3)
de rotacin terrestre y apunta hacia el polo Norte. 2
El eje X sobre el plano del Ecuador, es paralelo a Es interesante notar que po es un cuaternin vectori-
la lnea que une el centro de la Tierra con el punto al (escalar nulo) y la operacin indicada es el producto
Vernal (el equinoccio vernal es el punto donde el de dos cuaterniones. En (Kuipers, 1998) se explican
plano de la eclptica cruza el plano del Ecuador con gran detalle el lgebra de los cuaterniones y sus
terrestre de sur a norte). El eje Y completa la operaciones.
terna derecha.
Las definiciones y propiedades de las distintas repre-
sentaciones de la actitud, se describen en el Apndice A. 3.2 Cinemtica de un Satlite
Desplazamiento
(Lineal) Figura 8. Esquema de Actuadores.
Aceleracin
el par generado con toberas de gas. En la Figura 8 se
muestra una rueda de reaccin tpica.
(Angular)
Figura 7. Acelermetros.
6.1 Motores por Eyeccin de Masa
Navegacin, Guiado y Control de vehculos propulsa-
dos es otro tema en s mismo y puede consultarse en
(Lin, 1990). Las toberas son motores por eyeccin de masa que
generan una fuerza en el punto donde la tobera se
monta sobre la estructura de la nave. Si la distancia
6. ACTUADORES entre el centro de masa y la posicin de cada tobera
es distinta de cero, se genera un par. Este es calculado
Un satelite equipado con ruedas de reaccin no puede como,
ser considerado un cuerpo rgido, porque stas se TJET = r FJET , (18)
hallan girando alrededor de su eje de rotacin. Estos
actuadores proveen una cantidad de momento de la donde, r es el vector que une el centro de masa del
cantidad de movimiento, que contribuye al momento satlite y la tobera, y FJET es la fuerza generada por
total del cuerpo. El momento total del satlite y las la tobera al eyectar masa. El funcionamiento de las
ruedas est dado por, toberas est caracterizado por el mnimo tiempo de
H = I pi + hRW , (17) apertura y cierre, lo que determina el perfil del par
generado.
donde hRW es el momento de la cantidad de movimien-
to aportado por las ruedas de inercia. Introduciendo Este actuador tiene como desventaja que su uso limita
(17) en la ecuacin de la dinmica del satlite, se la vida til del satlite (que depende de la cantidad de
obtiene, combustible), pero es muy verstil ya que puede ser
utilizado como actuador de traslacin para elevar la
altura orbital y cambiar la inclinacin de su plano, y al
I pi (t) = pi (t) (I pi (t) + hRW )
mismo tiempo como actuador para modificar la actitud
dhRW (t) del vehculo.
+ TGG + TA + TM + TP
dt
La presencia de un actuador que intercambia masa
donde, dhRW dt
(t)
es ahora la accin de control, que con el medio ambiente, genera una transformacin
se realiza mediante la elevacin o el decrecimiento del sistema rgido cerrado en otro rgido pero abierto.
del nmero de revoluciones del motor de la rueda de En satlites esta distincin no es importante debido a
inercia. Cuando esta velocidad alcanza un lmite prefi- la relacin entre la masa del combustible y la masa
jado, es necesario volver la velocidad de rotacin a su total del satlite. Existen varios sistemas de propulsin
valor de referencia, para lo cul se necesita aplicar un utilizados en la prctica: qumica que utiliza hidracina,
par exterior al satlite. Este mecanismo se denomina de gas frio mediante un gas inerte, y la propulsin
desaturacin de las ruedas. En general para satlites elctrica. En (Sutton, 1992) hay una detallada expli-
de rbita baja, los pares magnticos son los adecuados cacin de esto e informacin sobre los distintos mo-
para esta operacin. En (Sidi, 1997) se explica en de- tores disponibles, combustibles, tipos de toberas, etc..
talle este mecanismo. En satlites de comunicaciones Solo a modo indicativo, se muestra en la Figura 8 una
o de rbitas similares, este mecanismo es realizado por tobera tpica de gas fro y un motor elctrico.
R. S. Snchez, R. J. Alonso 13
Velocidad ang.
magntico externo adelante o atrase (segn el
Inercial W
signo) el momento en que la saturacin se pro-
duce sobre el bobinado de salida. Esta medida
Torque T
traducida en volts es transladada a Gauss o Teslas
mediante la aplicacin de un factor de escala
no lineal. Los ms modernos instrumentos se
Figura 9. Girscopo clsico. basan en la inclusin de una resistencia sensible
a los campos magnticos (magnetoresistivos) en
un circuito elctrico. El cambio de tensin en el
mismo es debido al cambio en el valor del campo
Rollo de
fibra ptica externo (ver Figura 12).
acoplador
Fuente de luz
3. Sensor de Tierra:
Detector
efecto Sagnac:
Este sensor distingue la transicin entre el
horizonte terrestre y el espacio ms frio que
lo circunda. Debido a que solo utiliza una
fuente, puede determinar dos ngulos conocidos
(cabeceo y rolido). El giro alrededor del eje de
nadir es indeterminado. Hay dos clases de sen-
Figura 10. Girscopo de fibra ptica (FOG). sores, los estticos y los rotantes, que habitual-
mente se montan en una rueda de inercia, para
disminuir peso y potencia. En general son mi-
crobolmetros sin refrigerar que trabajan en el
La frecuencia de vibracin
es proporcional a la aceleracin
infrarrojo trmico. Las precisiones de determi-
nacin son del orden de 0.03 grados en dos ejes.
Su costo relativo es alto.
Acelermetros Girscopos 4. Sensor de Sol:
Determina la direccin del Sol, mediante una
acumulacin de celdas solares, CCD, o fotode-
tectores. Tiene solo solucin de la actitud en dos
ejes. Su precisin vara segn el uso, desde las
Figura 11. Girscopos y acelermetros de cuarzo. simples celdas solares que tienen una precisin
de 2 grados a los ms sofisticados que presenten
7. SENSORES una precisin de 0.1 grados.
5. Girscopos:
Los principales sensores utilizados en el control de Son sensores inerciales que detectan la veloci-
actitud de los satlites o de navegacin de cohetes son dad de rotacin inercial, aunque no determinan
los siguientes: por si solos la actitud. Se utilizan en un arreglo
1. Sensor de Estrellas: de tres girscopos ortogonales, para contar con
Son bsicamente cmaras digitales con sen- la informacin a lo largo de los tres ejes. En gen-
sores del tipo CCD, con un ordenador, donde se eral, tienen una deriva que produce errores que
almacena un mapa de las estrellas mas brillantes. crecen con el tiempo, lo que requiere de sensores
Luego de procesar una imagen, el programa in- de posicin para volver a cero este error peri-
terno busca en este mapa la misma configuracin odicamente. La precisin que se logra con estos
de estrellas y el ngulo que debera girar para sensores depende altamente del costo, y puede
alinear perfectamente ambas imgenes: la real llegar a rdenes de 0.01 grados por hora. El prin-
y la almacenada. Dos ngulos son determinados cipio de funcionamiento clsico puede verse en
con mayor precisin que el giro a lo largo del la Figura 9, existen adems otros ms modernos
eje ptico. Es necesario al menos tres estrellas de fibra ptica, basados en el efecto Sagnac (ver
para lograr inequvocamente una medida de la Figura 10) y los de cuarzo que tambin pueden
actitud. Son sensibles al Sol y a la Luna. Son de utilizarse como acelermetros (ver Figura 11).
precio relativamente alto y proveen precisiones 6. Navegacin por satlites:
del orden de 15 segundos de arco y an mejores. Para ubicar con mucha precisin el centro de
2. Magnetmetros: masa de un cohete se puede recurrir a los re-
El campo magntico terrestre es medido con ceptores de GPS (Glonass o futura red europea
un instrumento denominado magntometro de Galileo), siempre que el mismo se encuentre por
tres ejes. Los magntometros ms comunes son debajo de los satlites de la red (aproximada-
14 Control de Vehculos Espaciales
Estabilizado
en 1 eje
Estabilizado
en 3 ejes
8. MTODOS DE ESTABILIZACIN
Figura 15. Satlite universitario MSU-1.
En trminos muy generales, se tienen los sistemas pa-
sivos (sin sistema de control realimentado tradicional),
que resultan ms econmicos aunque de menor pre- mo por ejemplo en (Chen et al., 2000; Mo-
cisin: di, 1995; Martinelli y Snchez Pea, 2005). En
la Figura 15 puede verse un sistema de control
1. Satlites con spin, en los que el cuerpo princi-
de actitud totalmente pasivo basado en fuerzas
pal est girando para generar un momento de la
aerodinmicas, gradiente gravitatorio y amor-
cantidad de movimiento alrededor del eje que se
tiguamiento por friccin viscosa, de la Universi-
desea mantener constante respecto de una terna
dad de Buenos Aires. Aunque no es muy visible,
inercial. En la Figura 14 se observa el satlite
la estructura o boom que aprovecha el gradiente
brasilero SCD-1 y se muestra la rigidez en las
gravitatorio, est rodeada por un material casi
dos direcciones normales al eje de giro all in-
transparente que hace las veces de velamen, para
dicado. Existen experimentos cientficos o tec-
aprovechar el par aerodinmico. En su interior
nolgicos que permiten esta forma de movimien-
cuenta con recipientes de aceite viscoso que au-
to del cuerpo y dada su simplicidad de imple-
mentan el amortiguamiento inercial.
mentacion y su bajo costo es un mtodo adecua-
do. Los sistemas activos, ya sea porque consumen energa
2. Los que utilizan las fuerzas y pares naturales elctrica o porque cuentan con sistemas de control,
para su orientacin: magnticos, aerodinmicos, son ms precisos aunque ms caros, ya que deben
campo (gradiente) gravitatorio, presin solar, co- agregar sensores, actuadores y ordenadores a bordo.
R. S. Snchez, R. J. Alonso 15
1. Satlites que confieren momento de la cantidad sultados para el caso sin fallas, para el caso general
de movimiento al cuerpo por medio de la presen- con posibles fallas ver (Snchez Pea, 2004).
cia de una rueda (interna al cuerpo del satlite)
El sistema adems realiza el control en 3 grados de
como se muestra en la Figura 14. Los hay de dos
libertad del vehculo siguiendo una trayectoria angular
tipos:
predeterminada. Para ello el sistema de navegacin
2. Sin tener HRW a bordo, pero controlando el
entrega las velocidades angulares en rolido (roll),
sistema con cuatro ruedas de inercia como se
cabeceo (pitch) y guiada (yaw) {1 , 2 , 3 } y los
muestra en la Figura 14. Estos casos se obtienen
cuaterniones {0 , 1 , 2 , 3 }. El objetivo de control
satlites rpidos, de alta maniobrabilidad, al pre-
es el de seguir la trayectoria angular prefijada (ver
cio de incorporar al diseo, mayor masa y poten-
Figura 18) con el menor error y en el menor tiempo
cia para manejar los actuadores.
posible, teniendo en cuenta la saturacin de los actu-
Por supuesto hay combinaciones de todos los casos adores (toberas de gas fro) y el ruido de medicin.
presentados anteriormente. En particular los activos
El cohete de sondeo est compuesto por 2 etapas:
que poseen sistemas de control, se apoyan en algorit-
la primera de ellas de combustible slido coloca la
mos que manejan los sensores y actuadores, de modo
carga til (segunda etapa) a cierta altitud, de modo
de lograr la estabilidad y performance adecuados. Ex-
que la experiencia se realice durante la cada libre
isten una gran variedad de algoritmos de control para
de la segunda etapa. Hay un proceso de de-espinado
asegurar la orientacin de un satlite o la posicin del
antes de la separacin de ambas etapas, realizada por
centro de masa de un cohete durante una misin. Estos
un sistema de Yo-Yo (Wertz, 1978), para disminuir la
van desde el control clsico lineal tradicional, hasta
elevada velocidad angular longitudinal inicial del ve-
los mtodos de control nolineal, adaptivo, robusto o
hculo (1000 rpm). La segunda etapa tiene el sistema
mediante tcnicas denominadas de soft computation
de navegacin y control y es el que realiza el ensayo
como la lgica difusa, redes neuronales, algoritmos
tecnolgico. La misin completa puede observarse en
genticos, etc. Este es un tema especfico del rea de
la Figura 16.
Control Automtico y no se profundizar ms sobre
esto, ya que todas ellas, por ser generales, pueden apli-
carse a cualquier otro tipo de problemas. Sin embargo,
en las secciones 9 y 10 se presentan con cierto detalle,
dos ejemplos de control en 3 ejes, uno de un cohete
sonda y otro de un satlite de observacin de la Tierra,
en el que participaron ambos autores.
do aplica pares diferenciales para seguir la trayectoria puede aplicarse el control tolerante a fallos descrito en
b
que forman parte del vector Mext . stos se suman a (Snchez Pea, 2004).
los pares nominales, ya preestablecidos que forman
d
parte de Mext . La misin se realiza a alturas mayores a
los 100 Km por lo cual no tiene sentido prctico incluir 9.2 Diseo y Simulaciones
en el modelo los pares aerodinmicos.
1 9.2.1. Diseo del Controlador El diseo del contro-
db
q0 = db q d db
d
lador se ha realizado por la tcnica del control ptimo
2
1 en H . Para ello se aumenta el modelo de la plan-
db d
q = (db q0 I + db q d )bdd
(19) ta G(s) con pesos Wu (s) y Wn (s) sobre la entrada
2
d
bd =J 1 (Cbd Mext
b
Mextd
). de control y el ruido de medicin, respectivamente
d
[ver ecuaciones (20)-(21)], siendo u = u + Wu w1 .
Aqu, D representa la terna deseada de orientacin Asimismo, las salidas a minimizar han sido escaladas
del vehculo y B la terna fija al vehculo real. En de acuerdo a los errores mximos permitidos en el
consecuencia el par db q0 , db q d representa el cuaternin error de orientacin ( 1 ) y la fuerza de control (5
de rotacin entre las ternas B y D. bd es la velocidad N). Esto se ilustra en la Figura 17 donde se indica
b
angular de la terna B relativa a la terna D. Mext es la la transformacin lineal fraccional (LFT) que corre-
d
suma de los pares que actan sobre el vehculo, y Mext sponde a las siguientes ecuaciones.
es lo mismo, pero sobre el vehculo en la trayectoria
deseada. Cbd es la matriz de rotacin de la terna B
x(t) = Ax(t) + B1 w(t) + B2 (t)u(t)
respecto de la D.
z(t) = C1 x(t) + D11 w(t) + D12 u(t)
La linealizacin de las ecuaciones (19) genera el mod-
elo de errores que se indica como G(s) en la Figura 17. y(t) = C2 x(t) + D21 w(t) + D22 u(t)
Este modelo sencillo no considera el acoplamiento w1 z
w(t) = , z(t) = 1
entre ejes, por lo cual la matriz dinmica es diagonal w2 z2
en bloques. La salida a minimizar z1 son los cuater-
En este diseo, se fuerza a los polos a lazo cerrado
niones diferenciales. Las ecuaciones se presentan a
a permanecer dentro de una determinada zona del
continuacin:
semiplano izquierdo de modo que tanto las simula-
ciones como la implementacin del controlador sean
A1 0 0
realizables, evitando la presencia de modos demasiado
x(t) = 0 A2 0 x(t) (20)
rpidos.
0 0 A3
Broll 0 0 w1 z1
z1 (t) = q2 (21) w1
q3
z2
con Wu
q1 z1
K(s) + G(s)
1 u
f1 y
q2 .. 0 0,5
x= 2
u = . Ai=1,2,3 =
0 0 Wn +
f6
q3 w2
3
0 0
Broll = 1 Blat =1
Figura 17. Esquema LFT para el diseo correspondi-
Ix I`
ente al diagrama en bloques de la planta aumen-
Ix es el momento de inercia respecto del eje longitu- tada.
dinal x del vehculo e I` respecto de los ejes laterales
y y z. La matriz Bca da la ubicacin de los actu-
adores (control allocation), que se obtiene de acuerdo 9.2.2. Simulaciones En la Figura 18 se indica el
al diseo en (Servidia y Snchez Pea, 2002). En perfil de la nariz del cohete durante la trayectoria de-
este trabajo consideraremos al funcionamiento nom- seada, de modo de ensayar el sistema de navegacin
inal, sin fallas, del sistema de control. En el caso y control. Es un doble cono realizado alrededor de la
de fallas en las toberas, la dinmica pasa a ser lin- vertical del lugar con la punta del vehculo apuntando
eal y de parmetros variantes en el tiempo (LPV) y al zenith, de modo que las antenas del receptor puedan
R. S. Snchez, R. J. Alonso 17
1
El modelo se linealiza alrededor de la orientacin Y
(25)
nominal deseada descrita anteriormente. Los ngulos hz 0,06 Nms
0,1 /s
de roll, pitch y yaw alrededor de este punto de equilib- P
1
rio se indican como: R , P , y Y respectivamente. P
Los valores incrementales de los momentos de las hy 0,06 Nms
ruedas de inercia son hy en pitch y hz en yaw.
Para simplificar, asumimos los de la terna del satlite La inversa de estas cotas se utilizan en los pesos que
coincidentes con los ejes se incluyen en la resolucin del problema de opti-
de inercia principales, i.e. mizacin LQR. Las cotas de hz y hy corresponden
IT = diag Ix Iy Iz . Debido al acoplamiento entre
los ejes de roll y yaw resulta: a una mxima desviacin de 400 rpm, respecto de la
velocidad nominal de las ruedas de inercia (3000 rpm).
20 Control de Vehculos Espaciales
La seal de control y ganancia esttica calculada a Figura 24. Transformacin Lineal Fraccional para el
travs de la correspondiente ecuacin de Riccati es: anlisis de robustez y performance.
R Para realizar el anlisis robusto del sistema de control
R se adopta el formato de LFT en donde se interconectan
Twz
Tmz
xY las porciones nominales e inciertas, los pesos para
= FR FY Fhz 023
Twy
hz performance e incertidumbre como se indica en la
022 022 021 FP
P Figura 24. El sistema a lazo cerrado nominal es la
Tmy
P interconeccin lineal fraccional R(s) = F` (P, K),
hy siendo p las entradas de perturbacin, e las salidas a
acotar y (u , y ) las entradas y salidas relacionadas
con la incertidumbre, mencionadas en la seccin ante-
10.4 Anlisis (robusto) del controlador rior. Se agregan escalajes en las entradas y salidas de
modo de normalizar las condiciones de performance
y robustez, como se indica en la Figura 24. Los pares
La dinmica de lazo cerrado toma en consideracin
de perturbacin se deben principalmente al efecto del
slo el modelo rgido del satlite y de la estructura
frenado aerodinmico de la atmsfera en los ejes de
(boom). Por lo tanto los modos flexibles de la estruc-
yaw y pitch con una cota mxima de 105 Nm, y los
tura pueden tomarse como incertidumbre dinmica
debidos al momento magntico residual en roll con un
global de alta frecuencia. Para ello se utiliza informa-
mximo de 106 Nm. El error de medicin angular en
cin experimental provista por el fabricante del mismo
el sensor de horizonte es del orden de 0,3 en roll y
(Steen-Larsen, 1995) de modo de calcular la distribu-
pitch. El error de velocidad angular en los mismos ejes
cin en frecuencias de esta incertidumbre. Dentro de
se deriva del bit menos significativo (LSB) y resulta
este esquema, la dinmica incierta del boom se repre-
del orden de 0,01 /s. Los errores en la velocidad de las
senta de la siguiente manera:
ruedas de inercia que producen errores en el momento
angular en yaw (hz ) y pitch (hy ) llegan a un valor
4 Tpx 4 R
mximo del 2 % de hyo .
u = Gboom (s)y , u = , y =
Tpy P
Las condiciones necesarias y suficientes para garan-
Esto se justifica ya que la fuerza de excitacin que tizar performance nominal, estabilidad robusta y per-
inicia las oscilaciones de la dinmica flexible es la formance robusta son (Snchez Pea y Sznaier, 1998;
rotacin angular del satlite en roll y pitch (la torsin Zhou et al., 1996):
alrededor de yaw es despreciable) Por otro lado, la
perturbacin del boom a la estructura del satlite se
representa por los pares (internos) aplicados a los ejes ER kW (s)R11 (s)WI1 (s)k 1 (26)
de roll y pitch debidos a estas oscilaciones. Los ex- PN kWp (s)R22 (s)WI2 (s)k 1 (27)
perimentos en (Steen-Larsen, 1995) determinan una
dinmica de frecuencias del orden de 1 Hz. En con- PR sup [WO R(s)WI ] 1 (28)
s=
secuencia, un peso adecuado que cubre esta incer-
tidumbre de alta frecuencia del boom y que asume respectivamente, siendo
un error de modelado de hasta un 20 % a bajas fre-
5s+
cuencias es W (s) = 0,4 s+2 I22 .
W (s) 0
La especificacin de performance mantiene acotados WO =
0 Wp (s)
los estados y las acciones de control de las MWs y las
MTCs. Por lo tanto un peso adecuado para evaluar la WI1 (s) 0
WI =
performance consiste en una matriz diagonal Wp con 0 WI2 (s)
la inversa de las cotas en (24) y (25) como elementos R (s) R12 (s)
R(s) = 11
diagonales. R21 (s) R22 (s)
R. S. Snchez, R. J. Alonso 21
10.5 Simulaciones
Jurdjevic, V. (1997). Geometric Control Theory. Cam- permite expresar en la terna z, cualquier vector que se
bridge University. halle expresado en la terna v. Luego,
Kuipers, Jack (1998). Quaternion and Rotation Se- rz = Cvz rv
quences. Princeton University Press. Princeton,
sz = Cvz sv
New Jersey.
Lin, Ching-Fang (1990). Modern Navigation, Guid- tz = Cvz tv , (A.1)
z
ance, and Control Processing. Prentice Hall Se- donde, () representa al vector () expresado en la
ries. terna z. Idnticamente con ()v . La matriz de rotacin
Martinelli, Marcela y Ricardo S. Snchez Pea (2005). se calcula como,
Passive 3-axis attitude control of MSU-1 pico Cvz = [rz sz tz ] [rv sv tv ]
1
, (A.2)
satellite. Acta Astronautica 56, 507517.
Modi, V.J. (1995). On the semi-passive attitude con- Para generalizar la manera de encontrar esta matriz de
trol and propulsion of space vehicles using so- rotacin se utilizan los mismos vectores unitarios, z y
lar radiation pressure. Acta Astronautica 35, 231 v
246. Cvz = A = [(iv )z (jv )z (kv )z ] , (A.3)
Snchez Pea, Ricardo S. (2004). LTI and LPV tech- donde, [iv , jv , kv ] son los versores que definen la
niques in FTC: a sounding rocket example. en terna v y (iv )z representa la proyeccin del vector
revisin IEEE Transactions on Aerospace and unitario iv de la terna v en la terna z. Similarmente
Electronics Systems. con jv y kv .
Snchez Pea, Ricardo S., Roberto Alonso y Pablo Sobre la matriz A existen seis restricciones, las
Anigstein (2000). Robust optimal solution to the primeras tres tienen que ver con la longitud de los vec-
attitude/force. IEEE Transactions on Aerospace tores [iv , jv , kv ] que deben ser unitarios. Las restantes
and Electronic Systems 36(3), 784792. tres, son debidas a la ortogonalidad del sistema de
Snchez Pea, Ricardo S. y Mario Sznaier (1998). coordenadas. Estas restricciones se escriben en forma
Robust Systems Theory and Applications. John matricial como: A AT = AT A = I33 , i.e. la inversa
Wiley & Sons, Inc. es igual a la transpuesta y A R3 es ortogonal.
Servidia, Pablo y Ricardo S. Snchez Pea (2002). En general, el determinante de toda matriz ortogonal
Thruster design for the attitude/force control of tiene valor 1, i.e. det(A)2 = det(A) det(AT ) =
spacecraft. IEEE Transactions on Aerospace and det(A AT ) = det(I33 ) = 1.
Electronic Systems 38(4), 11721180.
Shuster, Malcolm (1993). A survey of attitude repre- En (Goldstein, 1950) se desarrolla el concepto de sim-
sentations. The Journal of the Astronautical Sci- ilaridad entre una matriz de pequeas rotaciones y los
ences 41(4), 439517. espacios vectoriales. Para rotaciones infinitesimales,
Sidi, Marcel J. (1997). Spacecraft Dynamics and Con- la matriz A puede escribirse como, A I + , siendo
trol. Cambridge Aerospace Series. Cambridge I = I33 para simplificar. Luego
University Press. A A1 (I + ) (I ) = I + = I (A.4)
Steen-Larsen, H. (1995). Boom test: Experimental asumiendo como un error de segundo orden,
values for eigenfrequencies, torsion and flexure. siendo sencillo probar que A1 = I .
Technical report. Per Udsen Co.
Sutton, George (1992). Rocket Propulsion Elements. La matriz de rotacin siempre se puede representar
John Wiley and Sons, Inc. como la exponencial de una matriz antisimtrica, A =
Wertz, James R., Ed.) (1978). Spacecraft Attitude De- exp [1 E1 + 2 E2 + 3 E3 ] donde {E1 , E2 , E3 } se
termination and Control. D. Reidel Publishing definen como:
Co.. Dortrett The Netherlands.
Wiesel, William E. (1997). Spacecraft Dynamics. Mc 0 0 0 0 0 1 0 1 0
0 0 1 , 0 0 0 , 1 0 0
Graw Hill.
0 1 0 1 0 0 0 0 0
Zhou, K., John C. Doyle y Keith Glover (1996). Feed-
back Control Theory. PrenticeHall. y el vector, = [1 , 2 , 3 ] es interpretado como
el producto del ngulo de rotacin, y el eje de
giro, 1 , luego = 1 . En general se representa
A = exp [S ()], donde S es un isomorfismo S :
Apndice A. MTODOS DE REPRESENTACIN
R3 SP3 (R), donde SP3 (R) es el grupo simpltico
DE LA ACTITUD
de matrices antisimtricas reales de 3 x 3 (en detalle
en (Jurdjevic, 1997)):
A.1 Matriz de Rotacin
0 tz ty
La matriz de rotacin se construye a partir de una S(t) = tz 0 tx (A.5)
trada de vectores linealmente independientes que se ty tx 0
pueden expresar en dos ternas de referencia. Sean los Es til mencionar que el eje de rotacin 1 coin-
vectores, r, s, t y sea Cvz la matriz de rotacin que cide con el autovector de A asociado al autovalor
R. S. Snchez, R. J. Alonso 23
unitario. El ngulo de rotacin y los componentes el desplazamiento general de un cuerpo rgido con un
del eje de rotacin pueden ser calculados usando punto fijo es una rotacin alrededor de un nico eje.
la frmula de Rodrguez (Shuster, 1993) cos() =
1
2 (traza(A) 1).
Ary 053 Bry 052
A= , B=
035 Ap 032 Bp
022
2
1
3o (Iz Ix )
0
0 0
Iz
Iy
Ap = B = 022
1 0 0 p
0 1
0 0 0
I
y
022
0 0
0 0
1 1
Bry = , Ary =
Iz Iz
0 0
1 0
T
o (Iy Iz Ix ) hy
0 1 0 0
Iz
(4o (Iz Iy ) + hy )o
0 0 0 0
Ix
(o (Ix + Iz Iy ) + hy )
0 0 1 0
Ix
o (o (Ix Iy ) + hy )
0 0 0 0
Iz
o
0 0 0 0
Ix
View publicat