   }
 
   return newString;
-}+})
    // }
  }

  Serial.println("writeMotor");
  writeMotor();

  Serial.println("telemetry");
  D(telemetry());

  Serial.println("blink");
  /* Pisca a led para indicar atividade */
  blinkState = !blinkState;
  digitalWrite(LED_PIN, blinkState);

/* Efetua a leitura da orientação a ser armazenada na variável "ypr" */
void readOrientation() {
  bool fifoOverflow = false; // Marca se houve overflow da FIFO durante a execução
  D(Serial.println("init RO"));

  /* Le somente se houve interrupção */
  if (mpuInterrupt) {
