 char buf;
 int angulo = 90; 
 String Bussola;
+char valorSerial;
 
 //Variaveis para armazenar valores dos sensores
 int AnguloX, AnguloY, AnguloZ;
 void setup()
 {
   Serial.begin(9600);
+  Serial.flush();
 
   //Inicializa o servo motor
   servo.attach(8);
-  servo.write(90);
 
   Wire.begin();
   Wire.beginTransmission(MPU);

  Wire.write(0); 
  Wire.endTransmission(true);
}

void loop()
{
  while (Serial.available() > 0)
  {
    buf = Serial.read();
    if (buf = 'A')
    {
      angulo = Serial.read();
      servo.write(angulo);
      Serial.write("ServoOk");
    }else if(buf = 'B'){
      Bussola = LerBussola();
      //Envia por serial os valores da bussola
      for (int i = 0; i < Bussola.length(); i++)
      {
        Serial.write(Bussola[i]);
      }
    }
  }
 }

 String LerBussola()

//Programa : Teste MPU6050 e LCD 20x4
//Alteracoes e adaptacoes : FILIPEFLOP
//
//Baseado no programa original de JohnChi

//Carrega a biblioteca Wire
#include<Wire.h>
#include <Servo.h> 
