solaESKF_EIGEN

Dependencies:   mbed LPS25HB_I2C LSM9DS1 PIDcontroller LoopTicker GPSUBX_UART_Eigen SBUS_without_mainfile MedianFilter Eigen UsaPack solaESKF_Eigen Vector3 CalibrateMagneto FastPWM

Revision:
74:f67062e7813e
Parent:
73:84ffa0166e6c
Child:
75:a505b9896da1
--- a/hil.cpp	Thu Jul 15 05:26:15 2021 +0000
+++ b/hil.cpp	Tue Jul 20 05:52:29 2021 +0000
@@ -21,7 +21,7 @@
     gyro = gyroMedian.Process(gyro);
     mag.x = -float(vp.magData[0])/1000.0f + sigma_mag*randn();
     mag.y = -float(vp.magData[1])/1000.0f + sigma_mag*randn();
-    mag.z = -float(vp.magData[2])/1000.0f + sigma_mag*randn();
+    mag.z =  float(vp.magData[2])/1000.0f + sigma_mag*randn();
     mag = magMedian.Process(mag);
     if(acc.Norm()<0.01f || mag.Norm() < 0.001f){
         acc.x = 0.0f;