HAPSRG / Mbed 2 deprecated optWingforHAPS_Eigen

Eigen Revision

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

Diff: servo.cpp

Revision:
87:89bbbcdb667b
Parent:
85:bc03f862a316
Child:
90:96c2b0ed4b96
--- a/servo.cpp	Mon Oct 18 12:18:15 2021 +0000
+++ b/servo.cpp	Wed Oct 20 01:50:52 2021 +0000
@@ -62,9 +62,11 @@
     servoLeft.pulsewidth_us(servoOut[1]); 
     servoThrust.pulsewidth_us(motorOut[0]);
 
+    sendData2PC();
+    writeSDcard();
     if(loop_count >= 6)
     {
-        writeSdcard();
+        sendTelemetry();
         loop_count = 1;
 
     }