最終調整
Dependencies: mbed AQM0802 CRotaryEncoder TB6612FNG
Diff: main.cpp
- 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; + } } }