Added more UART debug

src/bno080sensor.cpp

@@ -64,6 +64,16 @@ void BNO080Sensor::sendData() {
     if(newData) {
         newData = false;
         sendQuat(&quaternion, PACKET_ROTATION);
+        #ifdef FULL_DEBUG
+            Serial.print("Quaternion: ");
+            Serial.print(quaternion.x);
+            Serial.print(",");
+            Serial.print(quaternion.y);
+            Serial.print(",");
+            Serial.print(quaternion.z);
+            Serial.print(",");
+            Serial.println(quaternion.w);
+        #endif
     }
 }
 

src/defines.h

@@ -21,6 +21,8 @@
     THE SOFTWARE.
 */
 
+#define FULL_DEBUG 1
+
 #define IMU_MPU9250 1
 #define IMU_MPU6500 2
 #define IMU_BNO080 3