#include <Wire.h>
#include <LiquidCrystal.h>
#include <MPU6050.h>

MPU6050 mpu;
LiquidCrystal lcd(13,12,11,10,9,8);

int pin_flex   =  A0;
int data_flex  =   0;

int center     = 2;
int left       = 3;
int right      = 4;

void setup() {
  Serial.begin(9600);
  Wire.begin();
  lcd.begin(20, 4);

  mpu.initialize();
  
  pinMode(pin_flex, INPUT);
  
  pinMode(center,  OUTPUT);
  pinMode(left  ,  OUTPUT);
  pinMode(right ,  OUTPUT);
}

void loop() {
  data_flex = analogRead(pin_flex);
  Serial.print("Flex : ");
  Serial.println(data_flex);
  
  int16_t x, y, z;
  mpu.getAcceleration(&x, &y, &z);
  Serial.print("X    : ");
  Serial.println(x);

  lcd.setCursor(0, 0);
  lcd.print("Flex : ");
  lcd.print(data_flex);

  lcd.setCursor(0, 2);
  lcd.print("X    : ");
  lcd.print(x);

  //850
  if (data_flex >= 511) {
    digitalWrite(center, HIGH);
  }
  else {
    digitalWrite(center,  LOW);
  }

  if (x > 16000){
    digitalWrite(left , HIGH);
    digitalWrite(right,  LOW);
    delay(500);
    digitalWrite(left ,  LOW);
    digitalWrite(right,  LOW);
    delay(500);
  }
  else if (x < -16000){
    digitalWrite(left ,  LOW);
    digitalWrite(right,  LOW);
    delay(500);
    digitalWrite(left ,  LOW);
    digitalWrite(right, HIGH);
    delay(500);
  }
  else {
    digitalWrite(left ,  LOW);
    digitalWrite(right,  LOW);
  }
  delay(100);
}