// MCU BASIC: https://www.basic4mcu.com
// DateTime : 2018-12-04 오후 11:13:42
// by Ok-Hyun Park
//
#include <SoftwareSerial.h>
SoftwareSerial BTSerial(2,3);
//
#include "Wire.h"
#include "I2Cdev.h"
#include "MPU6050.h"
MPU6050  mpu;
//
int ax,ay,az,gx,gy,gz;
int val1,val2;
//
void setup(){
  Wire.begin();
  Serial.begin(9600);
  BTSerial.begin(9600);
  Serial.println("Initialize MPU");
  mpu.initialize();
  Serial.println(mpu.testConnection()?"Connected": "Connection failed");
}
//
void loop(){
  mpu.getMotion6(&ax,&ay,&az,&gx,&gy,&gz);
  val1=map(ax,-17000,17000,180,0);
  val2=map(ay,-17000,17000,180,0);
  BTSerial.write(val1);
  Serial.println(val1);
  delay(100);
}
//---------------------------------------------
#include <SoftwareSerial.h>
SoftwareSerial BTSerial(2,3);
//
#include "Servo.h"
Servo myservo;
//
int val=0,prevVal=0;
//
void setup(){
  myservo.attach(6);
  BTSerial.begin(9600);
  Serial.begin(9600);
}
//
void loop(){
  if(BTSerial.available()){
    val=BTSerial.read();
    Serial.println(val);
    //
    if(val!=prevVal){
      prevVal=val;
      if((val>0)&&(val<=180))myservo.write(val); //서보에 값을 주어 회전시킴
    }
  }
}