#include <Adafruit_MPU6050.h>
#include <Adafruit_Sensor.h>
#include <Wire.h>

//Parameters
const int btnPin  = A5;
const int ledPin = 13;

//Variables
int btnVal  = 0;
bool btnState  = false;
bool oldbtnState  = false;
bool ledState  = LOW;

float restState = 0;
float moveState = 0;

sensors_event_t event;

Adafruit_MPU6050 mpu;

void testPushBtn( ) { /* function test Gyro Sensor */
  ////Read Gyro Sensor
  btnVal = analogRead(btnPin);
  if (btnVal < 200) {
    btnState = true;
  } else {
    btnState = false;
  }
}

void setupMPU6050(){
  mpu.getAccelerometerSensor()->getEvent(&event);

  restState = moveState = event.acceleration.x+
                event.acceleration.y+
                event.acceleration.z;
}

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

  while (!mpu.begin()) {
    Serial.println("MPU6050 not connected!");
    delay(1000);
  }
  Serial.println("MPU6050 ready!");

  setupMPU6050();
}

void loop() {

  mpu.getAccelerometerSensor()->getEvent(&event);

  moveState = event.acceleration.x+
              event.acceleration.y+
              event.acceleration.z;

  if (moveState != restState){

   ledState  = HIGH;
   digitalWrite(ledPin, ledState);
    //Serial.println(restState);
    //Serial.println(moveState);

  }

}