Meça a inclinação com um MPU6050 e um Arduino
Intermediário
- 526componentes na bancada
- 46placas rodando agora
- 1.00xtempo real, em todas as placas
O MPU6050 é um acelerômetro de três eixos e um giroscópio de três eixos num único chip, normalmente vendido na pequena placa azul GY-521. O circuito acima o usa como medidor de inclinação: um Arduino Uno o lê via I2C, acende uma lâmpada verde enquanto ele está plano e uma lâmpada vermelha ou azul quando é inclinado para a esquerda ou para a direita. O monitor serial imprime a aceleração bruta, os ângulos de rolagem e arfagem, as taxas do giroscópio e a própria temperatura do chip.
Abra no editor e arraste a placa do sensor para incliná-la. As leituras acompanham a gravidade, e o giroscópio acompanha a rapidez com que você a move.
O que você precisa
- Um Arduino Uno
- Um MPU6050 numa placa GY-521
- LEDs vermelho, verde e azul com um resistor de 220 ohms cada
- Uma protoboard e jumpers
Ligação
| Componente e pino | Vai para | Nota |
|---|---|---|
| SCL do MPU6050 | A5 | A placa GY-521 já tem seus próprios pull-ups |
| SDA do MPU6050 | A4 | |
| VCC e GND do MPU6050 | 5 V e GND | |
| LED vermelho, por um resistor de 220 ohms | Pino 7 | Inclinado à esquerda |
| LED verde, por um resistor de 220 ohms | Pino 8 | Plano |
| LED azul, através de 220 ohms | Pino 9 | Inclinado à direita |
Ele liga dormindo
Após o reset, o registrador de gerenciamento de energia do MPU6050 contém 0x40: o bit de sleep está ativo. Até que um sketch o limpe, todo registrador de medição lê zero. Não há erro, nem reclamação, apenas um nada perfeitamente estável, o que é pior que uma travada porque parece um sensor funcionando, plano e parado. O primeiro ato de todo driver é escrever 0x00 no registrador 0x6B, e o exemplo imprime se isso funcionou.
O chip simulado também liga em modo sleep, então esquecer isso dá os mesmos zeros estáveis aqui como na bancada.
#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();
}Transformando gravidade em â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.
O exemplo lê os quatorze bytes de dados de uma vez, converte os números brutos em milésimos de g e calcula a rolagem a partir de Y e Z e a arfagem a partir de X e Z. O arcotangente vem de uma tabela de consulta precisa até cerca de um grau, o que é mais rápido e menor num Uno do que atan2() da biblioteca matemática, embora atan2() também funcione. Passando de 12 graus para qualquer lado, uma das lâmpadas externas assume o lugar da verde.
O giroscópio mede outra coisa: a rapidez com que a placa gira, em graus por segundo, não para onde ela aponta. Ele fica perto de zero enquanto a placa está parada e se move apenas enquanto você a inclina.
WHO_AM_I e o endereço
O endereço do chip é 0x68, ou 0x69 com o pino AD0 em nível alto. O registrador WHO_AM_I retorna 0x68 nos dois casos, porque ele guarda os bits de endereço sem o AD0. Por isso um driver que compara o WHO_AM_I com o endereço que está usando falha justamente na placa que alguém configurou para 0x69. O exemplo imprime os dois, para que a diferença fique visível.
Experimente no editor
Abra o circuito no editor e arraste a placa do sensor para incliná-la lentamente além de 12 graus. A lâmpada verde passa a vez para a vermelha ou a azul. Mude FLAT_DEGREES para 3 e o medidor vira um nível de bolha nervoso; mude para 30 e ele só reclama de uma inclinação de verdade.
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.
Depois escreva algumas linhas suas com Wire.h: uma transmissão para 0x68 com o registrador 0x75, o WHO_AM_I, e uma leitura de um byte. Ele imprime 68, igual a um chip de verdade.
Erros comuns
Forgetting to wake it, and getting zeros.
Ler os registradores um por um. Os seis bytes de aceleração podem mudar entre duas leituras separadas, resultando em um valor feito de metade de uma amostra e metade da próxima. Leia o bloco em uma única transferência.
Esperar um ângulo do giroscópio sozinho. Integrar graus por segundo ao longo do tempo causa desvio. Projetos reais combinam o acelerômetro e o giroscópio com um filtro complementar ou de Kalman.
Esperar números perfeitos de um hardware real. Um MPU6050 de verdade tem um desvio em cada eixo até ser calibrado. O simulado lê limpo, o que é útil para aprender a matemática e mais gentil que a bancada.
Abra este circuito no editor. Arduino Uno: medidor de inclinação com MPU6050, ligado como está rodando no topo desta página. Troque um componente ou um valor e rode de novo.
Abrir o circuitoPerguntas
Preciso de uma biblioteca para o MPU6050?
Não. Wire.h compila aqui como está, e acordar e ler o chip são poucas escritas em registradores e uma leitura em rajada. O exemplo usa o próprio auxiliar de MPU6050 do Mokxi, que encapsula exatamente isso.
Posso usar o MPU6050 com um ESP32?
Sim. O chip funciona a 3.3 volts e as mesmas leituras de registradores funcionam nos pinos I2C do ESP32.
O simulador tem o DMP?
Não. O processador de movimento dentro do chip real, que roda seu próprio firmware de fusão, não é modelado. Os registradores brutos de acelerômetro, giroscópio e temperatura são.
Continuar
Monte isto de verdade
Abra o editor, mude um valor e veja o número mudar junto. Nada para instalar, e não precisa de conta.