#include <Wire.h>
#include <Servo.h>
Servo servo;
Servo servo2;
int angle;
int angle2;
int yangle = 0;
const int MPU_addr = 0x68;
int16_t AcX, AcY,AcZ,Tmp,GyX,GyY,GyZ;
void setup() {
// put your setup code here, to run once:
Wire.begin();
Wire.beginTransmission(MPU_addr);
Wire.write(0x6B);
Wire.write(0);
Wire.endTransmission(true);
servo.attach(9);
servo2.attach(10);
}
void loop() {
// put your main code here, to run repeatedly:
Wire.beginTransmission(MPU_addr);
Wire.write(0x3B);
Wire.endTransmission(false);
Wire.requestFrom(MPU_addr,14,true);
AcY = Wire.read() << 8 | Wire.read();
yangle = AcY/182.04;
servo.write(yangle + 90);
servo2.write(90 - yangle);
}