Академический Документы
Профессиональный Документы
Культура Документы
L ECTURA S ENSORES
Los sensores de temperatura infrarrojo utilizados para determinar la posición del ae-
roplano han sido cambiados por una IMU9, esta aporta más precisión en las medidas. A
continuación vamos a comentar como se obtiene la información que nos interesa de
cada sensor. Al final de esta sección comentaremos como se informa a Paparazzi UAV
de los valores obtenidos de los sensores.
A nosotros, a parte del uso dado en el DCM, la lectura de los acelerómetros nos aporta
información para saber hacia dónde nos estamos moviendo y así poder corregir des-
plazamientos en la trayectoria, lo expuesto a continuación es con este motivo.
(1) = + Í +
Antes de comenzar a explicar cómo anular cada una de las aceleraciones que no nos
interesan, hay que compensar la salida de los acelerómetros, ya que esta, es depen-
diente de la temperatura. En las fórmulas expuestas a continuación sale la unidad
32
0 El proyecto paparazzi UAV
C OM P ENS AC I ÓN DE LA T E MP ER A TU R A
En el documento (34) observamos que tanto el offset como la sensibilidad en la lectura
son dependientes de la temperatura. El cálculo realizado a continuación es válido para
los tres ejes.
∗ . / . /
(2) / = ∗
/
En la IMU, tanto los acelerómetros como los giróscopos trabajan a 3.3V, sin embargo
las especificaciones están dadas para 3V. Basándonos en la información contenida en
la página 12 del documento (34) obtenemos que:
(3) 11 = . /
(4) = = =
(6) = ± . /℃
Con estos datos, definimos cuales son las funciones dependientes de la temperatura
en grados Celsius a utilizar en nuestro programa, sensitivityAccel(t) y offsetAccel(t):
(7) ( )= ⁄ ∙( + ℃ ∙( −
℃))
( ( /℃ ∙( ℃))∙ ( ) ⁄ ))
(8) ( )=
. /
L A GR A VEDA D
La gravedad afecta a las lecturas de los acelerómetros por ello es necesaria eliminarla
del vector aceleración.
11
En la documentación nos comentan que la sensibilidad es lineal y nos dan dos pun-
tos (3.6V, 360mV/g) y (2V, 195mV/g). Con la ecuación de la recta obtenemos que en
3.3V la sensibilidad es 329.0625 mV/g.
33
El valor que interpretamos como gravedad también cambia según la temperatura, de-
finimos la función gravity como:
(9) ( )=( ∙ () ⁄ ) / . /
Esta función nos determina cual es la aceleración en ADCStep de la gravedad que in-
cluyen nuestras lecturas. En condiciones ideales (25°C):
(10) ( )=( ∙ . ⁄ ) / . ⁄ = .
− í
(11) + _ ∙ = +
− ( ) í
Al no ser perfecto el cálculo del roll y el pitch, nunca conseguiremos anular completa-
mente la gravedad, aunque se merma lo suficiente como para que no introduzca erro-
res en la dirección del movimiento. En la Ilustracion 31 se muestra la salida en ADCStep
de los tres acelerómetros mientras se realiza un giro sobre el eje X.
L A A C ELER AC I ÓN C ENT R Í P ET A
La aceleración centrípeta se define:
34
0 El proyecto paparazzi UAV
(12) = ∙
El radio está medido al centro de la IMU. Al estar montado sobre el eje Z, no existe
aceleración centrípeta sobre este eje y el eje X e Y comparten el mismo radio. La velo-
cidad angular nos la dan las lecturas de los giróscopos en cada eje, obteniendo así el
vector aceleración centrípeta ⃗ = ( ∙ , ∙ , 0).
í
+ _ ∙ = + obtenemos
− ( ) í
la aceleración lineal:
∙
−
(13) = + _ ∙ − ∙
()
L A VELOC I DA D
¿Qué ocurría si lleváramos una velocidad constante? Tendríamos una aceleración nula,
al igual que se estamos en reposo. Con la aceleración instantánea no podemos saber
hacia dónde nos estamos moviendo, sólo sabemos si estamos o no acelerando un cier-
to eje.
35