solaESKF_EIGEN

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

Revision:
45:b439a135c24b
Parent:
44:f571273d3223
Child:
48:1065506191f2
--- a/main.cpp	Thu Apr 08 07:37:23 2021 +0000
+++ b/main.cpp	Wed May 19 05:10:41 2021 +0000
@@ -473,8 +473,8 @@
     pitchratePID.setProcessValue(gyro_y);
     rollPID.setProcessValue(roll);
     rollratePID.setProcessValue(gyro_x);
-    float de = pitchPID.compute()+pitchratePID.compute()-rc[1]+rc[0];
-    float da = rollPID.compute()+rollratePID.compute()+rc[0]+rc[1];
+    float de = pitchPID.compute()+pitchratePID.compute()-rc[1];
+    float da = rollPID.compute()+rollratePID.compute()+rc[0];
     float dT = rc[2];
     
     scaledServoOut[0]=de+da;