修正

Dependencies:   mbed CRotaryEncoder TB6612FNG

Files at this revision

API Documentation at this revision

Comitter:
poritekutama
Date:
Tue Aug 27 04:22:52 2019 +0000
Parent:
5:f635f1f01d2d
Commit message:
test;

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
diff -r f635f1f01d2d -r 5496ee4b3f3b main.cpp
--- a/main.cpp	Mon Aug 26 09:25:22 2019 +0000
+++ b/main.cpp	Tue Aug 27 04:22:52 2019 +0000
@@ -11,8 +11,8 @@
 
 
 //☆★☆★各種パラメータ調整箇所☆★☆★☆★
-#define     DEFAULT_SPEED 500   //機体の直進速度1000[mm/s] 
-#define     PULSE_TO_UM     30  //エンコーダ1パルス当たりのタイヤ移動距離[um]
+#define     DEFAULT_SPEED   900   //機体の直進速度1000[mm/s] 
+#define     PULSE_TO_UM     28  //エンコーダ1パルス当たりのタイヤ移動距離[um]
 #define     INTERRUPT_TIME  1000  //割りこみ周期[us]
 
 //モータ速度のゲイン関連(むやみに調整しない)
@@ -20,12 +20,12 @@
 #define     M_KD    0.001f//D(微分)制御成分
 
 //フォトリフレクタのゲイン(外側に行くにつれ値を何倍させたいか調整する。)
-#define S_K1    1.0f    //float演算させる値には必ずfを付ける
-#define S_K2    2.0f    //2倍
-#define S_K3    4.0f    //4倍
+#define S_K1    1.4f    //float演算させる値には必ずfを付ける
+#define S_K2    2.4f    //2倍
+#define S_K3    4.5f    //4倍
 
 //ラインセンサ各種制御成分
-#define S_KP    0.5f    //ラインセンサ比例成分。大きいほど曲がりやすい
+#define S_KP    0.8f    //ラインセンサ比例成分。大きいほど曲がりやすい
 #define S_KD    0.3f    //ラインセンサ微分成分。大きいほど急なラインずれに強くなる。
 
 
@@ -102,7 +102,7 @@
     /////モータの速度制御
     //過去の速度偏差を退避
     Motor_A_Diff[1]=Motor_A_Diff[0];
-    Motor_A_Diff[1]=Motor_A_Diff[0];
+    Motor_B_Diff[1]=Motor_B_Diff[0];
     //現在の速度偏差を取得。    
     Motor_A_Diff[0]=(Target_Speed_A-Speed_A);
     Motor_B_Diff[0]=(Target_Speed_B-Speed_B);