HAPSRG / Mbed 2 deprecated hexaTest_Eigen

solaESKF_EIGEN

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

Diff: setup.cpp

Revision:
109:eb255fc4462b
Parent:
96:3645f8f9bdd3
Child:
113:3e47d9881529
--- a/setup.cpp	Fri Nov 12 09:03:41 2021 +0000
+++ b/setup.cpp	Fri Nov 12 10:50:56 2021 +0000
@@ -45,6 +45,9 @@
     servoRight.pulsewidth_us(1500.0);
     servoLeft.pulsewidth_us(1500.0); 
     servoThrust.pulsewidth_us(1100.0);
+    
+    autopilot.set_dest(destination.x, destination.y);
+    autopilot.set_turn(turn_center.x, turn_center.y, turn_radius);
 }
 
 void calibrate()