diff --git a/main/motor_drive.c b/main/motor_drive.c index 939b998..3625032 100644 --- 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) {