From fa4c1be1797c31c25f883776108ddd049d65a1ab Mon Sep 17 00:00:00 2001 From: zwsd Date: Wed, 3 Aug 2022 16:53:43 +0800 Subject: [PATCH] update --- main/motor_drive.c | 3 ++- 1 file changed, 2 insertions(+), 1 deletion(-) 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) {