#include <Wire.h>
#include <math.h>
#include <Adafruit_MPU6050.h>
#include <Adafruit_Sensor.h>
Adafruit_MPU6050 mpu;
unsigned long timeout = 0;
void setup() {
Serial.begin(9600);
pinMode(18, OUTPUT);
while (!mpu.begin()) {
Serial.println("MPU6050 not connected!");
delay(1000);
}
Serial.println("MPU6050 ready!");
}
sensors_event_t event;
void loop() {
mpu.getAccelerometerSensor()->getEvent(&event);
if (timeout < millis()) {
Serial.print("Accelerometer x: ");
Serial.print(event.acceleration.x );
Serial.print(" y: ");
Serial.print(event.acceleration.y );
Serial.print(" z: ");
Serial.println(event.acceleration.z );
int res = sqrt( pow (event.acceleration.x , 2) + pow (event.acceleration.y , 2) + pow (event.acceleration.z , 2) );
Serial.println(res);
Serial.println("");
timeout = millis() + 1000;
if(res < 15){
digitalWrite(18, HIGH);
} else {
digitalWrite(18, LOW);
}
delay(500);
}
}