solaESKF_EIGEN

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

Revision:
121:2523eef96b36
Parent:
119:a21e283730d1
Child:
126:03da3a8c8870
--- a/setup.cpp	Thu Nov 18 10:10:18 2021 +0000
+++ b/setup.cpp	Fri Nov 19 07:56:16 2021 +0000
@@ -52,8 +52,9 @@
     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);
+    autopilot.set_dest(100.0f, 100.0f);
+    autopilot.set_turn(100.0f, 100.0f, 50.0f);
+    autopilot.set_alt(30.0f, 10.0f);
 }
 
 void calibrate()