From 87f7404564a4a041a0734c2ecf9e7b8181fd38f6 Mon Sep 17 00:00:00 2001
From: TomasLeTrain <tomylopezd@gmail.com>
Date: Sun, 29 Jun 2025 18:50:23 -0400
Subject: [PATCH] fixed wrong imu offset

---
 src/hardware/IMU/V5InertialSensor.cpp | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/src/hardware/IMU/V5InertialSensor.cpp b/src/hardware/IMU/V5InertialSensor.cpp
index 992a4b2..fb4013a 100644
--- a/src/hardware/IMU/V5InertialSensor.cpp
+++ b/src/hardware/IMU/V5InertialSensor.cpp
@@ -42,8 +42,8 @@ int32_t V5InertialSensor::setRotation(Angle rotation) {
     Angle raw = this->getRotation();
     if (to_stRot(raw) == INFINITY) return INT32_MAX;
     else {
-        m_offset = rotation - raw;
+        m_offset = rotation - raw + m_offset;
         return 0;
     }
 }
-} // namespace lemlib
\ No newline at end of file
+} // namespace lemlib