#include <Adafruit_MPU6050.h>
#include <Adafruit_Sensor.h>
#include <Wire.h>
Adafruit_MPU6050 mpu;
float dataZ0 = 0;
float dataZ1 = 0;
int distance = 0;
void setup(void) {
Serial.begin(115200);
while (!mpu.begin()) {
Serial.println("MPU6050 not connected!");
delay(1000);
}
Serial.println("MPU6050 ready!");
}
sensors_event_t event;
void loop() {
dataZ0 = event.acceleration.z;
mpu.getAccelerometerSensor()->getEvent(&event);
/*Serial.print("[");
Serial.print(millis());
Serial.print("] X: ");
Serial.print(event.acceleration.x);
Serial.print(", Y: ");
Serial.print(event.acceleration.y);
Serial.print(", Z: ");
Serial.print(event.acceleration.z);
Serial.println(" m/s^2");*/
dataZ1 = event.acceleration.z;
/*Serial.print("dataZ0: ");
Serial.print(dataZ0);
Serial.print(" dataZ1: ");
Serial.println(dataZ1);*/
if (dataZ0 == dataZ1){
if (distance == 11){
Serial.println("0 meter");
}
else if (distance == 22){
Serial.println("1 meter");
}
}
else if (dataZ0 > dataZ1){
Serial.println("Put Down");
distance = 11;
}
else if (dataZ0 < dataZ1){
Serial.println("Lift");
distance = 22;
}
delay(500);
}