diff --git a/src/shared/sensors/VN300/VN300.cpp b/src/shared/sensors/VN300/VN300.cpp
index ca802bd5e30bfe322ea5713626395cd8c75b2519..b92d3e621f784b283369c8f791d06801948f76f0 100644
--- a/src/shared/sensors/VN300/VN300.cpp
+++ b/src/shared/sensors/VN300/VN300.cpp
@@ -163,16 +163,19 @@ bool VN300::init()
 
 void VN300::run()
 {
-    while (!shouldStop())
+     while (!shouldStop())
     {
         long long initialTime = miosix::getTick();
+
+        VN300Data data = sampleData();
         {
             // Sample the data locking the mutex
             miosix::Lock<FastMutex> l(mutex);
-            threadSample = sampleData();
+            threadSample = data;
         }
         // Sleep for the sampling period
         miosix::Thread::sleepUntil(initialTime + samplePeriod);
+        printf("Sample time: %lld\n", miosix::getTick() - initialTime);
     }
 }