 void setup(void)
 {
   while (!Serial);
-  delay(500);
+  delay(100);
 
 
   triggerButton.setDebounceDelay(newDebounceDelay);

    Serial.println(diffQuat.w(), 4);


    ble.print("AT+BLEKEYBOARD=");
    ble.print(diffQuat.x(), 4);
    ble.print(",");


  Serial.println(F("Enable HID Service (including Keyboard): "));
  if ( ble.isVersionAtLeast(MINIMUM_FIRMWARE_VERSION) )
  {
    //if ( !ble.sendCommandCheckOK(F( "AT+BLEHIDEN=1" ))) {
      //error(F("Could not enable Keyboard"));
    //}
  } else
  {
    //if (! ble.sendCommandCheckOK(F( "AT+BLEKEYBOARDEN=1"  ))) {
      //error(F("Could not enable Keyboard"));
    //}
  }

  Serial.println( F("Switching to DATA mode!") );
  ble.setMode(BLUEFRUIT_MODE_DATA);
  
  /* Add or remove service requires a reset */
  Serial.println(F("Performing a SW reset (service changes require a reset): "));
  if (! ble.reset() ) {
