最終調整

Dependencies:   mbed AQM0802 CRotaryEncoder TB6612FNG

Revision:
34:ae6cc6b0ac19
Parent:
32:4deb27262901
--- a/main.cpp	Thu Nov 28 02:52:38 2019 +0000
+++ b/main.cpp	Sat Nov 30 06:01:16 2019 +0000
@@ -90,7 +90,7 @@
 
 int Imaginary_Speed=0;                 //曲率演算にて求めた2走目以降の仮想走行速度
 int Next_Imaginary_Speed=0;
-long int       course_data[100][3];                  //コース情報の記憶用配列マーカ数は行数分まで対応し、
+long int       course_data[200][3];                  //コース情報の記憶用配列マーカ数は行数分まで対応し、
                                             //列情報は左タイヤ走行距離、右タイヤ走行距離、演算で求めた2走目走行速度を格納する。
 int Row=0;                                  //行情報を格納。マーカ通過ごとに加算し、走行終了後リセットされる。
 int Marker_Cnt=0;
@@ -273,6 +273,12 @@
                 Target_Speed_A=Low_Speed;
                 Target_Speed_B=Low_Speed;
             } 
+    }//現在速度が中間速度で次のコースが急カーブであり、残り距離が---だったとき
+    else if((course_data[Row][2]==High_Speed)&&(Next_Imaginary_Speed==High_Speed)){
+            if(Recent_Distance<(HM_BREAK_DISANCE)){
+                Target_Speed_A=Low_Speed;
+                Target_Speed_B=Low_Speed;
+            } 
     }          
 }