diff --git a/TaiChi/TaiChi.ino b/TaiChi/TaiChi.ino index 1f55f59..73b3392 100644 --- a/TaiChi/TaiChi.ino +++ b/TaiChi/TaiChi.ino @@ -104,7 +104,8 @@ void TurnDirection(uint8_t direction, float speed_rate = 1.0); void setup() { #ifdef TAICHI_DEBUG - Serial.begin(9600); + Serial.begin(115200); + Serial.println("#TAICHI: ======================setup()====================="); #endif move.Stop(); @@ -123,6 +124,10 @@ void setup() void loop() { + #ifdef TAICHI_DEBUG + Serial.println("#TAICHI: ====================New loop()===================="); + #endif + //情况一:刚完整经过普通点,下一个点为普通点 if (route[passed_flag][TYPE] == NORMAL_POINT && route[next_flag][TYPE] == NORMAL_POINT) { @@ -196,6 +201,10 @@ void loop() if (++next_next_flag > max_flag) next_next_flag = 0; + + #ifdef TAICHI_DEBUG + Serial.println("#TAICHI: ====================End loop()===================="); + #endif } @@ -430,4 +439,4 @@ void TurnDirection(uint8_t direction, float speed_rate) //调试输出直行或后退或转向结束 Serial.println("#TAICHI: End Turn Direction"); #endif -} \ No newline at end of file +}