diff --git a/src/bno080sensor.cpp b/src/bno080sensor.cpp
index 1a5de3f..81a7845 100644
--- a/src/bno080sensor.cpp
+++ b/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
     }
 }
 
diff --git a/src/defines.h b/src/defines.h
index 547ca4f..ff19347 100644
--- a/src/defines.h
+++ b/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