Despliegue de Paracaídas con Arduino-MPU 6050
Componentes:
-Arduino Nano o Mini
-Giroscopio MPU 6050
-Servomotor
-Cables finos
-Una batería de 3.7 o más volts (hasta 20v)
Conexiones:
MPU6050:
SCL - A5
SDA - A4
INT - 2
Servo - 9
i2cdev.zip: https://drive.google.com/open?id=1m311tlTBeYpiAnRucSCSWw7gB2rn-yiR
MPU6050.zip: https://drive.google.com/open?id=1GJVezngsDsghCG9yK4mBnwTB7E7yBxkQ
#include "Wire.h"
#include "I2Cdev.h"
#include "MPU6050.h"
#include "Servo.h"
MPU6050 mpu;
int16_t ax, ay, az;
int16_t gx, gy, gz;
Servo servo1;
int val1;
int prevVal1;
void setup()
{
Wire.begin();
Serial.begin(38400);
Serial.println("Inicializar MPU");
mpu.initialize();
Serial.println(mpu.testConnection() ? "Conectado" : "Conexión fallida");
servo1.attach(9);
}
void loop()
{
mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
val1 = map(ax, -17000, 17000, 120, 10);
if (val1 != prevVal1)
{
servo1.write(val1);
prevVal1 = val1;
}
delay(50);
}
Código:
#include "Wire.h"
#include "I2Cdev.h"
#include "MPU6050.h"
#include "Servo.h"
MPU6050 mpu;
int16_t ax, ay, az;
int16_t gx, gy, gz;
Servo servo1;
int val1;
int prevVal1;
void setup()
{
Wire.begin();
Serial.begin(38400);
Serial.println("Inicializar MPU");
mpu.initialize();
Serial.println(mpu.testConnection() ? "Conectado" : "Conexión fallida");
servo1.attach(9);
}
void loop()
{
mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
val1 = map(ax, -17000, 17000, 120, 10);
if (val1 != prevVal1)
{
servo1.write(val1);
prevVal1 = val1;
}
delay(50);
}
Comentarios
Publicar un comentario