3/2

Dependencies:   mbed move4wheel2 EC CruizCore_R1370P

Committer:
yuki0701
Date:
Sat Mar 02 07:18:38 2019 +0000
Revision:
5:6cebe1c458a9
Parent:
1:3c11e07da92a
a

Who changed what in which revision?

UserRevisionLine numberNew contents of line
la00noix 0:c61c6e4775ca 1 #ifndef HARUROBO2019_MOVEMENT
la00noix 0:c61c6e4775ca 2 #define HARUROBO2019_MOVEMENT
la00noix 0:c61c6e4775ca 3
la00noix 0:c61c6e4775ca 4 extern char ashi_data[4];
la00noix 0:c61c6e4775ca 5
la00noix 0:c61c6e4775ca 6 extern int16_t m1,m2,m3,m4;
la00noix 0:c61c6e4775ca 7
la00noix 0:c61c6e4775ca 8 void UserLoopSetting_sensor();
la00noix 0:c61c6e4775ca 9
la00noix 0:c61c6e4775ca 10 void calOmega();
la00noix 0:c61c6e4775ca 11
la00noix 0:c61c6e4775ca 12 void output(double FL,double BL,double BR,double FR);
la00noix 0:c61c6e4775ca 13
la00noix 0:c61c6e4775ca 14 void base(double FL,double BL,double BR,double FR,double Max);
la00noix 0:c61c6e4775ca 15
la00noix 0:c61c6e4775ca 16 void ashi_led();
la00noix 0:c61c6e4775ca 17
la00noix 0:c61c6e4775ca 18 void calc_gyro();
la00noix 0:c61c6e4775ca 19
la00noix 0:c61c6e4775ca 20 void calc_xy_enc();
la00noix 0:c61c6e4775ca 21
la00noix 0:c61c6e4775ca 22 void set_cond(int t, int px, double bx, int py, double by);
la00noix 0:c61c6e4775ca 23
la00noix 0:c61c6e4775ca 24 void calc_xy_usw(double tgt_angle);
la00noix 0:c61c6e4775ca 25
la00noix 0:c61c6e4775ca 26 void calc_xy(double tgt_angle, double u, double v);
la00noix 0:c61c6e4775ca 27
la00noix 0:c61c6e4775ca 28 void purecurve(int type,double u, double v, //正面を変えずに円弧or楕円を描いて曲がる
la00noix 0:c61c6e4775ca 29 double point_x1,double point_y1,
la00noix 0:c61c6e4775ca 30 double point_x2,double point_y2,
la00noix 0:c61c6e4775ca 31 int theta,
la00noix 0:c61c6e4775ca 32 double speed,
la00noix 0:c61c6e4775ca 33 double q_p,double q_d,
la00noix 0:c61c6e4775ca 34 double r_p,double r_d,
la00noix 0:c61c6e4775ca 35 double r_out_max,
la00noix 0:c61c6e4775ca 36 double target_angle);
la00noix 0:c61c6e4775ca 37
la00noix 0:c61c6e4775ca 38 void gogo_straight(double u, double v, double x1_point,double y1_point, //直線運動プログラム
la00noix 0:c61c6e4775ca 39 double x2_point,double y2_point,
la00noix 0:c61c6e4775ca 40 double speed1,double speed2,
la00noix 0:c61c6e4775ca 41 double q_p,double q_d,
la00noix 0:c61c6e4775ca 42 double r_p,double r_d,
la00noix 0:c61c6e4775ca 43 double r_out_max,
la00noix 0:c61c6e4775ca 44 double target_angle);
la00noix 0:c61c6e4775ca 45
yuki0701 1:3c11e07da92a 46 void pos_correction(double tgt_x, double tgt_y, double tgt_angle, double u, double v);
la00noix 0:c61c6e4775ca 47
la00noix 0:c61c6e4775ca 48 #endif