The greatest WordPress.com site in all the land!

arduino + mpu6050 + 1 servo

http://lukagabric.com/arduino-mpu6050/

#include <Servo.h>
#include <MPU6050.h>
#include <I2Cdev.h>
#include <Wire.h>
MPU6050 mpu;

int16_t ax, ay, az;
int16_t gx, gy, gz;

Servo myservo;

int val;
int prevVal;

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

Serial.println(« Initialize MPU »);
mpu.initialize();
Serial.println(mpu.testConnection() ? « Connected » : « Connection failed »);
myservo.attach(9);
}

void loop()
{
mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);

val = map(ay, -17000, 17000, 0, 179);
if (val != prevVal)
{
myservo.write(val);
Serial.println(val);
prevVal = val;
}

delay(50);
}

Publicités

Laisser un commentaire

Entrez vos coordonnées ci-dessous ou cliquez sur une icône pour vous connecter:

Logo WordPress.com

Vous commentez à l'aide de votre compte WordPress.com. Déconnexion / Changer )

Image Twitter

Vous commentez à l'aide de votre compte Twitter. Déconnexion / Changer )

Photo Facebook

Vous commentez à l'aide de votre compte Facebook. Déconnexion / Changer )

Photo Google+

Vous commentez à l'aide de votre compte Google+. Déconnexion / Changer )

Connexion à %s