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

Revision:
107:46e039e12182
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/autopilot.cpp	Fri Nov 12 09:04:59 2021 +0000
@@ -0,0 +1,26 @@
+#include "global.hpp"
+
+void level_flight()
+{
+    autopilot.update_val(rpy, palt, pi);
+    autopilot.level();
+    obj = autopilot.return_val();
+    roll_obj = obj[0];
+}
+
+void point_guide()
+{
+    autopilot.update_val(rpy, palt, pi);
+    autopilot.guide();
+    obj = autopilot.return_val();
+    roll_obj = obj[0];
+    
+}
+
+void turning()
+{
+    autopilot.update_val(rpy, palt, pi);
+    autopilot.turn();
+    obj = autopilot.return_val();
+    roll_obj = obj[0];
+}
\ No newline at end of file