Calculo 2
Calculo 2
Calculo 2
PROFESOR GUÍA:
MARCOS DÍAZ QUEZADA
MIEMBROS DE LA COMISIÓN:
JAVIER RUIZ DEL SOLAR SAN MARTIN
MARCOS ORCHARD CONCHA
SANTIAGO DE CHILE
2018
RESUMEN DE LA MEMORIA PARA OPTAR AL TÍTULO DE
INGENIERO CIVIL ELECTRICISTA
POR: GUSTAVO HERNÁN DÍAZ HUENUPÁN
FECHA: 10 de abril de 2018
PROFESOR GUÍA: DR. MARCOS DÍAZ QUEZADA
Los satélites artificiales actualmente han mostrado ser de gran relevancia en diferentes
ámbitos. Esto se puede ver en el uso que hacen de ellos tecnologı́as como el GPS, las telecomu-
nicaciones entre teléfonos móviles y televisión satelital, informes meteorológicos, y diversos
temas de investigación cientı́fica tanto terrestre como espacial.
En el contexto de fomentar el desarrollo de proyectos aeroespaciales destaca el estándar
CubeSat, que facilita el diseño y manufactura de satélites a bajo costo, generando particular
interés por parte de Universidades y Centros de Investigación en ésta área. Parte del estándar
es que el satélite se desarrolla para estar contenido en cubos de 10x10x10cm y con un peso
no mayor a 1.33Kg. Además se clasifican de acuerdo al número de cubos o unidades que
componen el satélite, siendo configuraciones usuales los CubeSat 1U, 2U, 3U y 6U.
En Chile algunas iniciativas en este ámbito han sido los satélites FASat-Bravo, desa-
rrollado por la Universidad británica de Surrey en conjunto con la Fuerza Aérea de Chile,
y el FASat-Charlie desarrollado por la división Astrium del grupo europeo EADS. En
Junio de 2017 se lanzó el satélite SUCHAI 1, primer CubeSat desarrollado en Chile, por
el laboratorio SPEL de la Universidad de Chile, gracias a la colaboración de sus alumnos,
profesores e ingenieros.
El satélite SUCHAI 1 cuenta además de los sistemas de computador a bordo, sistema
de comunicaciones y sistema de energı́a, con cuatro payloads de carácter cientı́fico. Sin em-
bargo carece de los sensores y actuadores necesarios para poder orientar el satélite en una
determinada dirección. En este contexto surge el desarrollo de este trabajo con la finalidad
de incorporar un sistema de control de orientación para las versiones 2 y 3 del satélite que
serán de tres unidades y se estima serán lanzados en 2018.
Este sistema otorga la capacidad de realizar movimientos precisos de alineación median-
te el satélite, tales como apuntar antenas hacia estaciones terrenas para un mejor enlace
de comunicación, u otros instrumentos de medición del mismo hacia algún objeto o región
especı́fica del espacio, como por ejemplo las cámaras. También serı́a posible mediante este
sistema lograr una comunicación entre satélites, alineando sus respectivas antenas, y otras
maniobras de coordinación.
En este trabajo se implementó un algoritmo de control de orientación en 3 ejes mediante
cuaterniones usando ruedas de reacción, con un correcto desempeño en las pruebas de soft-
ware. Sin embargo una restricción importante para este proyecto es el presupuesto, por lo
cual se desarrolló un prototipo de bajo costo que logró un correcto desempeño para el control
en un eje en la plataforma Air bearing, quedando como parte del trabajo futuro las pruebas
de control en los 3 ejes y su integración en las próximas versiones del satélite SUCHAI.
i
A mi Familia y Amigos.
ii
Agradecimientos
Este trabajo representa la conclusión de un extenso y arduo proceso de formación, un
maravilloso viaje a través de las ciencias, el pensamiento y la razón, un camino con paisajes
agradables y otros no tanto, repleto de descubrimientos y que felizmente he recorrido junto a
muchos seres queridos que respeto profundamente. A ellos van dirigidas estas palabras, puesto
que cada uno en sus más diversas formas a sido esencial durante esta valiosa experiencia.
Comienzo agradeciendo a Mónica mi Madre quien me inspiró muchos de los valores que
considero fundamentales, y que hubiese estado feliz con este logro. A Raúl mi Padre quien es
la persona más trabajadora que conozco, de quien también he aprendido valores importantes
y estaré siempre agradecido por su incondicional apoyo en francamente todo lo que estuviese
a su alcance. A Mari quien me ayudo siempre que se lo pedı́. A Felipe mi hermano por todo su
apoyo, sobre todo en los momentos complicados, pese a cualquier diferencia que tuviéramos.
Agradezco profundamente a mi tı́a Marisol y queridos primos, Pame, Elias, Judith y
Camilo, quienes han estado presentes en cada momento importante, brindando su apoyo de
todas las formas posibles, y estando siempre disponibles para una conversación, un consejo,
celebraciones y todo lo que pudiese necesitar. He aprendido y disfrutado mucho con ustedes y
los quiero demasiado. No es posibles mencionar a toda mi familia, pero cada uno de ustedes a
aportado grandes cosas a mi vida, agradezco particularmente a mis abuelos, personas de gran
valor de quienes aprendı́ muchas cosas. A mis grandes amigos, Daniel, Kevin, Amanda, Óscar,
Jacqueline, Vı́ctor, con quienes una conversación nunca fue trivial, desde cosas cotidianas
hasta la metafı́sica, gracias por aquellos entretenidos debates y todos los momentos vividos.
A todos mis compañeros de eléctrica, de plan común, y del liceo.
Agradezco profundamente al profesor Marcos Dı́az por confiar en mı́ y darme la oportu-
nidad de realizar este trabajo, por sus consejos, y las más diversas conversaciones. A todos
los integrantes del SPEL, quienes me recibieron con mucho cariño, particularmente a Samuel
con quien tuve entretenidas discusiones sobre fı́sica y Javier quien me ayudó cuantas veces
se lo pedı́ y más. Al profesor Marcos Orchard por su asesorı́a en este trabajo.
También agradezco al profesor Javier por sus agudas observaciones en cada proyecto y
por confiar en mı́ para ser auxiliar de Mecatrónica. A todos los integrantes de Bender en
Robótica por haberme recibido tan afectuosamente, particularmente a Luz por permitirme
ser parte del equipo, por ser tan buenos amigos, con ustedes aprendı́ muchas cosas interesantes
y entretenidas. A Isao y Rodrigo por su constante asesorı́a y buena disposición.
Hay muchos a quienes no alcanzo a mencionar, pero todos ustedes con quienes he com-
partido, disfrutado y aprendido, que me han acompañado y lo seguirán haciendo de alguna
forma en esta aventura, a todos ustedes les agradezco sinceramente.
iii
Tabla de Contenido
1. Introducción 1
1.1 Motivación . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 1
1.2 Antecedentes . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2
1.3 Objetivos y Alcance . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 3
1.4 Estructura de la Memoria . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4
3. Modelos Matemáticos 12
3.1 Cinemática del satélite . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12
3.2 Dinámica del satélite . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 14
3.3 Ecuaciones dinámicas en Air Bearing . . . . . . . . . . . . . . . . . . . . . . . 15
3.4 Dinámica de las Ruedas de Reacción . . . . . . . . . . . . . . . . . . . . . . . 16
3.4.1 Motor de Corriente Continua . . . . . . . . . . . . . . . . . . . . . . . 17
3.4.2 Motor BLDC . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 18
3.4.3 Modelo Ruedas de Reacción . . . . . . . . . . . . . . . . . . . . . . . . 20
3.5 Maniobras de control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 20
3.5.1 Control en Yaw . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 20
3.5.2 Control en Pitch y Roll . . . . . . . . . . . . . . . . . . . . . . . . . . 21
3.5.3 Control en 3 Ejes . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 21
iv
4.1.4 Placa de conexiones . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 26
4.2 Interfaz de usuario . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 27
4.2.1 Protocolo de Comunicación . . . . . . . . . . . . . . . . . . . . . . . . 27
4.2.2 Interfaz de Control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 28
4.2.3 Visualización de Datos . . . . . . . . . . . . . . . . . . . . . . . . . . . 30
4.3 Simulaciones en Gazebo . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 30
Bibliografı́a 55
Anexos 58
A. Plataforma Air Bearing utilizada . . . . . . . . . . . . . . . . . . . . . . . . . 58
B. Transformaciones entre ángulos de Euler y Cuaterniones . . . . . . . . . . . . . 59
C. Placa de Conexiones . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 60
v
Índice de Tablas
vi
Índice de figuras
vii
33. Seguimiento de referencias escalón de orientación en 3 ejes. Cuaternion de error
y Comando de torque. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 41
34. Seguimiento de referencia de orientación en 3 ejes. Velocidades R.R y satélite. 41
35. Rueda de reacción con imanes. . . . . . . . . . . . . . . . . . . . . . . . . . . 42
36. Velocidad de la rueda, medida y filtrada. . . . . . . . . . . . . . . . . . . . . 43
37. Velocidad de la rueda, medida con sensor de efecto hall y con tacómetro. . . 43
38. Corriente del motor, medida y filtrada. . . . . . . . . . . . . . . . . . . . . . 44
39. Prueba en Cámara de Vacı́o. a) Voltaje Motor y b)Presión en la cámara. . . 45
40. Prueba en Cámara de Vacı́o. Temperatura del motor. . . . . . . . . . . . . . 45
41. Control de corriente en lazo cerrado Motor eje Z. Seguimiento de referencia. 47
42. Control de corriente en lazo cerrado Motor eje Y. Seguimiento de referencia. 47
43. Control de velocidad en lazo cerrado. Seguimiento de referencia. . . . . . . . 49
44. Control de ángulo yaw para referencia de 100◦ . . . . . . . . . . . . . . . . . . 50
45. Control de ángulo yaw para referencia de 100◦ . Gráfico controlador de corriente. 51
46. Configuración prueba de equilibrio. . . . . . . . . . . . . . . . . . . . . . . . 52
47. a) Cuaternion de orientación durante prueba de equilibrio. b) Ángulo ψ. . . 52
48. a) Ángulo θ y b) Ángulo φ, durante prueba de equilibrio. . . . . . . . . . . . 53
49. Plataforma de pruebas Air Bearing. . . . . . . . . . . . . . . . . . . . . . . . 58
50. Esquemático placa de conexiones. . . . . . . . . . . . . . . . . . . . . . . . . 60
51. PCB layout placa de conexiones. . . . . . . . . . . . . . . . . . . . . . . . . 61
viii
1 Introducción
1.1 Motivación
Los satélites artificiales actualmente constituyen una tecnologı́a de gran relevancia para
las comunidades tanto civil, cientı́fica y militar. Esto se puede ver en el uso que hacen de
ellos otras tecnologı́as ampliamente usadas como los GPS, las telecomunicaciones entre teléfo-
nos móviles y televisión satelital, informes meteorológicos, y diversos temas de investigación
cientı́fica tanto terrestre como espacial.
Sin embargo existen también algunas compañı́as dedicadas al desarrollo de este tipo de
satélites y/o a la venta de subsistemas para los mismos, pero estos son en general de alto
costo. Lo anterior y las iniciativas en el resto del mundo por soluciones de bajo costo motiva
el desarrollo de esta tecnologı́a en el paı́s.
1
1.2 Antecedentes
En chile los primeros hitos en naves aeroespaciales corresponden a los satélites FASat-
Alpha (1995, fallido) y FASat-Bravo (1998 al 2001), desarrollados bajo un programa de
transferencia tecnológica entre la Fuerza Aérea de Chile (FACh) y la Universidad británica
de Surrey. Posteriormente se encuentra el FASat-Charlie (2011 al presente) encargado
por el Ministerio de Defensa al fabricante europeo EADS Astrium y operado por la FACh en
conjunto con la Universidad de Concepción.
El satélite en órbita es un CubeSat de una unidad (1U) y cuenta además de los sistemas de
computador a bordo, sistema de comunicaciones y sistema de energı́a, con cuatro payloads de
carácter cientı́fico. Estos son el experimento Sonda Langmuir para el estudio de la ionósfera,
el experimento para el estudio de electrónica fuera del equilibrio, una cámara junto con un
acelerómetro para la observación terrestre y un GPS para obtener la posición del satélite.
Uno de los problemas que presenta la actual versión del satélite es que carece de actua-
dores para poder orientar el satélite en una determinada dirección, además de disponer de
datos poco precisos de orientación. En este contexto surge el desarrollo de este trabajo con
la finalidad de incorporar un sistema de control de orientación para las versiones 2 y 3 del
satélite que serán de tres unidades y se estima serán lanzados en 2018.
2
1.3 Objetivos y Alcance
El objetivo del trabajo de memoria es desarrollar un sistema de control de orientación
para el nano-satélite SUCHAI, basado en ruedas de reacción y un sistema de navegación
inercial. El sistema debe ser validado con pruebas en la plataforma rotacional Air Bearing 1 .
De esto se desprenden los siguientes objetivos especı́ficos:
• Implementar un driver para la operación del motor BLDC que junto a un disco de giro
conforma las ruedas de reacción.
• Diseñar y aplicar un algoritmo de control que permita mantener una orientación deseada
considerando dos ejes espaciales.
• Proveer una interfaz de usuario que permita maniobrar la orientación del satélite de
forma remota. La interfaz debe además proporcionar una interfaz para modificar los
parámetros del algoritmo de control.
• Dejar una plataforma con el sistema implementado que sea funcional y permita una
posterior integración con los demás sistemas del satélite.
1
El modelo especı́fico utilizado puede verse en Anexo A
3
1.4 Estructura de la Memoria
El trabajo realizado se presenta en este documento organizado en siete capı́tulos cuyos
objetivos principales se describen a continuación.
Capı́tulo 1: Introducción
Se explican los conceptos necesarios para comprender el trabajo desarrollado, una revisión
bibliográfica del estado del arte, el método propuesto y el hardware ha utilizar.
Se plantean las ecuaciones que describen la dinámica y cinemática del satélite, junto con
modelos de los motores utilizados. Finalmente se presentan las funciones de transferencia a
considerar para el control de orientación en cada uno de los ejes.
Se presentan los métodos utilizados para determinar los parámetros relevantes del satéli-
te y los esquemas de control a utilizar junto con simulaciones en Matlab de control de los
motores y de orientación en tres ejes.
Se presentan los resultados de las pruebas realizadas con el prototipo, evaluando el desem-
peño de los diferentes controladores en los distintos modos de operación. Se discuten las es-
pecificaciones finales del sistema desarrollado.
Capı́tulo 7: Conclusiones
4
2 Fundamentos Técnicos y Teóricos
Entre las técnicas de control de orientación se distinguen los métodos de control Pasivos
y Activos. Los primeros usan los fenómenos fı́sicos que se producen de forma natural durante
la órbita del satélite para diseñar la estructura del mismo de modo de aumentar el efecto de
alguna fuerza y reducir el efecto de otras. En el segundo caso se utilizan sensores para obtener
la orientación del satélite y actuadores para modificar la misma de acuerdo a lo requerido.
Ésta última clase de métodos utilizan el concepto de control por retroalimentación y son los
usados en las misiones que requieren precisión.
Durante las últimas tres décadas se han estudiado extensamente numerosos algoritmos de
control activos [1, 6, 7, 9], desde leyes de control proporcional derivativas hasta técnicas de
control adaptativo [1] y control adaptativo basado en lógica difusa [11]. Gracias a esto y al
desarrollo de la electrónica, los centros de investigación han podido desarrollar sistemas de
reducido tamaño y presupuestos moderados [8, 4]. Aun ası́ la aplicación de estos estudios a
nano-satélites tipo CubeSat con bajo presupuesto sigue siendo un desafı́o y campo de inves-
tigación en el área de la Ingenierı́a Espacial. Esto es particularmente cierto en Chile donde
este tipo de tecnologı́as no llevan muchos años de desarrollo.
5
2.1.1 Estado del Arte
En la actualidad se han implementado sistemas de control de orientación para nano-satéli-
tes tipo CubeSat mediante el uso de Magnetorquers y ruedas de reacción de reducido tamaño,
del orden de 1/8U CubeSat en el caso de [3]. En este caso el sistema es desarrollado mediante
componentes de tipo COTS (Commercial off-the-shelf ), y logran un sistema con un consumo
de 4[W ] capaz de maniobrar el satélite en los tres ejes mediante ambos actuadores e incluso
incluyendo una interfaz de comunicación serial con el mismo. En este caso utilizaron una ley
de control proporcional.
En [12] se realiza un estudio sobre la elección óptima de ruedas de reacción para pequeños
satélites, mediante simulación de modelos matemáticos y variación de parámetros. En este
trabajo validan sus resultados mediante una plataforma de pruebas rotacional Air Bearing.
Dado que uno de los objetivos es implementar un sistema de bajo costo y mediante com-
ponentes tipo COTS, se propone además para este trabajo de memoria, implementar la rueda
de reacción mediante un motor BLDC de disco duro. Para esto se utilizará un driver sen-
sorless para la operación del motor y sensores de efecto hall para medir la velocidad del disco.
En este trabajo se utilizan leyes de control PI para los motores y PD para control de
la orientación, que como se ha mostrado en la revisión bibliográfica, ha obtenido resultados
satisfactorios para los casos donde se han usado ruedas de reacción como actuador.
6
2.2 Orientación de Satélites
2.2.1 Sistemas de Referencia
Para poder determinar y actuar sobre la orientación del satélite es necesario definir el
sistema de referencia en base al cual se formulan los modelos. La elección del sistema de
coordenadas implica la elección de una referencia de posición absoluta para el sistema y la
ubicación del origen del sistema de referencia. Existen variados sistemas de referencia uti-
lizados en la literatura, siendo ampliamente usados los denominados Sistema de referencia
móvil (SRM) y Sistema de Referencia Inercial (SRI). Los vectores medidos con respecto al
sistema de referencia inercial son llamados absolutos y los medidos con respecto al sistema
de referencia móvil serán llamados relativos. En particular en este trabajo se utilizará la no-
tación presentada en [2].
Se escoge como origen del sistema el centro de la tierra y fijo con respecto a las estrellas.
ˆ J,
Se usará la notación (I, ˆ K̂) para los vectores unitarios y el subı́ndice I para indicar la
posición de un punto P (xI , yI , zI ) en este sistema de referencia. El vector unitario K̂ coincide
con el polo norte geográfico. Otra definición de este tipo de sistema es que se cumplen las
Leyes del Movimiento de Newton, sin la necesidad de fuerzas ficticias o inerciales.
Este sistema de referencia se usa para determinar la posición y orientación del satélite
con respecto a otro sistema de referencia. Estos ejes pueden estar moviéndose libremente o
ligado a un cuerpo. En este último caso el sistema se traslada y rota junto con el objeto,
y se denomina sistema de referencia del cuerpo (SRC) o Body Frame; en el caso de satéli-
tes se suele además escoger el centro de masa del mismo como origen del sistema de referencia.
En la fig.1a) [2] se muestra el SRC con origen O, ubicado en el centro de masa del cuerpo y
determinado por los vectores unitarios (î, ĵ, k̂) en un sistema de referencia inercial con origen
OI . En la fig.1b) se muestra el sistema de referencia orbital (SRO), cuyo origen se mueve con
el centro de masa del satélite y queda descrito por los vectores ZR apuntando hacia el centro
de masa de la tierra, XR en el plano de la órbita en la dirección de la velocidad del satélite,
e YR normal al plano local de la órbita. Además el origen del SRI se sitúa en el centro de
masa de la tierra. Se usa el subı́ndice B para indicar la posición de un punto P (xB , yB , zB )
en el SRC.
7
a) b)
La notación a usar para los ángulos de Euler es φ alrededor del eje XB , θ alrededor de
YB y ψ alrededor de ZB .
cos θ cos ψ cos θ sin ψ − sin θ
Aψθφ = − cos φ sin ψ + sin φ sin θ cos ψ cos φ cos ψ + sin φ sin θ sin ψ sin φ cos θ (1)
sin φ sin ψ + cos φ sin θ cos ψ − sin φ cos ψ + cos φ sin θ sin ψ cos φ cos θ
8
números ~q = (q1 , q2 , q3 , q4 ) = (~
q3 , q4 ), donde q~3 es llamado la parte vectorial y q4 es llamado
la parte escalar. En este caso la matriz de transformación queda dada por la (ec.2). Una
revisión más detallada de esta representación se puede ver en [2].
q12 − q22 − q32 + q42 2(q1 q2 + q3 q4 ) 2(q1 q3 − q2 q4 )
A(q) = 2(q1 q2 − q3 q4 ) −q12 + q22 − q32 + q42 2(q2 q3 + q1 q4 ) (2)
2(q1 q3 + q2 q4 ) 2(q2 q3 − q1 q4 ) −q12 − q22 + q32 + q42
Sin embargo, uno de los principales desafı́os al trabajar con las IMU es implementar
algoritmos que permitan obtener datos precisos a partir de las mediciones del dispositivo.
Esto se debe a que tanto los acelerómetros como los giróscopos están sujetos a perturbacio-
nes debidas a su construcción y funcionamiento. De esta forma cada uno de los sensores por
separado entregan una medición poco confiable por si sola, pero dada la naturaleza de sus
perturbaciones es posible combinar ambas mediciones para obtener una estimación óptima.
Los algoritmos tı́picamente usados [14, 15] para esto son el Filtro Complementario y el Filtro
de Kalman.
EL MPU6050 incluye además hardware especı́fico que procesa los datos adquiridos por el
mismo. Esta unidad de procesamiento es el DMP (del ingles Digital Motion Processor ), y es
capaz de filtrar y combinar los datos en una representación 3D con una precisión ya aceptable
para ciertas aplicaciones. Las referencias usadas por el MPU6050 para las mediciones de
orientación se muestran en la fig.2, tomada de la hoja de datos del dispositivo.
2
Hoja de datos en https://www.invensense.com/wp-content/uploads/2015/02/MPU-6000-Datasheet1.pdf
9
Figura 2: Orientación y sentido de rotación ejes MPU6050.
Estos motores están compuestos tı́picamente por imanes permanentes que giran en torno
a la armadura, lo cual elimina los problemas de desgaste presentes en los motores con es-
cobillas, además de reemplazar el conmutador por un controlador electrónico, permitiendo
la implementación de la conmutación en software. Esto último ofrece una mayor flexibilidad
para controlar la operación del motor. Sin embargo estos motores requieren un driver más
complejo para su operación que los motores DC con escobillas.
En particular para el desarrollo de este proyecto se utiliza un motor BLDC de disco duro
como el mostrado en la fig.3. Este motor posee 12 polos, tiene un voltaje nominal de 12[V] y
es capaz de girar a una velocidad nominal de 10.000 [RPM] por largos periodos de tiempo.
10
2.3.3 Driver Motor BLDC
En este trabajo se propone la evaluación de un controlador de velocidad electrónico, tam-
bién conocido como ESC por sus siglas en ingles, para la operación del motor. Este dispositivo
ofrece un control sencillo de la velocidad de estos motores mediante modulación PWM. En
particular se usa el ESC TURNIGY Basic 18A3 , que permite controlar velocidades desde
35000 RPM(12 polos) hasta 210000 RPM (2 polos).
En la fig. 4 se muestra el tipo de ESC descrito. Posee 3 terminales para alimentar las
fases del motor, dos terminales para alimentación tanto del motor como del propio dispositivo
(11.1[V] en este caso) y un conector slim mediante el cual se conecta la señal PWM de control
(pines GND, 5V, SIG).
La ventaja de este dispositivo es que la velocidad del motor se puede variar solamente
con el ciclo de trabajo de la señal PWM, lo cual es sencillo de implementar en cualquier
microcontrolador. Estos dispositivos implementan un control en lazo abierto de la velocidad
mediante una estrategia denominada sensorless. Sin embargo presenta problemas para operar
el motor a bajas velocidades. Si dichas velocidades son o no adecuadas para el sistema de
control a implementar es parte de los resultados que se obtendrán.
3
Hoja de datos en https://hobbyking.com/media/file/407056493X1759697X24.pdf
11
3 Modelos Matemáticos
dω
α = +Ω×ω
dtrel
(3)
dω
= ω̇x î + ω̇y ĵ + ω̇z k̂
dt rel
12
De esta forma, considerando tres rotaciones consecutivas dadas por los ángulos Euler en
el orden ψ → θ → φ, la velocidad inercial del satélite queda dada por la Ec.(4)
ωx 0 0 φ̇
ω = ωy = Aφ Aθ Aψ 0 + Aφ Aθ θ̇ + Aφ 0
(4)
ωz ψ̇ 0 0
Con lo cual reemplazando las matrices es posible obtener las Ec.(5). Ası́ mediante la
velocidad angular del satélite, la que se puede obtener mediante la IMU permite calcular la
posición del satélite en el sistema de referencia inercial integrando dichas ecuaciones.
La Ec.(5) presenta dos importantes problemas, por una parte se indetermina para θ = 90◦ ,
y por otra su implementación requiere del cálculo de varias funciones trigonométricas, lo cual
representa un alto costo computacional. Debido a lo anterior se suele utilizar la Ec.(6) que
corresponde a la formulación equivalente expresada en cuaterniones.
0 ωz −ωy ωx
dq 1 0 0 −ωz 0 ωx ωy
= Ωq , Ω =
ωy −ωx
(6)
dt 2 0 ωz
−ωx −ωy −ωz 0
Luego para obtener una representación en ángulos de Euler a partir del cuaternion de
estado existen conocidas representaciones, la usasda en este trabajo se puede ver en Anexos.
Como se mencionó antes, en el caso de la IMU utilizada en este trabajo el DMP im-
plementa un filtro y fusión de datos, entregando una orientación en ángulos de Euler o en
cuaterniones dependiendo de cómo se configure. En este trabajo se utilizaron ambas configu-
raciones.
13
3.2 Dinámica del satélite
La dinámica del satélite queda determinada principalmente por su momento angular y el
torque actuando sobre el mismo. En el caso general ilustrado en la Fig.6 para un satélite con
i ruedas de reacción (R.R.), el momento angular del cuerpo relativo al centro de masa G del
sistema de acuerdo a [16] es HGbody = IGbody ω, siendo IGbody el momento de inercia (M.I.) del
cuerpo relativo a G, sin considerar las ruedas de reacción.
(s) (i)
Pn Pn (i) (i)
HG = IG + I
i=1 Gi ω + i=1 IGi ωrel
(i)
(i) (i)
(7)
= IGbody + ni=1 IG ω + ni=1 IGi ωrel
P P
14
A partir de lo anterior es posible obtener la ecuación de movimiento del satélite calculando
la derivada de HG con respecto al S.R. inercial, conocida como ecuación de movimiento de
Euler, dada por la Ec.(8) en función del torque externo (MG )externo aplicado al sistema.
dHG
(MG )externo = + ω × HG (8)
dt rel
Los M.I. de las R.R. con respecto a sus propios centros de masa están dados por la
(1) (2) (3)
matrices diagonales IG1 = [I, J, J], IG2 = [J, I, J], IG3 = [J, J, I], y el M.I. del satélite es
(ν)
IG = [A, B, C]. Ası́ aplicando la Ec.(7) se obtiene:
(1)
A + I + 2J 0 0 ωx Iω
HG = 0 B + I + 2J 0 ωy + Iω (2)
0 0 C + I + 2J ωz Iω (3)
(10)
(A + I + 2J)ωx + Iω (1)
15
Luego la ecuación de movimiento se obtiene a partir de la Ec.(8):
(A + I + 2J)ω̇x + I ω̇ (1)
(C − B)ωy ωz + I(ωy ω (3) − ωz ω (2) )
MGx
MGy = (B + I + 2J)ω̇y + I ω̇ (2) + (A − C)ωx ωz + I(ωz ω (1) − ωx ω (3) ) (11)
MGz (C + I + 2J)ω̇z + I ω̇ (3) (B − A)ωx ωy + I(ωx ω (2) − ωy ω (1) )
Luego con algo de álgebra se obtienen las ecuaciones de movimiento para cada eje:
I ω̇ (1)
MGx B−C I (2) (3)
ω̇x = + ωy ωz + [ωz ω − ωy ω ] −
A + I + 2J A + I + 2J A + I + 2J A + I + 2J
MGy C −A I I ω̇ (2)
ω̇y = + ωx ωz + [ωx ω (3) − ωz ω (1) ] −
B + I + 2J B + I + 2J B + I + 2J B + I + 2J
MGz A−B I I ω̇ (3)
ω̇z = + ωx ωy + [ωy ω (1) − ωx ω (2) ] −
C + I + 2J C + I + 2J C + I + 2J C + I + 2J
(12)
Se puede observar que estas ecuaciones están acopladas entre sı́ y corresponde a un sis-
tema MIMO, puesto que las entradas corresponden a las velocidades de las ruedas ω (i) . La
estrategia utilizada en este trabajo para controlar este sistema corresponde a realizar tres
rotaciones consecutivas con respecto a cada eje. Con esto durante cada rotación alrededor
de alguno de los ejes la velocidad del satélite en los otros dos ejes se considerara nula y los
efectos debidos a las velocidades de las otras ruedas se consideran como perturbaciones.
16
3.4.1 Motor de Corriente Continua
Los motores de corriente continua (C.C.) por mucho tiempo fueron ampliamente utili-
zados en aplicaciones de control de velocidad y posición, debido a su sencillo principio de
funcionamiento, versatilidad en términos de operación y adecuada respuesta dinámica.
El motor de corriente continua esta compuesto por una parte fija llamada estator que
genera un campo magnético constante y una parte móvil llamada rotor o armadura que
corresponde a la parte rotatoria. El estator esta compuesto usualmente por electroimanes,
mientras que el rotor está compuesto por bobinas conectadas a una fuente de alimentación
mediante un conmutador mecánico compuesto por una serie de delgas y dos escobillas, tal
como se muestra en la Fig.8 a). Dependiendo de si la conexión entre el estator y el rotor es
en paralelo on en serie se distinguen los motores tipo shunt y serie respectivamente.
a) b)
Figura 8: Motor C.C a) Vista transversal de un motor de dos polos y b) Circuito equivalente.
El modelo del motor de C.C. descrito en detalle en [19] y [18] queda dado por las Ec.(13)
y está basado en el circuito equivalente mostrado en la Fig.8 b).
dia
vt = Ra ia + La + ea
dt
ea = KE ωm
(13)
Te = KT ia
dωm
Te = J + Bωm
dt
El control de velocidad del motor se logra variando el voltaje de alimentación vt . Esto
se realiza usualmente mediante rectificadores controlados que permiten generar un voltaje
continuo regulado por medio de modulación de ancho de pulso (PWM).
17
3.4.2 Motor BLDC
Como se ha mencionado los motores BLDC son motores sı́ncronos que usan inversores
para su operación. A diferencia de los motores de C.C los motores BLDC utilizan conmuta-
ción electrónica en lugar de mecánica por lo que solucionan los problemas de mantenimiento
debidos al colector y las escobillas.
El modelo para el motor BLDC basado en el circuito equivalente obtenido de [21] mostrado
en la Fig.10 queda determinado de acuerdo a [22] por la Ec.(14).
vab ia − ib ia − ib ea − eb
vbc = R ib − ic + L d ib − ic + eb − ec
dt (14)
vca ic − ia ic − ia ec − ea
dωm
Te = kf ωm + J + TL
dt
Donde v, i y e denotan los voltajes fase-fase, corrientes y fuerzas contra-electromotrices
asociadas a cada fase. Se tiene además que la fuerza contra-electromotriz de la fase i es función
18
de la velocidad y posición del rotor ei = k2e ωm Fi (θe ), con Fi (·) una función que depende de la
forma del rotor y la distribución de los devanados de estator, siendo usualmente una forma
de onda trapezoidal. Además el torque eléctrico puede ser expresado por la Ec.(15).
kt (ea ia + eb ib + ec ic )
Te = (15)
km ωm
El driver utilizado en este trabajo opera el motor de modo que mantiene siempre dos
fases energizadas, las que producen mayor torque, y la tercera fase flotando. De esta forma
asumiendo que no circula corriente en la fase flotante, de acuerdo a [21] se puede obtener un
modelo equivalente a la Ec.(15), dado por la Ec.(16).
dieq
vxy = Req ieq + Leq + Ke ω m
dt (16)
ex ix + ey iy
Te = = Ke ieq
ωm
El diagrama equivalente de este modelo se muestra en la Fig.11
19
3.4.3 Modelo Ruedas de Reacción
Basado en lo anterior se utilizará el modelo equivalente al motor de C.C. para el motor
BLDC dado por la Ec.(16). En este caso es necesario considerar la inercia de la rueda de
reacción y la velocidad relativa de la misma con respecto al estator. Con esto la dinámica de
la R.R. queda determinada por la Ec.(17).
diM
V = RM iM + LM + ω (i) kV
dt
TM = KM iM (17)
dω (i)
TM = I + Bω (i)
dt
(3)
(C + I + 2J)ω̇z + Bd ωz = −[TM − Bω (3) ] = −Tc (18)
20
3.5.2 Control en Pitch y Roll
El control en pitch corresponde a una rotación con respecto al eje Y, mediante la rueda
de reacción cuyo eje de giro coincide con dicho eje (ω (2) ). Durante la cual se considera ωx ≈
ωz ≈ 0 y ω (1) , ω (3) constantes. En este caso de las mismas ecuaciones Ec.(12) y Ec.(17) se
obtiene que la dinámica queda determinada por la Ec.(20). La ecuación que determina la
dinámica del movimiento en Roll es idéntica por simetrı́a.
(2)
M gL TM
ω̇y = sin θ − (20)
(C + I + 2J) (C + I + 2J)
qE1 qT 4 qT 3 −qT 2 qT 1 −qS1
qE2 −qT 3 qT 4 qT 1 −qS2
qT 2
qE =
qE3 = qT 2 −qT 1 qT 4
(22)
qT 3 −qS3
qE4 −qT 1 −qT 2 −qT 3 qT 4 qS4
21
4 Desarrollo del Sistema
En este capı́tulo se describen los aspectos relevantes del diseño de la plataforma tipo
cubesat 1U construida para realizar las pruebas de control de orientación. La construcción
de esta plataforma tiene el objetivo de poder verificar experimentalmente los modelos de la
dinámica de rotación del satélite bajo la acción de la gravedad terrestre.
22
Figura 12: Ensamblaje en SolidWorks del satélite.
4.1.2 Prototipo
La estructura se construyó mediante perfiles de aluminio y los soportes para montar
los motores y componentes electrónicos se fabricaron mediante impresión 3D. El prototipo
pasó por tres iteraciones en diseño, donde cambió principalmente la electrónica y la disposi-
ción de los componentes. En la Fig.13 se pueden ver las dos últimas versiones, siendo la foto
b) la estructura final, cuyas especificaciones de construcción se muestran en la Tabla 1.
a) b)
23
La electrónica del satélite consiste en una IMU, tres sensores de efecto hall para medir
la velocidad de cada una de las ruedas y tres sensores de corriente, uno para cada motor.
También se utiliza un módulo bluetooth para la comunicación con el satélite y un micro-
controlador Arduino Pro mini. En la Fig.14 se muestra un esquema general del sistema. Un
diagrama más detallado se puede ver en el esquemático de la placa de conexiones mostrada
en el Anexo C.
En la fig.16 se muestra el circuito que realiza la conmutación entre las fases R y T del
ESC al motor para realizar el cambio de dirección de giro. Este circuito posee una señal de
24
control que cuando está en estado LOW permite el paso de la fase R del ESC a través del
relé de arriba y de la fase T a través del relé de abajo, mientras que cuando su estado es
HIGH, el relé de arriba conecta la fase R del ESC a la fase T del motor y el de abajo conecta
la fase T del ESC con la fase R del motor, estableciendo un giro en el sentido contrario al
del estado anterior.
Figura 16: Circuito que realiza la conmutación entre las fases del motor.
Para la operación con este driver mediante el modelo del motor presentado, debe además
considerarse la relación entre el voltage requerido por el controlador y el PWM aplicado por
el driver. Para determinar esta relación se realizo una prueba en lazo abierto, para 12 valores
diferentes de PWM en el rango de operación y se midió el voltaje fase-neutro RMS en una de
las fases del motor, en régimen permanente. Con esos datos se realiza un ajuste cuadrático
de los parámetros, el cual se muestra en la Fig.17.
25
4.1.4 Placa de conexiones
La placa desarrollada tiene dos funciones principales, implementa un circuito que permite
la operación bidireccional de uno de los motores, y permite la conexión adecuada del resto
de los componentes. La PCB se puede ver en la Fig.18. Además van conectados a la placa
dos interruptores, uno general conectado a la baterı́a, y otro que permite reprogramar el
microcontrolador de forma segura. La especificación de cada conector en la placa se puede
revisar en el layout de la PCB en Anexo C.
26
4.2 Interfaz de usuario
La interfaz de usuario para operar el control de orientación del satélite consiste en tres
aspectos principales, por una parte un protocolo de comunicación que permite enviar co-
mandos al satélite y recibir datos del mismo mediante bluetooth de forma suficientemente
confiable. Por otra se encuentra el software que permite un uso compartido de los datos entre
los distintos procesos, para lo cual se utiliza software de ROS. Finalmente se encuentran las
interfaces de visualización de los datos.
Por cada frame se envian cuatro datos, cada uno de los cuales tiene un tamaño de 3 bytes.
El primer byte DHi es el High byte (byte superior) del dato i-ésimo, DLi es el low byte y SDi
contiene la parte decimal del dato en los primeros 7 bits y el signo en el bit restante. De esta
forma sea D = n.m el dato, con n su parte entera y m su parte decimal, el dato queda dado
por la Ec.(24), donde n ∈ {0, 65535}, m ∈ {0, 99} y se simbolizan las operaciones de bits
shift, and y or mediante los sı́mbolos <<, & y | respectivamente.
n + m
n = (DH << 8)|DL Si signo = 0
m = SD&(0b01111111) ⇒ D = 100 (24)
−(n + m ) Si signo = 1
signo = SD >> 7 100
Por otro lado el primer byte del frame es un identificador que permite enviar otra serie
de datos. Finalmente el último byte corresponde a una suma de verificación o checksum, que
es la suma de los bytes anteriores, y permite verificar la integridad de los datos recibidos.
27
4.2.2 Interfaz de Control
La interfaz de control se implementa mediante ROS6 , que es un framework que dispone de
librerı́as y herramientas que proveen abstracción de hardware, controladores de dispositivos,
herramientas de visualización, comunicación por mensajes, entre otros.
Para este proyecto se utilizan particularmente las librerı́as y herramientas para comuni-
cación mediante mensajes. Para esto se crea un nodo ROS (archivo ejecutable), que publica
y se subscribe a lo que en el contexto de ROS se llaman tópicos. Los tópicos permiten a un
nodo enviar y recibir información hacia/desde otros nodos, donde cada nodo tiene sus propios
procesos y pueden estar ejecutándose de manera independiente.
La clase que maneja la comunicación con el satélite se implementa en el nodo ros interface,
el que publica y se subscribe a los siguientes tópicos:
• Suscritos:
• Publicados:
28
– /wheelzSpeedSetpoint. Publica un mensaje de tipo std msgs/Float32 que co-
rresponde a la referencia de velocidad actual para la rueda en el eje Z.
– /wheel[y,z]Current. Publica un mensaje de tipo std msgs/Float32 que corres-
ponde a la corriente actual medida del motor en el eje respectivo.
– /wheel[y,z]CurrentSetpoint. Publica un mensaje de tipo std msgs/Float32
que corresponde a la referencia de corriente actual para el motor respectivo.
Los mensajes publicados en el tópico /controller command. pueden ser alguno de los
comandos mostrados en la tabla 3.
29
4.2.3 Visualización de Datos
Para la visualización de los datos se utiliza el package rqt plot de ROS, que mediante
una interfaz gráfica permite ver los datos numéricos publicados en los diferentes tópicos.
Además de esto los datos son guardados en un archivo de texto en formato csv. También
se implementó un script en Matlab que lee este archivo en tiempo real y grafica los datos.
La ventaja de éste último es que el script se puede configurar para tener cada variable en
un gráfico y con las escalas correspondientes de los ejes, además de etiquetas para cada curva.
En la Fig.19 se muestran los datos de medición de corriente mediante rqt plot y una
interfaz que permite publicar comandos en los tópicos existentes.
30
a) b)
Figura 20: Simulación de satélite a) fijo a pedestal y b) en plataforma Air Bearing en Gazebo.
En el caso de la simulación con la plataforma Air Bearing se observa que el satélite sin
actuación comienza a caer hacia un lado, puesto que su centro de masas no coincide con su
centro geométrico, sin embargo es posible mantenerlo en la plataforma actuando sobre una
de las ruedas verticales y la rueda horizontal.
31
5 Diseño y Pruebas de Modelos
De esta forma la planta de corriente queda dada por la Ec.(25), que corresponde a un
sistema de primer orden con constante de tiempo de 0,0026[s].
1 100
Gi (s) = = (25)
2∗5· 10−3 s + 2 ∗ 1,9 s + 380
La constante de torque KM y amortiguamiento B, presentes en el modelo del motor dado
por la Ec.(17), se obtienen dando como entrada al motor un escalón de voltaje, midiendo
la corriente y la velocidad hasta que alcanzan sus valores en estado estacionario, i∗M y ω (3)∗ .
La constante KM se calcula para 10 valores de voltajes en el rango de operación según la
∗
ecuación Ec.(26), y luego se obtiene el promedio KM , con el cual a su vez se calculan 10
valores de la constante B según la ecuación Ec.(27) y se obtiene el promedio B ∗ .
10 10
∗ 1 X 1 X vt (n) − Ri∗M (n)
KM = KM (n) = (26)
10 n=1 10 n=1 ω (3)∗ (n)
10 ∗ ∗ 10
∗ 1 X 1 X KM iM (n)
B = B(n) = (3)∗
(27)
10 n=1 10 n=1 ω (n)
32
Con esto se obtienen los valores mostrados en la tabla 5. A partir de los cuales se obtiene
la función transferencia del sistema dada por la Ec.(28), con una constante de tiempo de
14.6[s].
1 32680
Gω (s) = = (28)
3,06 · 10−5 s + 2,29 · 10−6 s + 0,0748
Figura 21: Corriente y Velocidad RR en prueba para determinar parámetros del motor.
Tabla 6: Errores en estado estacionario del modelo con respecto a los valores medidos.
Vt 2.00[V] 2.31[V] 2.62[V] 2.93[V] 3.24[V] 3.55[V] 3.86[V] 4.17[V] 4.80[V]
e iM 3.95 % 7.12 % 21.55 % 2.20 % 12.28 % -7.41 % -15.02 % -20.80 % -42.67 %
eω(3) 49.91 % 48.15 % 21.96 % 12.19 % 8.93 % -3.31 % -9.99 % -18.28 % -31.89 %
33
5.1.2 Momento de Inercia del satélite
Para determinar M.I. del satélite se consideraron dos estimaciones. Para la primera esti-
mación se midieron las masas y dimensiones de los componentes principales del satélite y se
calcularon los M.I. de cada uno con respecto a sus centro de masa, los cuales se muestran en
la tabla 7.
Luego se calcula la inercia del satélite con respecto al centro geométrico del mismo,
mediante el Teorema de Steiner. La segunda estimación se obtuvo del modelo implementado
en SolidWorks. Ambos valores se muestran en la tabla 8.
Los valores obtenidos con SolidWorks se obtuvieron considerando todos los materiales
como PLA con densidad homogénea. Sin embargo en el prototipo hay materiales de distintos
tipos. Lo anterior y el hecho de que el ensamblaje de los componentes en el prototipo no es
completamente simétrico como en el software, determina las diferencias obtenidas.
Con el cálculo mediante ambos métodos se valida el orden de magnitud de los parámetros,
utilizando para los modelos los cálculos directos, dado que representan mejor al prototipo
desarrollado.
34
5.2 Control de corriente del Motor
Para el control de corriente del motor se utiliza el esquema mostrado en la Fig.22, el cual
se basa en la Ec.(17) y Ec.(19). Se implementa un controlador proporcional integral (PI) con
estructura Antiwinding up.
Para el sistema dado por la Ec.(25) se imponen como parámetros de diseño un sobrepaso
de 2 % y un tiempo de establecimiento de 4[ms], con lo cual se obtiene el controlador dado
por la Ec.(29). El desempeño del controlador para seguimiento de referencias tipo escalón se
muestra en la Fig.23, donde se observa que cumple con los requerimientos establecidos.
6221,65
Gci (s) = 12,51 + (29)
s
35
5.3 Control de velocidad de la rueda de reacción
Para el control de velocidad de la rueda se utiliza un esquema de control anidado, donde el
lazo externo controla la velocidad generando un comando de torque para el lazo interno de co-
rriente. Para el control de velocidad se utiliza también un PI y el de corriente es el presentado
en la sección anterior. En la Fig.24 se muestra el esquema de control implementado.
6787,35
Gcω (s) = 10,70 + (30)
s
a) b)
36
5.4 Control de Orientación en 3 Ejes
Para el control de orientación en los tres ejes del satélite se implementa la ley de control
dada por la Ec.(21) mediante cuaterniones descrita en la Sección 3.5.3. Para probar el
desempeño de este algoritmo se implementan las ecuaciones Ec.(5), Ec.(6) y Ec.(12) que
describen la cinemática y dinámica del satélite. En este caso no se incluyen perturbaciones
del entorno, por lo que se considera (MG )externo = 0. En la Fig.26 se muestra el esquema
general del sistema implementado.
37
Figura 27: Modelo del satélite en Simulink.
El bloque de R.R. se muestra en la Fig.29, donde se puede observar que la entrada corres-
ponde a los comandos de torque para cada uno de los tres motores y la salida corresponde a
las velocidades de las ruedas, determindas por los modelos explicados en la sección anterior.
38
Figura 29: Modelo R.R. en Simulink.
En la Fig.26 se observan dos modos de refencia para el satélite, uno en el cual se pueden
cambiar los ángulos de forma manual y el bloque ypr-tracking-test que utiliza una señal alea-
toria para cada ángulo, lo cual sirve para probar el desempeño del controlador. Además se
observa en la Fig.26 el switch Control Mode que permite probar comportamientos del modelo
especificando los comando de torque, tal como una precesión el alguno de los ejes, estabilidad
de rotaciones en lazo abierto, etc.
39
En la Fig.31 se muestra el resultado de un seguimiento de referencias tipo escalón en
cuaterniones. Las lineas punteadas representan las referencias, y las lineas continuas la orien-
tación actual de satélite. Se observa que las señales logran seguir las referencias con tiempos
de establecimiento inferiores a 2[s]. También se observan ciertos sobrepasos en la parte escalar
del cuaternión, lo cual está directamente relacionado con la cantidad total de rotación con
respecto al eje de rotación dado por la parte vectorial, en cada cambio de referencia.
40
En la Fig.33 a) se muestra el cuaternion de error y en b) el comando de torque determi-
niado por el controlador. Se observa que la parte vectorial del cuaternion converge a 0 y la
parte escalar a 1, luego de cada cambio, lo que implica que no hay rotación. Se observa que
el máximo torque requerido durante la maniobra es de 7.7[mNm].
Además se observa en la Fig.34 que la máxima velocidad requerida para las RR durante
la maniobra es de 590[RPM] en el eje z, que a su vez determina la máxima velocidad del
satélite de -20[RPM] en el mismo eje.
41
6 Resultados y Análisis del Sistema
ninterrupciones 1000
v[rpm] = 60[s/min] [rev] (31)
nimanes ∆t[ms]
Esta medición presenta ruido de alta frecuencia por lo cual se pasa la señal por un filtro
pasa bajos con frecuencia de corte de 1[Hz]. En la Fig.36 se muestra la velocidad directamente
medida y la filtrada.
8
Hoja de datos en https://www.mouser.com/ds/2/734/US5881-Datasheet-Melexis-953437.pdf
42
Figura 36: Velocidad de la rueda, medida y filtrada.
Para verificar las mediciones obtenidas de esta forma se midió la velocidad del disco
mediante un tacómetro óptico. En la Fig.37 se muestran los resultados obtenidos con ambos
métodos.
Figura 37: Velocidad de la rueda, medida con sensor de efecto hall y con tacómetro.
Como se puede observar existe una diferencia entre las velocidades por lo cual se aplica un
ajuste a la velocidad calculada para que coincida con la del tacómetro, que es un instrumento
calibrado.
43
6.1.2 Medición de corriente
Para la medición de corriente se utiliza el integrado ACS712 9 , que permite medir corrien-
te C.C. y C.A., hasta 5[A]. El sensor se conecta a la alimentación del driver del motor, es
decir, se mide la corriente C.C. que es equivalente a la corriente del modelo presentado en la
sección 3.4.2.
La medición obtenida contiene ruido, por lo cual se aplica un filtro pasa bajos de 2[Hz].
Esto se puede ver en la Fig.38.
Para esto se utilizó una cámara de termo vacı́o que es capaz de establecer presiones de
hasta 10−9 [T orr], sin embargo para esta prueba se llegó hasta 6 · 10−5 [T orr] debido al tiempo
que se requiere para alcanzar estos niveles de presión. En la Fig.39 se muestra el voltaje de
operación del motor (voltaje RMS en una de las fases) y la presión en la cámara.
9
Hoja de datos en https://www.sparkfun.com/datasheets/BreakoutBoards/0712.pdf
44
a) b)
En la Fig.40 se observa que la temperatura del motor aumenta desde los 24[C] hasta los
26[C] debido a las pruebas de comunicación, durante las cuales se llevó el motor a 2[V] y 4[V]
en un tiempo de 4[min]. Al comenzar la prueba a los 17[min] se observa que la temperatura
mantiene aproximadamente la misma tasa de aumento, variando levemente incluso después
de aumentar el voltaje a 4[V]. Sin embargo a partir de los 80[s] la tasa de cambio aumenta
notoriamente hasta aproximadamente los 90[min] cuando se apaga el motor.
45
El aumento a los 80[min] coincide con el momento en que se comienza a presurizar la
cámara. Esto en principio no concuerda con la teorı́a ya que al haber menos vacı́o se espera
que haya mayor disipación de calor por convección, y por tanto una menor tasa aumento de
la temperatura. Sin embargo durante el experimento se observó también que las máquinas
térmicas que se encuentran en la misma habitación que la cámara de vacı́o producen niveles
apreciables de calor, lo cual a su vez se transmite a la cámara.
Debido a lo anterior, para determinar el real efecto del vacı́o en la variación térmica del
motor deben ubicarse las máquinas térmicas en otra habitación. Además se deben realizar
más pruebas de encendido y apagado del motor a diferentes niveles de vacı́o con el objetivo
de comparar las tasas de cambio de temperatura para cada presión.
También se puede observar que la máxima corriente que se puede controlar es de 0.3[A],
que esta limitada por el voltaje de la baterı́a, que en este caso corresponde a 11.1[V].
46
Figura 41: Control de corriente en lazo cerrado Motor eje Z. Seguimiento de referencia.
Figura 42: Control de corriente en lazo cerrado Motor eje Y. Seguimiento de referencia.
47
Se observa también un sobrepaso importante de 42 % para la referencia de 0.5[A], además
de oscilaciones de amplitud similar. Para dicha referencia se observan vibraciones importan-
tes debidas a la alta velocidad y las imperfecciones de la estructura. Las oscilaciones a alta
velocidad reflejan este fenómeno, sin embargo para determinar su real efecto se debe construir
una estructura mecánicamente más robusta.
En el caso del sistema en órbita, lo anterior se justifica si la rotación del satélite es estable
con respecto al eje de control de velocidad. En el caso de los otros ejes, no se justifica ya
se debe compensar el torque debido al peso, por tanto no es directo determinar la velocidad
adecuada y de forma suficientemente rápida para evitar que el sistema se desestabilice.
48
Figura 43: Control de velocidad en lazo cerrado. Seguimiento de referencia.
49
Figura 44: Control de ángulo yaw para referencia de 100◦ .
Se observa durante la prueba que los altos sobrepasos se deben a la alta velocidad con que
comienza a moverse el motor, pese a ser la mı́nima que permite el driver. Se observa también
en la Fig.45 que la referencia de corriente está saturada y tiene una variación más rápida de
lo que el controlador es capaz de seguir.
50
Figura 45: Control de ángulo yaw para referencia de 100◦ . Gráfico controlador de corriente.
Para solucionar los problemas que esto presenta se deben realizar pruebas con una rueda
con mayor inercia e idealmente con un driver que permita operación a menores velocidades.
51
Figura 46: Configuración prueba de equilibrio.
Este sistema es inestable y dado que el centro de masa no coincide con el centro geométri-
co de la configuración, en la posición mostrada siempre existirá un torque tendiendo a voltear
el cuerpo. Para esta prueba se emplean los controladores diseñados en torno al punto de ope-
ración θ = 0, φ = 0, para los cuales resulta haber un offset de torque en los motores de los
ejes x e y, resultando a su vez en un offset de velocidad en dichos motores. Los controladores
compensan en torno a dichos valores.
a) b)
52
En la Fig.48 se observa que los ángulos θ y ψ entre [−4,75, 11,96]◦ y [−11,72, 11,56]◦
respectivamente, salvo en el inicio de la prueba y los tiempos donde cae sobre los soportes.
El dispositivo logra mantener el equilibrio por periodos del orden de 60[s].
a) b)
10
Rueda de Reacción de referencia en cubesatshop, en https://www.cubesatshop.com/product/
cubewheel-small/
53
Se obtiene que la RR diseñada es aproximadamente 8 veces menos eficiente en términos
de energı́a y 10 veces menos precisa en términos de control de velocidad, pero puede entre-
gar aproximadamente 4 veces más torque y almacenar 9 veces más momento angular que la
versión utilizada como referencia. Además el dispositivo diseñado tiene un costo aproxima-
damente 36 veces menor que la versión comercial.
Queda propuesto como trabajo futuro incluir perturbaciones del entorno en las simulacio-
nes, tales como el gradiente gravitacional, magnéticas y la presión solar. Ası́ como también
realizar los cálculos para diferentes objetivos de orientación en órbita, tales como, apuntar
hacia la tierra, hacia el sol, etc.
Mientras que en el caso del prototipo queda propuesto realizar pruebas del sistema de
control en 3 ejes mediante una plataforma de pruebas adecuada. Para este trabajo se dispuso
del Air bearing en las fases finales de desarrollo, lo cual fue útil para realizar las pruebas de
orientación en 1 eje, sin embargo para 2 o 3 ejes, el prototipo de 3 unidades con el hardware
utilizado no es capaz de estabilizar el sistema.
54
7 Conclusiones y Trabajo Futuro
Se comprueba también que los sensores utilizados logran proporcionar datos certeros me-
diante el uso de los filtros adecuados. En particular se valida el uso de sensores de efecto
hall para la medición de las velocidades de las ruedas y el uso del los datos fusionados del
DMP de la IMU para la orientación. De esto se desprende que para la siguiente iteración del
sistema se puede seguir utilizando el mismo hardware de medición. Sin embargo la IMU debe
ser utilizada en conjunto con un magnetómetro o bien usar una equivalente con magnetóme-
tro incluido, como el MPU9250, para solucionar el problema de la referencia en el ángulo yaw.
Para integración de los desarrollos con las próximas versiones del satélite SUCHAI deben
ser tratados con mayor detalle principalmente los aspectos mecánicos. Desde el punto de vista
de la electrónica, se logró integrar la mayorı́a de los componentes en una placa, que puede
ser reducida en tamaño reemplazando los componentes through hole por componentes SMD
e integrando los driver en la misma placa. Desde el punto de vista del software el sistema
cumple con la filosofı́a de funcionar en base a comandos, que se requiere para la integración
con el computador a bordo y el resto de sistemas del satélite.
55
Bibliografı́a
[1] J.T Wen and K. Delgado, “The attitude control problem,” IEEE Trans. Automatic
Control, Vol. 36, No. 10, pp. 1148-1162, 1991. ←-
[2] Marcel J. Sidi, Spacecraft Dynamics and Control, A practical Engineering Approach
University of Cambridge, 1997.
[3] G. P. Candini, F. Piergentili, and F. Santoni, “Miniaturized attitude control system for
nanosatellites,” Acta Astronautica, vol.81, pp. 325–334, 2005. ←-
[4] M. Swartwout, Twenty plus years of university-class spacecraft: A review of what was,
an understanding of what is, and a look at what should be next, in: Proceedings of
the 20th Annual AIAA/USU Conference on Small Satellites, Logan, UT, Utah State
University, Paper SSC06-I-314– 17 Aug. 2006.
[5] N. Shams, F. Tanveer, S. Ahmad, “Design and development of attitude control system
(ACS) using COTS based components for small satellites”, Advances in Space Techno-
logies 2008. ICAST 2008. 2nd International Conference on, pp. 6-11, 29-30 Nov. 2008.
[6] B. Wie, ”Space vehicle dynamics and control.” AIAA Education Series, 2nd ed. Reston,
VA, ISBN: 978-1-56347-953-3, pp. 323-402, 2008.
[8] F. Santoni, F. Piergentili, F. Graziani, The UNISAT program: lessons learned and achie-
ved results, Acta Astronautica, vol.65, pp. 54–60, 2009.
[10] Henri Christian Kjellberg, E. Glenn Lightsey, ”A Constrained Attitude Control Module
for Small Satellites”, Proceedings of the 26th Annual AIAA/USU Conference on Small
Satellites, The University of Texas at Austin, 2012.
[11] Li, Junquan, Mark Post, Thomas Wright, and Regina Lee, Design of Attitude Control
Systems for Cubesat-class Nanosatellite, Journal of Control Science and Engineering,
2013.
56
[12] Helosman Figueiredo, Osamu Saotome, “Design of a Set of Reaction Wheel for Satellite
Attitude Control Simulation”, 22nd International Congress of Mechanical Engineering,
2013.
[13] Jean-François Trégouët, Denis Arzelier, Dimitri Peaucelle, Christelle Pittet, Luca Zacca-
rian, Reaction Wheels Desaturation Using Magnetorquers and Static Input Allocation”,
Control Systems Technology IEEE Transactions on, vol. 23, pp. 525-539, 2015.
[14] E.J. Lefferts, F.L. Markley, and M.D. Shuster, “Kalman Filtering for Spacecraft Attitude
Estimation”, Journal of Guidance, Control, and Dynamics, Vol. 5, No. 5 (1982), pp. 417-
429.
[15] MARK L. PSIAKI, FRANCOIS MARTEL, and PARIMAL K. PAL., “Three-axis atti-
tude determination via Kalman filtering of magnetometer data”, Journal of Guidance,
Control, and Dynamics, Vol. 13, No. 3 (1990), pp. 506-514.
[16] Curtis, Howard D., Orbital Mechanics for Engineering Students (3rd ed.). Amsterdam:
Elsevier Butterworth Heinemann, 2005.
[18] Ned Mohan, Tore M. Undeland, William P. Robbins, Electrónica de Potencia, Conver-
tidores, aplicaciones y diseño (Tercera Edición). 2009.
[19] P.C. Sen, Principles of Electric Machines and Power Electronics (2nd ed.). Queen’s
University, Kingston, Ontario, Canada. 1997.
[20] Ward Brown., “Brushless DC Motor Control Made Easy”, Microchip Technology Inc.,
2002.
[22] Stefán Baldursson, BLDC Motor Modelling and Control-A MAtlab/Simulink Implemen-
tation, Master Thesis work, Chalmers University of Technology, Gothenburg, Sweden,
2005.
[24] Lynn Rothschild, Adrian Lister, Evolution on Planet Earth: Impact of the Physical
Environment, Spring 2003, Part 2, pp 112.
57
Anexos
a) b) c)
11
Link al sitio web: http://www.pi-usa.us/products/Air_Bearing_Stages/PIglide_HB_Spherical_
Air_Bearing.pdf
58
B. Transformaciones entre ángulos de Euler y Cuater-
niones. (↑ 1 , ↑ 2 )
Dados los ángulos de Euler ψ, θ, φ y el orden de rotación ψ → θ → φ, explicado en el
marco teórico, se puede obtener la misma rotación mediante el cuaternión qT = (q, qT 4 ) dado
por la Ec.(32).
qT 1 sin(φ/2) cos(θ/2) cos(ψ/2) − cos(φ/2) sin(θ/2) sin(ψ/2)
qT 2 cos(φ/2) sin(θ/2) cos(ψ/2) + sin(φ/2) cos(θ/2) sin(ψ/2)
qT =
qT 3 =
cos(φ/2) cos(θ/2) sin(ψ/2) − sin(φ/2) sin(θ/2) cos(ψ/2)
(32)
qT 4 cos(φ/2) cos(θ/2) cos(ψ/2) + sin(φ/2) sin(θ/2) sin(ψ/2)
2(q0 q3 +q1 q2 )
arctan
ψ 1−2(q22 +q32 )
θ = arcsin (2(q0 q2 − q3 q1 )) (33)
φ arctan 2(q0 q1 +q 2
2 q3 )
2
1−2(q1 +q2 )
59
C. Placa de Conexiones. (↑ 1 , ↑2 )
En la Fig.50 se muestra el esquemático de la placa desarrollada para las conexiones de los
sensores. El diseño se realizó en el software Eagle y se fabricó en Laboratorio de Electrónica
del DIE. Además en la Fig.51 se muestra el layout de la placa.
60
Figura 51: PCB layout placa de conexiones.
61