自己位置推定機能を追加

Dependencies:   SBDBT arrc_mbed BNO055

Committer:
kazumayamanaka
Date:
Wed Jan 19 12:43:26 2022 +0000
Revision:
0:a1238c4cd105
2022robotcontest

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kazumayamanaka 0:a1238c4cd105 1 #ifndef DUALSHOCK_CO_H
kazumayamanaka 0:a1238c4cd105 2 #define DUALSHOCK_CO_H
kazumayamanaka 0:a1238c4cd105 3 #include "mbed.h"
kazumayamanaka 0:a1238c4cd105 4 #define RS_normal 64
kazumayamanaka 0:a1238c4cd105 5 #define RS_MAX 127
kazumayamanaka 0:a1238c4cd105 6 #define RL_MAX 255
kazumayamanaka 0:a1238c4cd105 7
kazumayamanaka 0:a1238c4cd105 8 class DUALSHOCKco{
kazumayamanaka 0:a1238c4cd105 9
kazumayamanaka 0:a1238c4cd105 10 public:
kazumayamanaka 0:a1238c4cd105 11 void pass_val(double RSX,double RSY,double R2AN,double L2AN);
kazumayamanaka 0:a1238c4cd105 12 bool cal_input();
kazumayamanaka 0:a1238c4cd105 13 double obt_X();
kazumayamanaka 0:a1238c4cd105 14 double obt_Y();
kazumayamanaka 0:a1238c4cd105 15
kazumayamanaka 0:a1238c4cd105 16 private:
kazumayamanaka 0:a1238c4cd105 17 double rsx,rsy,r2an,l2an;
kazumayamanaka 0:a1238c4cd105 18 double Xval,Yval;
kazumayamanaka 0:a1238c4cd105 19
kazumayamanaka 0:a1238c4cd105 20 };
kazumayamanaka 0:a1238c4cd105 21
kazumayamanaka 0:a1238c4cd105 22 #endif