Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Fork of TVDctrller2017_brdRev1_ver6 by
Global.h@51:640198055ed6, 2017-12-20 (annotated)
- Committer:
- sift
- Date:
- Wed Dec 20 16:34:37 2017 +0000
- Revision:
- 51:640198055ed6
- Parent:
- 47:949e6c2e69fc
- Child:
- 52:6209efecde6f
???????????????????????; ???
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
sift | 25:c21d35c7f0de | 1 | #ifndef GLOBAL_H |
sift | 25:c21d35c7f0de | 2 | #define GLOBAL_H |
sift | 25:c21d35c7f0de | 3 | |
sift | 25:c21d35c7f0de | 4 | //制御周期 |
sift | 39:c05074379713 | 5 | const float CONTROL_CYCLE_S = 0.01f; |
sift | 39:c05074379713 | 6 | const int CONTROL_CYCLE_MS = (int)(CONTROL_CYCLE_S * 1000.0f); |
sift | 39:c05074379713 | 7 | const int CONTROL_CYCLE_US = (int)(CONTROL_CYCLE_S * 1000000.0f); |
sift | 25:c21d35c7f0de | 8 | |
sift | 43:5da6b1574227 | 9 | const float RPS_MEAS_CYCLE_S = 0.01f; |
sift | 43:5da6b1574227 | 10 | const int RPS_MEAS_CYCLE_US = (int)(RPS_MEAS_CYCLE_S * 1000000); |
sift | 40:8e33c60c6590 | 11 | |
sift | 44:d433bb5f77c0 | 12 | const float LSB_MOTORSPEED = 0.01f; //[(m/s) / bit] |
sift | 44:d433bb5f77c0 | 13 | const float LSB_RPS = 0.0004f; //[rps / bit] |
sift | 28:47e9531a3a9d | 14 | |
sift | 25:c21d35c7f0de | 15 | //エラーカウンタ型 |
sift | 25:c21d35c7f0de | 16 | struct errCounter_t { |
sift | 25:c21d35c7f0de | 17 | int apsUnderVolt; //aps電圧不足 |
sift | 25:c21d35c7f0de | 18 | int apsExceedVolt; //aps電圧超過 |
sift | 25:c21d35c7f0de | 19 | int apsErrorTolerance; //aps偏差超過 |
sift | 25:c21d35c7f0de | 20 | int apsStick; //aps固着 |
sift | 25:c21d35c7f0de | 21 | int brakeUnderVolt; //brake電圧不足 |
sift | 25:c21d35c7f0de | 22 | int brakeExceedVolt; //brake電圧超過 |
sift | 25:c21d35c7f0de | 23 | int brakeFuzzyVolt; //brake曖昧な電圧(ONでもOFFでもない) |
sift | 25:c21d35c7f0de | 24 | int brakeOverRide; //accel-brake同時踏み |
sift | 25:c21d35c7f0de | 25 | }; |
sift | 25:c21d35c7f0de | 26 | |
sift | 43:5da6b1574227 | 27 | typedef enum { |
sift | 45:8e5d35beb957 | 28 | FR_WHEEL = 0, FL_WHEEL = 1, RR_MOTOR = 2, RL_MOTOR = 3, SELECT_T_NUM |
sift | 43:5da6b1574227 | 29 | }select_t; |
sift | 25:c21d35c7f0de | 30 | |
sift | 47:949e6c2e69fc | 31 | const double M_PI = 3.1415f; //[-] |
sift | 25:c21d35c7f0de | 32 | |
sift | 47:949e6c2e69fc | 33 | const double ratioLPF = 0.67; //各センサLPF:CutOff:20Hz |
sift | 47:949e6c2e69fc | 34 | const double ratioLPF_ACC_BRK = 0.061; //各センサLPF:CutOff:1Hz |
sift | 47:949e6c2e69fc | 35 | //const double ratioLPF_ACC_BRK = 0.67; //各センサLPF:CutOff:1Hz |
sift | 47:949e6c2e69fc | 36 | const double ratioLPF_RPS = 0.773; //各センサLPF:CutOff:30Hz |
sift | 25:c21d35c7f0de | 37 | |
sift | 47:949e6c2e69fc | 38 | #define myAbs(x) (((x)>=0)?(x):(-(x))) |
sift | 47:949e6c2e69fc | 39 | #define mySign(x) (((x)>=0)?(1.0):(-1.0)) |
sift | 46:16f1a7a01f5f | 40 | #define myMin(x,y) (((x)<(y))?(x):(y)) |
sift | 47:949e6c2e69fc | 41 | #define myMax(x,y) (((x)>(y))?(x):(y)) |
sift | 25:c21d35c7f0de | 42 | |
sift | 47:949e6c2e69fc | 43 | const double GEAR_RATIO =13.0; //[-] |
sift | 47:949e6c2e69fc | 44 | const double TIRE_DIAMETER =0.533; //[m] |
sift | 47:949e6c2e69fc | 45 | const double WHEEL_BASE =1.760; //[m] |
sift | 47:949e6c2e69fc | 46 | const double TREAD =1.3; //[m] |
sift | 47:949e6c2e69fc | 47 | const double A =0.005; //[s^2/m^2] |
sift | 51:640198055ed6 | 48 | const double STEER_RATIO =0.148; //[-] |
sift | 46:16f1a7a01f5f | 49 | const double ALPHA =5.0f; //[-]増幅率α |
sift | 25:c21d35c7f0de | 50 | |
sift | 25:c21d35c7f0de | 51 | #endif |