自己位置推定機能を追加
Dependencies: SBDBT arrc_mbed BNO055
Odmetry.hpp
- Committer:
- kazumayamanaka
- Date:
- 2022-03-05
- Revision:
- 8:f2407caf81ba
- Parent:
- 7:a0b9b6e71e41
File content as of revision 8:f2407caf81ba:
#ifndef ODMETRY_H #define ODMETRY_H #include "mbed.h" #define Co (108 * 3.1415926535897) / 512 #define PI 3.1415926535897 class Odmetry{ public: Odmetry(); 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(); void CalcPosition(); void CalcSpd(); void transform(); double Radius; double Wradius; double Omega[4]; double spd[4]; double pulse_a[4],pulse_b[4],diff[4]; double Xspd,Yspd; double Xpower,Ypower; double XPos,YPos,Theta; double dt; }; #endif