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: setup.cpp

Revision:
107:46e039e12182
Parent:
96:3645f8f9bdd3
--- a/setup.cpp	Wed Nov 10 06:35:10 2021 +0000
+++ b/setup.cpp	Fri Nov 12 09:04:59 2021 +0000
@@ -39,6 +39,9 @@
     rollPID.setInputLimits(-M_PI,M_PI); 
     rollratePID.setInputLimits(-M_PI,M_PI);
     
+    autopilot.set_dest(destination.x, destination.y);
+    autopilot.set_turn(turn_center.x, turn_center.y, turn_radius);
+    
     servoRight.period_us(15000.0);
     servoLeft.period_us(15000.0);
     servoThrust.period_us(15000.0);