島根短大　ライントレーサ制作チーム / Mbed 2 deprecated Aoki_machine

青木制作機体プログラム

Dependencies:   mbed AQM0802 CRotaryEncoder TB6612FNG

tuning.h@31:fe9ae7992246, 2019-11-26 (annotated)

Committer:
yusaku0125
Date:
Tue Nov 26 02:57:02 2019 +0000
Revision:
31:fe9ae7992246
Parent:
30:14615f9ff467
Child:
32:4deb27262901
2019/11/26  12:00;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
yusaku0125 30:14615f9ff467 1 /************************************
yusaku0125 30:14615f9ff467 2 個人で設定する調整パラメータ
yusaku0125 30:14615f9ff467 3
yusaku0125 30:14615f9ff467 4 ************************************/
yusaku0125 30:14615f9ff467 5
yusaku0125 31:fe9ae7992246 6 ////////機体速度関連
yusaku0125 30:14615f9ff467 7 #define LOW_SPEED 800 //標準速度[mm/sec]
yusaku0125 30:14615f9ff467 8 #define MEDIUM_SPEED 950 //2走目の中間速度[mm/sec]
yusaku0125 30:14615f9ff467 9 #define HIGH_SPEED 1200 //2走目の高速速度[mm/sec]
yusaku0125 30:14615f9ff467 10 #define STOP_DISTANCE 200000 //停止距離200000[um]⇒20[cm]
yusaku0125 30:14615f9ff467 11 #define TURN_POWER 0.6f //コースアウト時の旋回力
yusaku0125 31:fe9ae7992246 12
yusaku0125 31:fe9ae7992246 13
yusaku0125 31:fe9ae7992246 14 ///////マーカ判定関連
yusaku0125 30:14615f9ff467 15 #define DEFAULT_GRAY 0.2f //フォトリフレクタデジタル入力の閾値
yusaku0125 30:14615f9ff467 16 //シリアル通信でSensor_Digital値を確認し調整する。
yusaku0125 30:14615f9ff467 17 #define MARKER_WIDTH 8000 //マーカ幅[um]（ビニルテープ幅19000[um]以内）
yusaku0125 30:14615f9ff467 18 //コースの傷によってマーカ誤検知する場合は値を大きくする。
yusaku0125 30:14615f9ff467 19 #define CROSS_JUDGE 4 //ラインセンサいくつ以上白線検知で交差点認識するか設定。
yusaku0125 30:14615f9ff467 20
yusaku0125 31:fe9ae7992246 21
yusaku0125 31:fe9ae7992246 22 //////ブレーキングシステム調整
yusaku0125 31:fe9ae7992246 23 #define HIGH_SPEED_SECTION 1.25f //最高速度の左右回転差の上限倍率
yusaku0125 31:fe9ae7992246 24 #define MEDIUM_SPEED_SECTION 2.0f //中間速度の左右回転差の上限倍率
yusaku0125 30:14615f9ff467 25 #define LOW_SPEED_SECTION 4.0f //最低速度の左右回転差の上限倍率
yusaku0125 30:14615f9ff467 26 #define HL_BREAK_DISANCE 200000 //高速度で次のカーブが低速カーブのときのブレーキング距離[um]
yusaku0125 30:14615f9ff467 27 #define HM_BREAK_DISANCE 100000 //高速度で次のカーブが中間速度カーブのときのブレーキング距離[um]
yusaku0125 30:14615f9ff467 28 #define ML_BREAK_DISANCE 50000 //中間速度で次のカーブが低速カーブのときのブレーキング距離[um]
yusaku0125 31:fe9ae7992246 29
yusaku0125 31:fe9ae7992246 30
yusaku0125 31:fe9ae7992246 31
yusaku0125 31:fe9ae7992246 32 //////各種PD調整
yusaku0125 30:14615f9ff467 33 //モータ速度のゲイン関連(むやみに調整しない)
yusaku0125 30:14615f9ff467 34 #define M_KP 0.002f //P(比例)制御成分
yusaku0125 30:14615f9ff467 35 #define M_KD 0.001f //D(微分)制御成分
yusaku0125 30:14615f9ff467 36
yusaku0125 30:14615f9ff467 37 //フォトリフレクタのゲイン（外側に行くにつれ値を何倍させたいか調整する。）
yusaku0125 30:14615f9ff467 38 #define S_K1 1.0f //float演算させる値には必ずfを付ける
yusaku0125 30:14615f9ff467 39 #define S_K2 2.0f //2倍
yusaku0125 31:fe9ae7992246 40 #define S_K3 3.0f //3倍
yusaku0125 30:14615f9ff467 41
yusaku0125 30:14615f9ff467 42
yusaku0125 30:14615f9ff467 43 //ラインセンサ各種制御成分
yusaku0125 30:14615f9ff467 44 //P成分
yusaku0125 30:14615f9ff467 45 #define S_KP_LOW 3.0f //低速P成分
yusaku0125 30:14615f9ff467 46 #define S_KP_MEDIUM 2.0f //中速P成分
yusaku0125 30:14615f9ff467 47 #define S_KP_HIGH 1.0f //高速P成分
yusaku0125 30:14615f9ff467 48
yusaku0125 30:14615f9ff467 49 #define S_KP_DEFAULT_HIGH 2.0f //3走目P成分
yusaku0125 30:14615f9ff467 50
yusaku0125 30:14615f9ff467 51 //D成分
yusaku0125 30:14615f9ff467 52 #define S_KD_LOW 15.0f //低速D成分
yusaku0125 30:14615f9ff467 53 #define S_KD_MEDIUM 10.0f //中速D成分
yusaku0125 30:14615f9ff467 54 #define S_KD_HIGH 5.0f //高速D成分
yusaku0125 30:14615f9ff467 55
yusaku0125 30:14615f9ff467 56 #define S_KD_DEFAULT_HIGH 10.0f //3走目D成分
yusaku0125 30:14615f9ff467 57 //////////☆★☆★☆★☆★☆★//////////////