自己位置推定機能を追加

Dependencies:   SBDBT arrc_mbed BNO055

Revision:
7:a0b9b6e71e41
Parent:
2:e189d55ef292
--- a/Odmetry.hpp	Fri Jan 28 15:13:35 2022 +0000
+++ b/Odmetry.hpp	Wed Feb 23 03:03:36 2022 +0000
@@ -11,6 +11,9 @@
         void pass_pulse(double PULSE1,double PULSE2,double PULSE3,double PULSE4);
         void pass_angle(double THETA);
         void print_Pos();
+        double obt_CurrentPosX();
+        double obt_CurrentPosY();
+        double obt_CurrentTheta();
         
     private:
         void Angular();