solaESKF_EIGEN

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

Revision:
89:c9f64bd655d9
Parent:
88:be349faa1976
Child:
90:96c2b0ed4b96
--- a/transferData.cpp	Thu Oct 21 06:41:03 2021 +0000
+++ b/transferData.cpp	Mon Oct 25 05:39:34 2021 +0000
@@ -23,7 +23,8 @@
 void sendTelemetry()
 {
     //twelite.printf("%f %f %f %f %f %f\r\n",da,de,dT,rpy.x*180.0f/M_PI,rpy.y*180.0f/M_PI,rpy.z*180.0f/M_PI);
-    twelite.printf("%f %f %f %f %f %f %f %f %f %f %f %f\r\n",ekf.vihat(1,1), ekf.vihat(2,1), ekf.vihat(3,1),ekf.accBias.x,ekf.accBias.y,ekf.accBias.z,ekf.errState(7,1),ekf.errState(8,1),ekf.errState(9,1),ekf.errState(10,1),ekf.errState(11,1),ekf.errState(12,1));
+    twelite.printf("%f %f %f %f %f %f %f %f %f %f %f %f\r\n",ekf.accned(1,1),ekf.accned(2,1),ekf.accned(3,1),ekf.vihat(1,1), ekf.vihat(2,1), ekf.vihat(3,1),ekf.errState(10,1),ekf.errState(11,1),ekf.errState(12,1),rpy.x*180.0f/M_PI,rpy.y*180.0f/M_PI,rpy.z*180.0f/M_PI);
+    //twelite.printf("%f %f %f %f %f %f %f %f %f\r\n", lsm.ax, lsm.ay, lsm.az, lsm.gx, lsm.gy, lsm.gz, lsm.mx, lsm.my, lsm.mz);
 }
 
 void writeSDcard()