From fefcd6e44f6454ff8caff17721a9de42897a4064 Mon Sep 17 00:00:00 2001
From: Alex Mikhalev <alexmikhalevalex@gmail.com>
Date: Thu, 23 May 2019 12:05:16 -0700
Subject: [PATCH] fix MPU calibration

---
 main/ugv_io_mpu.cc | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/main/ugv_io_mpu.cc b/main/ugv_io_mpu.cc
index fe4311b..d5daac3 100644
--- a/main/ugv_io_mpu.cc
+++ b/main/ugv_io_mpu.cc
@@ -21,14 +21,14 @@ static constexpr mpud::gyro_fs_t  MPU_GYRO_FS     = mpud::GYRO_FS_500DPS;
 static constexpr float            MPU_MAG_TO_FLUX = (4912.f) / (32760.f);
 
 static const Vec3f ACCEL_OFFSET = {0., 0., 0.};
-static const Mat3f ACCEL_MAT    = {1., 0., 0., 0., -1., 0., 0., 0., -1.};
+static const Mat3f ACCEL_MAT    = {-1., 0., 0., 0., -1., 0., 0., 0., -1.};
 //static const Vec3f MAG_OFFSET   = {-7.79683, 3.6735, 32.3868};
 //static const Vec3f MAG_OFFSET   = {-118.902, 18.8173, -39.209};
 static const Vec3f MAG_OFFSET   = {-135.994629, 19.117216, -33.0};
 //static const Mat3f MAG_MAT      = {0., -0.0281408, 0., -0.0284409, 0., 0., 0., 0., 0.0261544};
 static const Mat3f MAG_MAT      = {0., -0.0335989, 0., -0.0330167, 0., 0., 0., 0., 0.0335989};
 static const Vec3f GYRO_OFFSET  = {-4.33655, -2.76826, -0.908427};
-static const Mat3f GYRO_MAT    = {1., 0., 0., 0., -1., 0., 0., 0., 1.};
+static const Mat3f GYRO_MAT    = {1., 0., 0., 0., 1., 0., 0., 0., 1.};
 
 static const char *TAG = "ugv_io_mpu";