|
@ -314,6 +314,7 @@ bool motor_stop() { |
|
|
motor_read_encoder_count = motor_read_encoder_count + 1; |
|
|
motor_read_encoder_count = motor_read_encoder_count + 1; |
|
|
} else { |
|
|
} else { |
|
|
motor_befor_encoder = motor_now_encoder; |
|
|
motor_befor_encoder = motor_now_encoder; |
|
|
|
|
|
motor_read_encoder_count = 0; |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
if (motor_read_encoder_count == 3) { |
|
|
if (motor_read_encoder_count == 3) { |
|
|