solaESKF_EIGEN

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

Revision:
94:579e875a4244
Parent:
92:00460f6df439
Child:
107:46e039e12182
--- a/servo.cpp	Fri Oct 29 13:30:24 2021 +0000
+++ b/servo.cpp	Mon Nov 01 09:18:07 2021 +0000
@@ -65,9 +65,10 @@
     servoThrust.pulsewidth_us(motorOut[0]);
 
     sendData2PC();
-    writeSDcard();
-    if(loop_count >= 6)
+
+    if(loop_count >= 5)
     {
+        writeSDcard();
         sendTelemetry();
         loop_count = 1;