#include <Servo.h>

#include <Wire.h>

#include <I2Cdev.h>

#include <MPU6050.h>





MPU6050 mpu;
int16_t ax, ay, az;
int16_t gx, gy, gz;
Servo servo1;
Servo servo2;
Servo servo3;

int va11;
int va12;
int va13;

int prevVa11;
int prevVa12;
int prevVa13;

void setup()
{
  Wire.begin();


  servo1.attach(5);
  servo2.attach(6);
  servo3.attach(7);
}

void loop()
{
mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
va11 = map(ax, -17000, 17000, 0, 179);
if (va11 != prevVa11)
{
servo1.write(va11);
prevVa11 = va11;
}
va12 = map(ay, -17000, 17000, 0, 179);
if (va12 != prevVa12)
{
servo2.write(va12);
prevVa12 = va12;
}
va13 = map(az, -17000, 17000, 0, 179);
if (va13 != prevVa13)
{
servo3.write(va13);
prevVa13 = va13;
}
delay(50);
}