diff --git a/libs/mavlink-skyward-lib b/libs/mavlink-skyward-lib
index 7343a00a31df548754d962dc3cac18ccf1bfd2aa..ce83ce010ef39c922e040442f34c07fe5b484045 160000
--- a/libs/mavlink-skyward-lib
+++ b/libs/mavlink-skyward-lib
@@ -1 +1 @@
-Subproject commit 7343a00a31df548754d962dc3cac18ccf1bfd2aa
+Subproject commit ce83ce010ef39c922e040442f34c07fe5b484045
diff --git a/src/shared/sensors/BMX160/BMX160.cpp b/src/shared/sensors/BMX160/BMX160.cpp
index 41aea4459273f7d6200de8d8084f39011e9d48b9..df7e966bbc0f7cdb202084f0e2820e7d07d7f6fb 100644
--- a/src/shared/sensors/BMX160/BMX160.cpp
+++ b/src/shared/sensors/BMX160/BMX160.cpp
@@ -698,11 +698,12 @@ void BMX160::readData()
     auto gyrRaw = parseStruct<BMX160Defs::GyrRaw>(buf, idx);
     auto accRaw = parseStruct<BMX160Defs::AccRaw>(buf, idx);
 
+    auto timestamp = TimestampTimer::getTimestamp();
     // Push a new sample into the fifo
     pushSample(BMX160Data{
-        buildAccData(accRaw, lastInterruptTimestamp),
-        buildGyrData(gyrRaw, lastInterruptTimestamp),
-        buildMagData(magRaw, lastInterruptTimestamp),
+        buildAccData(accRaw, timestamp),
+        buildGyrData(gyrRaw, timestamp),
+        buildMagData(magRaw, timestamp),
     });
 }
 
diff --git a/src/shared/sensors/H3LIS331DL/H3LIS331DL.cpp b/src/shared/sensors/H3LIS331DL/H3LIS331DL.cpp
index ed024165b8b53eb938c3ac94aa5ff0dd847e3c35..fa74cc9eaa5e4b7307c0f437d23abf8e91071fc0 100644
--- a/src/shared/sensors/H3LIS331DL/H3LIS331DL.cpp
+++ b/src/shared/sensors/H3LIS331DL/H3LIS331DL.cpp
@@ -173,7 +173,7 @@ H3LIS331DLData H3LIS331DL::sampleImpl()
         if (!(status & H3LIS331DLDefs::STATUS_REG_XYZDR))
         {
             lastError = SensorErrors::NO_NEW_DATA;
-            LOG_DEBUG(logger, "No new data available.");
+            LOG_ERR(logger, "No new data available.");
             return lastSample;
         }
 
diff --git a/src/shared/sensors/H3LIS331DL/H3LIS331DLDefs.h b/src/shared/sensors/H3LIS331DL/H3LIS331DLDefs.h
index 57394833eefa852446e519a2c99dae95796c421a..6c6df8eec05f471342aa557037705ffd1f83c7e7 100644
--- a/src/shared/sensors/H3LIS331DL/H3LIS331DLDefs.h
+++ b/src/shared/sensors/H3LIS331DL/H3LIS331DLDefs.h
@@ -19,6 +19,7 @@
  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  * THE SOFTWARE.
  */
+#pragma once
 
 namespace Boardcore
 {