Mide la inclinación con un MPU6050 y un Arduino
Intermedio
- 526componentes en el banco de trabajo
- 46placas funcionando ahora
- 1.00xtiempo real, en todas las placas
El MPU6050 es un acelerómetro de tres ejes y un giroscopio de tres ejes en un solo chip, que suele venderse en la pequeña placa azul GY-521. El circuito de arriba lo usa como medidor de inclinación: una Arduino Uno lo lee por I2C, enciende una lámpara verde mientras está plano, y una lámpara roja o azul cuando se inclina a la izquierda o a la derecha. El monitor serie imprime la aceleración sin procesar, los ángulos de balanceo y cabeceo, las velocidades del giroscopio y la temperatura del propio chip.
Ábrelo en el editor y arrastra la placa del sensor para inclinarla. Las lecturas siguen la gravedad, y el giroscopio sigue la rapidez con la que la mueves.
Lo que necesitas
- Un Arduino Uno
- Un MPU6050 en una placa GY-521
- LEDs rojo, verde y azul con una resistencia de 220 ohms cada uno
- Una protoboard y cables jumper
Cableado
| Componente y pin | Va a | Nota |
|---|---|---|
| SCL del MPU6050 | A5 | La placa GY-521 incluye sus propias pull-ups |
| SDA del MPU6050 | A4 | |
| VCC y GND del MPU6050 | 5 V y GND | |
| LED rojo, con 220 ohm | Pin 7 | Inclinado a la izquierda |
| LED verde, con 220 ohm | Pin 8 | Plano |
| LED azul, a través de 220 ohms | Pin 9 | Inclinado a la derecha |
Enciende dormido
Después del reinicio, el registro de administración de energía del MPU6050 contiene 0x40: el bit de reposo está activo. Hasta que un sketch lo limpia, todos los registros de medición contienen cero. No hay error, no hay reclamo, solo una nada perfectamente estable, lo cual es peor que un bloqueo porque parece un sensor funcionando, plano y quieto. El primer acto de todo controlador es escribir 0x00 en el registro 0x6B, y el ejemplo imprime si eso funcionó.
El chip simulado también enciende dormido, así que olvidar esto da los mismos ceros estables aquí que en el banco de trabajo.
#include <Wire.h>
void setup() {
Serial.begin(9600);
Wire.begin();
Wire.beginTransmission(0x68);
Wire.write(0x6B); // PWR_MGMT_1
Wire.write(0x00); // clear SLEEP
Wire.endTransmission();
}Convertir la gravedad en un ángulo
An accelerometer sitting still measures gravity and nothing else. Flat on a table, all of gravity is on the Z axis, so the reading is 0, 0 and plus 1 g. Tip it to one side and some of gravity moves onto Y; tip it forward and some moves onto X. The tilt angle is the arctangent of the two components, which is the whole trick behind every spirit level app.
El ejemplo lee los catorce bytes de datos de una sola vez, convierte los números sin procesar a milésimas de g, y calcula el balanceo a partir de Y y Z, y el cabeceo a partir de X y Z. La arcotangente viene de una tabla de consulta con una precisión de aproximadamente un grado, lo cual es más rápido y ocupa menos espacio en una Uno que atan2() de la biblioteca matemática, aunque atan2() también funciona. Pasados 12 grados en cualquier dirección, una de las lámparas exteriores reemplaza a la verde.
El giroscopio mide algo distinto: qué tan rápido está girando la placa, en grados por segundo, no hacia dónde apunta. Se mantiene cerca de cero mientras la placa está quieta y solo se mueve mientras la inclinas.
WHO_AM_I y la dirección
La dirección del chip es 0x68, o 0x69 con el pin AD0 en alto. Su registro WHO_AM_I devuelve 0x68 en ambos casos, porque contiene los bits de dirección sin AD0. Así que un driver que compara WHO_AM_I con la dirección que está usando falla justo con la placa que alguien configuró en 0x69. El ejemplo imprime ambos, para que la diferencia sea visible.
Pruébalo en el editor
Abre el circuito en el editor y arrastra la placa del sensor para inclinarla lentamente pasando los 12 grados. La lámpara verde pasa el turno a la roja o a la azul. Cambia FLAT_DEGREES a 3 y el medidor se convierte en un nivel de burbuja nervioso; cámbialo a 30 y solo se queja de una inclinación real.
Watch the gyro numbers in the serial monitor while you drag. They rise while the board is moving and fall back to zero the moment you stop, even though the tilt stays. That is the difference between a rate and a position, and it is why a gyro on its own cannot tell you which way up something is.
Luego escribe unas líneas por tu cuenta con Wire.h: una transmisión a 0x68 con el registro 0x75, WHO_AM_I, y una lectura de un byte. Imprime 68, igual que un chip real.
Errores comunes
Forgetting to wake it, and getting zeros.
Leer los registros uno por uno. Los seis bytes de aceleración pueden cambiar entre dos lecturas separadas, dando un valor hecho de la mitad de una muestra y la mitad de la siguiente. Lee el bloque en una sola transferencia.
Esperar un ángulo del giroscopio solo. Integrar grados por segundo en el tiempo produce deriva. Los proyectos reales combinan el acelerómetro y el giroscopio con un filtro complementario o de Kalman.
Esperar números perfectos del hardware real. Un MPU6050 real tiene un desfase en cada eje hasta que se calibra. El simulado lee limpio, lo cual sirve para aprender las matemáticas y es más amable que el banco de trabajo.
Abre este circuito en el editor. Arduino Uno: medidor de inclinación con MPU6050, cableado tal como funciona al inicio de esta página. Cambia un componente o un valor y vuelve a ejecutarlo.
Abrir el circuitoPreguntas
¿Necesito una biblioteca para el MPU6050?
No. Wire.h compila aquí tal cual, y despertar y leer el chip son unas cuantas escrituras de registros y una lectura en ráfaga. El ejemplo usa el propio ayudante de MPU6050 de Mokxi, que encapsula exactamente eso.
¿Puedo usar el MPU6050 con un ESP32?
Sí. El chip funciona a 3.3 volts y las mismas lecturas de registros sirven en los pines I2C del ESP32.
¿El simulador tiene el DMP?
No. El procesador de movimiento del chip real, que corre su propio firmware de fusión, no está modelado. Los registros de acelerómetro, giroscopio y temperatura en bruto sí lo están.
Sigue así
Ármalo en la vida real
Abre el editor, cambia un valor y mira cómo cambia el número con él. Nada que instalar y sin necesidad de cuenta.