#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 myservo;
 
int val;
int prevVal;
int sw = 10;
int led = 6;
int state = LOW;
int previous = LOW;
int reading;
long time = 0;
long debounce = 100;

void setup()
{
    pinMode(sw, INPUT_PULLUP);
    pinMode(led, OUTPUT);
    Wire.begin();
    Serial.begin(38400);
 
    Serial.println("Initialize MPU");
    mpu.initialize();
    Serial.println(mpu.testConnection() ? "Connected" : "Connection failed");
    myservo.attach(9);
}
 
void loop()
{
    reading = digitalRead(sw);
    if (reading == HIGH && previous == LOW && millis() - time > debounce)
    {
      if (state == HIGH)
        state = LOW;
      else
        state = HIGH;
      time = millis();
    }
    digitalWrite(led, state);
    previous = reading;
   
    mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
 
    val = map(ay, -17000, 17000, 0, 179);
    if (val != prevVal)
    {
        myservo.write(val);
        prevVal = val;
    }
    delay(50);
}

 

mpu6050이 움직일때 서보모터가 움직이는 코드에다가 led 전구 스위치를 단건데