diff --git a/crazyflie_groundstation/src/ccrazyflie/CCrazyflie_loggingFuncs.cpp b/crazyflie_groundstation/src/ccrazyflie/CCrazyflie_loggingFuncs.cpp
index a786c9f4eaa67e0aa673f1623ea16aff62e63398..621fee8e401cc9537e5e168bdd2168de4f362e77 100644
--- a/crazyflie_groundstation/src/ccrazyflie/CCrazyflie_loggingFuncs.cpp
+++ b/crazyflie_groundstation/src/ccrazyflie/CCrazyflie_loggingFuncs.cpp
@@ -204,6 +204,7 @@ double CCrazyflie::readTestStand() {
 	if(this->test_stand == NULL) {
 		return std::numeric_limits<double>::quiet_NaN();
 	}
+	/*
 	uint8_t buffer[8];
 	int nlNum = 0;
 	std::string result = "";
@@ -235,6 +236,9 @@ double CCrazyflie::readTestStand() {
 			}
 		}
 	}
+	*/
+	std::string result = "";
+	result = this->test_stand->readline();
 	double value;
 	try {
 		value = std::stod(result);