#define BLYNK_TEMPLATE_ID "TMPL69AbetbbM"
#define BLYNK_TEMPLATE_NAME "IoT Fall Detection System"
#define BLYNK_AUTH_TOKEN "jCW4zdCr-jwtLe28r0fDji35x2G6BlMx"

#define BLYNK_PRINT Serial
#include <WiFi.h>
#include <WiFiClient.h>
#include <BlynkSimpleEsp32.h>
#include <Adafruit_MPU6050.h>
#include <Adafruit_Sensor.h>
#include <Wire.h>

BlynkTimer timer;
char auth[] = BLYNK_AUTH_TOKEN;

char ssid[] = "Wokwi-GUEST";
char pass[] = "";

Adafruit_MPU6050 mpu;

void setup(void) {
    Serial.begin(115200);
  while (!Serial)
    delay(10); 

  Serial.println("Adafruit MPU6050 test!");

  if (!mpu.begin()) {
    Serial.println("Failed to find MPU6050 chip");
    while (1) {
      delay(10);
    }
  }
  Serial.println("MPU6050 Found!");

  mpu.setAccelerometerRange(MPU6050_RANGE_8_G);
  Serial.print("Accelerometer range set to: ");
  switch (mpu.getAccelerometerRange()) {
  case MPU6050_RANGE_2_G:
    Serial.println("+-2G");
    break;
  case MPU6050_RANGE_4_G:
    Serial.println("+-4G");
    break;
  case MPU6050_RANGE_8_G:
    Serial.println("+-8G");
    break;
  case MPU6050_RANGE_16_G:
    Serial.println("+-16G");
    break;
  }
  mpu.setGyroRange(MPU6050_RANGE_500_DEG);
  Serial.print("Gyro range set to: ");
  switch (mpu.getGyroRange()) {
  case MPU6050_RANGE_250_DEG:
    Serial.println("+- 250 deg/s");
    break;
  case MPU6050_RANGE_500_DEG:
    Serial.println("+- 500 deg/s");
    break;
  case MPU6050_RANGE_1000_DEG:
    Serial.println("+- 1000 deg/s");
    break;
  case MPU6050_RANGE_2000_DEG:
    Serial.println("+- 2000 deg/s");
    break;
  }

  mpu.setFilterBandwidth(MPU6050_BAND_21_HZ);
  Serial.print("Filter bandwidth set to: ");
  switch (mpu.getFilterBandwidth()) {
  case MPU6050_BAND_260_HZ:
    Serial.println("260 Hz");
    break;
  case MPU6050_BAND_184_HZ:
    Serial.println("184 Hz");
    break;
  case MPU6050_BAND_94_HZ:
    Serial.println("94 Hz");
    break;
  case MPU6050_BAND_44_HZ:
    Serial.println("44 Hz");
    break;
  case MPU6050_BAND_21_HZ:
    Serial.println("21 Hz");
    break;
  case MPU6050_BAND_10_HZ:
    Serial.println("10 Hz");
    break;
  case MPU6050_BAND_5_HZ:
    Serial.println("5 Hz");
    break;
  }
  Blynk.begin(auth, ssid, pass);
 timer.setInterval(100L, sendSensor);
  Serial.println("");
  delay(100);
}

void sendSensor()
{
    /* Get new sensor events with the readings */
    sensors_event_t a, g, temp;
    mpu.getEvent(&a, &g, &temp);
      int accelerationx=a.acceleration.x;
      int accelerationy=a.acceleration.y;
      int accelerationz=a.acceleration.z;
      int rotationx=g.gyro.x=(180/3.14)*atan(a.acceleration.y/sqrt(sq(a.acceleration.x)+sq(a.acceleration.z)));
      int rotationy=g.gyro.y=(180/3.14)*atan(a.acceleration.x/sqrt(sq(a.acceleration.y)+sq(a.acceleration.z)));
      int rotationz=g.gyro.z=(180/3.14)*atan(sqrt(sq(a.acceleration.x)+sq(a.acceleration.y))/a.acceleration.z);
      
    /* Print out the values */
     Serial.print("Acceleration X: ");
     Serial.print(a.acceleration.x);
     Serial.print(", Y: ");
     Serial.print(a.acceleration.y);
     Serial.print(", Z: ");
     Serial.print(a.acceleration.z);
     Serial.println(" m/s^2");
     
     Serial.print("Rotation X: ");
     Serial.print(g.gyro.x);
     Serial.print(", Y: ");
     Serial.print(g.gyro.y);
     Serial.print(", Z: ");
     Serial.print(g.gyro.z);
     Serial.println(" rad/s");
    
      Blynk.virtualWrite(V0, accelerationx);
      Blynk.virtualWrite(V1, accelerationy);
      Blynk.virtualWrite(V2, accelerationz);
      Blynk.virtualWrite(V3, rotationx);
      Blynk.virtualWrite(V4, rotationy);
      Blynk.virtualWrite(V5, rotationz);
      Blynk.logEvent("fall_detected","Pasien Terjatuh!!!");
    Serial.println(" ");
   delay(200);
}

void loop()
{
  Blynk.run();
  timer.run();
 }