solaESKF_EIGEN

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

Revision:
113:3e47d9881529
Parent:
109:eb255fc4462b
Child:
117:f899fd694e2a
Child:
118:962f226bdf64
--- a/setup.cpp	Tue Nov 16 01:21:01 2021 +0000
+++ b/setup.cpp	Tue Nov 16 13:57:32 2021 +0000
@@ -18,9 +18,12 @@
     gps.Attach();
     wait_ms(100);
     
-    SensorAlignment << 1.0f << 0.0f << 0.0f
-                    << 0.0f << 1.0f << 0.0f
-                    << 0.0f << 0.0f << -1.0f; 
+    SensorAlignmentAG << 1.0f << 0.0f << 0.0f
+                      << 0.0f << 1.0f << 0.0f
+                      << 0.0f << 0.0f << -1.0f;
+    SensorAlignmentMAG <<  0.0f << -1.0f << 0.0f
+                       << -1.0f <<  0.0f << 0.0f
+                       <<  0.0f <<  0.0f << -1.0f; 
     
     pitchPID.setSetPoint(0.0);
     pitchratePID.setSetPoint(0.0);