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:
107:46e039e12182
Parent:
94:579e875a4244
Child:
121:2523eef96b36
Child:
123:b63d3524ffbc
--- a/servo.cpp	Wed Nov 10 06:35:10 2021 +0000
+++ b/servo.cpp	Fri Nov 12 09:04:59 2021 +0000
@@ -21,6 +21,14 @@
     rollPID.setProcessValue(rpy.x);
     rollratePID.setProcessValue(gyro.x);
     
+    if (true)
+    {
+        //level_flight();
+        //point_guide();
+        turning();
+        rollPID.setSetPoint(roll_obj);
+    }
+    
     //舵角計算
     if(rc[4]<-0.3f){
         de = (rc[0]-rc[1])/2.0f;