diff --git a/src/C++/Driver/src/TestM5.cpp b/src/C++/Driver/src/TestM5.cpp
new file mode 100644
index 0000000..5296b16
--- /dev/null
+++ b/src/C++/Driver/src/TestM5.cpp
@@ -0,0 +1,33 @@
+#include <M5Stack.h>           
+#include <Wire.h>              
+#include "Adafruit_SGP30.h"    
+
+Adafruit_SGP30 sgp;
+
+void setup() {
+    M5.begin();                   
+    Serial.begin(9600);         
+
+    
+    if (!sgp.begin()) {
+        Serial.println("SGP30 sensor niet gevonden :(");
+        while (1);
+    }
+    Serial.println("SGP30 sensor gevonden!");
+
+    sgp.setIAQBaseline(0x8973, 0x8AAE);
+}
+
+void loop() {
+    delay(1000);
+
+    if (!sgp.IAQmeasure()) {
+        Serial.println("Error bij meting!");
+        return;
+    }
+    Serial.print("eCO2: ");
+    Serial.print(sgp.eCO2);
+    Serial.print(" ppm\tTVOC: ");
+    Serial.print(sgp.TVOC);
+    Serial.println(" ppb");
+}
\ No newline at end of file