Saltar la navegación

Acelerómetro - Giroscopio - Servo (MPU 6050).


gyro

Realizar una montaje que utilice el acelerómetro/giroscopio MPU 6050 de tal manera que cuando lo giremos horizontalmente el eje de un servomotor siga el movimiento del sensor.

Para ello conectaremos el servo al pin 10 y realizaremos las conexiones con Arduino del sensor MPU 6050 indicadas en la tabla indicada en la sección de Montaje.

Es necesario instalar la librería "MPU6050_tockn". Para ello seleccionaremos la opción del menú del IDE de Arduino "Sketch -> Include Libraries -> Manage Libraries...", buscamos la librería en cuestión y la instalamos.

Vamos a ver el resultado de la demostración en el siguiente vídeo:

ESQUEMA:

ARDUINO MPU 6050
5V VCC
GND GND
A4 SDA
A5 SCL
D2 INT

ARDUINO SERVO
5V +Vcc
GND GND
D10 SEÑAL

PROGRAMA A CARGAR EN ARDUINO:

#include <MPU6050_tockn.h>
#include <Wire.h>
#include "Servo.h"
#define pinServo 10
Servo servom;
MPU6050 mpu6050(Wire);

void setup() {
  Serial.begin(9600);
  servom.attach(pinServo);
  Wire.begin();
  mpu6050.begin();
  mpu6050.calcGyroOffsets(true);
}

void loop() {
  
  mpu6050.update();
  float rotZ = mpu6050.getAngleZ();
  Serial.print("angleZ : ");
  Serial.println(mpu6050.getAngleZ());
  if (rotZ > 0) servom.write(abs(rotZ));
}