fix global imu position

diff --git a/imuboard/imu.c b/imuboard/imu.c
index 7e9a17f..c113e1c 100644 (file)
--- a/imuboard/imu.c
+++ b/imuboard/imu.c
@@ -57,8 +57,8 @@ static void imu_cb(struct callout_mgr *cm, struct callout *tim, void *arg)
        IRQ_UNLOCK(irq_flags);
 
        mpu6050_read_all_axes(&g_imu);
-       MadgwickAHRSupdate(&g_imu, &g_quat);
-       quaternion2euler(&g_quat, &g_euler);
+       MadgwickAHRSupdate(&g_imu, &quat);
+       quaternion2euler(&quat, &g_euler);
 
        /* update global variables */
        IRQ_LOCK(irq_flags);