MPU-6050 IMU

O que é

O MPU-6050 é a maneira como um robô sente o próprio movimento. É uma unidade de medida inercial de seis eixos—um giroscópio e um acelerômetro em um único chip—que informa como o robô está inclinado, com que rapidez está girando e como está acelerando. Enquanto um sensor ultrassônico observa o mundo à sua frente, uma IMU olha para dentro, para o próprio corpo do robô, que é exatamente o que um robô autoequilibrado ou um navegador por estimativa de posição precisa.

Como funciona

Dentro há dois sensores. O acelerômetro mede aceleração linear nos eixos X, Y e Z—em repouso, isso é apenas gravidade, que informa ao robô qual direção é para baixo (sua inclinação). O giroscópio mede a rapidez com que o robô gira em torno de cada eixo. Você lê ambos por I²C (SCL/SDA).

Nenhum sensor é suficiente sozinho: integre o giroscópio para obter um ângulo e ele derivará lentamente; confie apenas no acelerômetro e ele ficará ruidoso sempre que o robô se mover. A solução é a fusão de sensores—combine as medições para que o acelerômetro corrija a deriva do giroscópio e o giroscópio suavize o ruído do acelerômetro. Essa técnica é exatamente o que o guia sobre ruído, viés e filtragem de sensores aborda.

Quando usar

Use um MPU-6050 quando um robô precisar conhecer a própria orientação ou movimento:

• Robôs autoequilibrados — o ângulo de inclinação que a malha de controle tenta manter em zero.
• Orientação e navegação por estimativa — detecção de curvas para melhorar a odometria entre leituras dos encoders.
• Detecção de movimento / gestos — reagir a ser levantado, inclinado ou sacudido.

Para medir a distância até objetos (paredes, obstáculos), use um sensor de distância como o HC-SR04 ou o VL53L0X—uma IMU detecta o robô, não o mundo.

Conexões e armadilhas

• I²C, 3,3–5 V. A maioria das placas adaptadoras (a GY-521 roxa) tem regulador; portanto, 5 V serve. O chip puro é de apenas 3,3 V.
• Filtre as leituras do giroscópio e do acelerômetro—não controle o robô com uma leitura bruta. Uma única amostra do acelerômetro em movimento é inutilizável como ângulo de inclinação.
• A guinada deriva sem magnetômetro; use o MPU-6050 para arfagem e rolagem e para curvas de curta duração, não para obter uma orientação absoluta de bússola.
• Mantenha-o rígido e nivelado; um sensor solto acrescenta vibração que o filtro não consegue remover.

Pinagem

A placa adaptadora roxa GY-521 é a placa que quase todo mundo quer dizer com “MPU-6050”. São oito pinos, dos quais quatro normalmente ficam desconectados.

AD0 é o pino que torna possível usar dois MPU-6050 no mesmo barramento, e é a razão pela qual a colisão de endereços tem aqui uma solução simples que a maioria dos sensores não oferece.

Conexão com um Arduino

Há uma sutileza que vale conhecer em um Arduino de 5 V. Os resistores de pull-up da GY-521 estão conectados à trilha regulada de 3,3 V, portanto as linhas I²C ficam ociosas em 3,3 V, não 5 V. Um ATmega328P lê HIGH acima de 0,6 × Vcc = 3,0 V; portanto, 3,3 V supera o limiar—mas por apenas 0,3 V. Funciona de forma confiável na prática e é uma das razões pelas quais um trecho I²C longo ou ruidoso se comporta mal nesta placa antes de se comportar mal em outra placa de 5 V.

Leitura: os registradores que importam

Você pode controlar este sensor com uma biblioteca e nunca ver um registrador, mas quatro deles explicam quase todos os problemas que as pessoas encontram.

Os dois registradores de configuração definem o fator de escala pelo qual se divide as contagens brutas, e um valor incorreto é a causa mais comum de “meus ângulos estão quatro vezes maiores do que deveriam”:

Escolha a faixa menor que não saturar. Um robô autoequilibrado raramente excede ±250 °/s, e a faixa estreita oferece quatro vezes a resolução de ±1000 °/s sem custo adicional.

Código mínimo funcional

Sem biblioteca—este é o código inteiro, e vale executá-lo uma vez para saber o que a biblioteca está fazendo por você.

#include <Wire.h>

const uint8_t MPU = 0x68;          // 0x69 if AD0 is tied high

void setup() {
  Serial.begin(115200);
  Wire.begin();

  Wire.beginTransmission(MPU);
  Wire.write(0x6B);                 // PWR_MGMT_1
  Wire.write(0);                    // wake up — the chip boots asleep
  Wire.endTransmission(true);
}

void loop() {
  Wire.beginTransmission(MPU);
  Wire.write(0x3B);                 // ACCEL_XOUT_H
  Wire.endTransmission(false);      // repeated start, do not release the bus
  Wire.requestFrom(MPU, (uint8_t)14);

  int16_t ax = Wire.read() << 8 | Wire.read();
  int16_t ay = Wire.read() << 8 | Wire.read();
  int16_t az = Wire.read() << 8 | Wire.read();
  Wire.read(); Wire.read();         // temperature, discarded here
  int16_t gx = Wire.read() << 8 | Wire.read();
  int16_t gy = Wire.read() << 8 | Wire.read();
  int16_t gz = Wire.read() << 8 | Wire.read();

  // Default ranges: +/-2 g and +/-250 deg/s
  float pitch = atan2(ax, sqrt((float)ay * ay + (float)az * az)) * 57.2958f;
  float rateY = gy / 131.0f;        // deg/s

  Serial.print(pitch); Serial.print(' '); Serial.println(rateY);
  delay(20);
}

Duas coisas que este código deliberadamente não faz: ele nunca combina as medições dos dois sensores e nunca subtrai um viés. As duas etapas vêm a seguir.

Calibração: as vinte linhas que mais importam

Em repouso, um giroscópio não lê zero. Ele lê um pequeno desvio quase constante e, como você integra o giroscópio para obter um ângulo, esse desvio se integra e gera um erro que cresce continuamente. Um viés de apenas 2 °/s sem correção produz 120° de deriva após um minuto.

Calcule a média de algumas centenas de amostras com o sensor completamente parado e subtraia:

long sum = 0;
for (int i = 0; i < 500; i++) { sum += readGyroY(); delay(3); }
const float gyroBias = sum / 500.0f;   // subtract from every later reading

Três observações práticas que a folha de dados não informa:

• Faça a cada ligamento, não apenas uma vez. O viés do giroscópio varia com a temperatura, e um robô que está funcionando há dez minutos não é o mesmo robô que você calibrou a frio.
• “Parado” significa parado. Uma calibração feita enquanto alguém se apoia na mesa grava esse movimento permanentemente no viés.
• O acelerômetro precisa de uma referência de nível, não de zero. Ele deve ler 1 g no eixo que aponta para baixo. Se ler 0,97 g, esse é o erro de escala, e ele aparecerá como um ângulo de inclinação sistematicamente alguns graus fora do valor correto.

Por que um sensor nunca basta

Os dois sensores falham de maneiras exatamente opostas, e é isso que faz a fusão funcionar tão bem.

Um filtro complementar combina as características vantajosas de cada sensor—confia no giroscópio no curto prazo e deixa o acelerômetro corrigir lentamente a estimativa em direção ao valor real:

angle = 0.98f * (angle + rate * dt) + 0.02f * accelAngle;

Esse 0,98 define a frequência de cruzamento. Um valor maior atribui mais peso ao giroscópio por mais tempo, o que produz uma estimativa mais suave, mas com mais deriva; um valor menor dá mais peso ao ruído do acelerômetro. O tutorial do filtro complementar explica como escolher esse valor conscientemente, em vez de por tentativa.

Solução de problemas

MPU-6050 ou uma opção mais nova?

O MPU-6050 chegou ao fim de vida no fabricante e ainda é a IMU mais amplamente usada na robótica hobby, porque é barata, está documentada em todo lugar e é suportada por todas as bibliotecas.

O resumo honesto: se o seu robô precisa de arfagem e rolagem—que é o que o equilíbrio exige— o MPU-6050 é totalmente suficiente, e vale a pena implementar a fusão. Se ele precisa de orientação absoluta, nenhuma quantidade de filtramento obterá isso de seis eixos; você precisa de um magnetômetro.