#include "Wire.h"       
#include "I2Cdev.h"     
#include "MPU6050.h"    

MPU6050 mpu;
int16_t ax, ay, az;
int16_t gx, gy, gz;

struct MyData {
  byte X;
  byte Y;
  byte Z;
};

int n = 0;
int x =0;

MyData data;

void setup()
{
  Serial.begin(9600);
  Wire.begin();
  mpu.initialize();
  //pinMode(LED_BUILTIN, OUTPUT);
}

void loop()
{

  mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
  data.X = map(ax, -17000, 17000, 0, 255 ); // X axis data
  data.Y = map(ay, -17000, 17000, 0, 255); 
  data.Z = map(az, -17000, 17000, 0, 255);  // Y axis data

//  Serial.print(millis());
  //Serial.print(",");
//  Serial.print(data.X);
  //Serial.print(",");
  Serial.println(data.Y);
  //Serial.print(",");
  //Serial.println(data.Z);

  if(data.Y > 220 && data.Y < 250)
  {
    n = n+1;
  //Serial.println(n);
    if (n==30)
    {
      Serial.println("Succesful Stretch");
      n = 0;
    }
  }
  else if(data.Y > 210 && data.Y < 230)
  {
    x =x+1;
    if (x>=10){
      x=0;
      Serial.println("Try to stretch a bit further");
    }
  }
  else
  {
    n = 0;
    x=0;
  }
  delay(1000);
}