update

3 years ago · fa4c1be179
1 changed files with 2 additions and 1 deletions
--- a/main/motor_drive.c
+++ b/main/motor_drive.c
@ -309,11 +309,12 @@ bool motor_stop() {
  static uint8_t motor_read_encoder_count = 0;
  if (motor_cmd_ctr_turn_flag && port_haspassedms(time) > 100) {
    motor_now_encoder = motor_drive_read_encoder();
-    
+
    if (motor_now_encoder == motor_befor_encoder) {
      motor_read_encoder_count = motor_read_encoder_count + 1;
    } else {
      motor_befor_encoder = motor_now_encoder;
+      motor_read_encoder_count = 0;
    }

    if (motor_read_encoder_count == 3) {