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

青木制作機体プログラム

Dependencies:   mbed AQM0802 CRotaryEncoder TB6612FNG

tuning.h@32:4deb27262901, 2019-11-27 (annotated)

Committer:
yusaku0125
Date:
Wed Nov 27 08:40:41 2019 +0000
Revision:
32:4deb27262901
Parent:
31:fe9ae7992246 
test;

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 32:4deb27262901 7 #define LOW_SPEED 750 //標準速度[mm/sec]
yusaku0125 32:4deb27262901 8 #define MEDIUM_SPEED 850 //2走目の中間速度[mm/sec]
yusaku0125 32:4deb27262901 9 #define HIGH_SPEED 1150 //2走目の高速速度[mm/sec]
yusaku0125 30:14615f9ff467 10 #define STOP_DISTANCE 200000 //停止距離200000[um]⇒20[cm]
yusaku0125 32:4deb27262901 11 #define TURN_POWER 0.4f //コースアウト時の旋回力
yusaku0125 31:fe9ae7992246 12
yusaku0125 31:fe9ae7992246 13
yusaku0125 31:fe9ae7992246 14 ///////マーカ判定関連
yusaku0125 32:4deb27262901 15 #define DEFAULT_GRAY 0.25f //フォトリフレクタデジタル入力の閾値
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 32:4deb27262901 23 #define HIGH_SPEED_SECTION 1.35f //最高速度の左右回転差の上限倍率
yusaku0125 32:4deb27262901 24 #define MEDIUM_SPEED_SECTION 1.65f //中間速度の左右回転差の上限倍率
yusaku0125 32:4deb27262901 25 #define LOW_SPEED_SECTION 2.00f //最低速度の左右回転差の上限倍率
yusaku0125 30:14615f9ff467 26 #define HL_BREAK_DISANCE 200000 //高速度で次のカーブが低速カーブのときのブレーキング距離[um]
yusaku0125 32:4deb27262901 27 #define HM_BREAK_DISANCE 150000 //高速度で次のカーブが中間速度カーブのときのブレーキング距離[um]
yusaku0125 32:4deb27262901 28 #define ML_BREAK_DISANCE 100000 //中間速度で次のカーブが低速カーブのときのブレーキング距離[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 32:4deb27262901 40 #define S_K3 4.0f //3倍
yusaku0125 30:14615f9ff467 41
yusaku0125 30:14615f9ff467 42
yusaku0125 30:14615f9ff467 43 //ラインセンサ各種制御成分
yusaku0125 30:14615f9ff467 44 //P成分
yusaku0125 32:4deb27262901 45 #define S_KP_LOW 2.0f //低速P成分
yusaku0125 32:4deb27262901 46 #define S_KP_MEDIUM 1.5f //中速P成分
yusaku0125 30:14615f9ff467 47 #define S_KP_HIGH 1.0f //高速P成分
yusaku0125 30:14615f9ff467 48
yusaku0125 32:4deb27262901 49 #define S_KP_DEFAULT_HIGH 1.5f //3走目P成分
yusaku0125 30:14615f9ff467 50
yusaku0125 30:14615f9ff467 51 //D成分
yusaku0125 32:4deb27262901 52 #define S_KD_LOW 6.0f //低速D成分
yusaku0125 32:4deb27262901 53 #define S_KD_MEDIUM 3.0f //中速D成分
yusaku0125 32:4deb27262901 54 #define S_KD_HIGH 2.0f //高速D成分
yusaku0125 30:14615f9ff467 55
yusaku0125 32:4deb27262901 56 #define S_KD_DEFAULT_HIGH 1.0f //3走目D成分
yusaku0125 30:14615f9ff467 57 //////////☆★☆★☆★☆★☆★//////////////