Signed-off-by: huhui <huhui@sharkgulf.com>
@@ -68,6 +68,11 @@ static u32 _self_check_task(void *p) {
mc_lock_motor(true);
}
+ if (motor.b_lock_motor) {
+ if (!mc_is_gpio_mlock()) {
+ mc_lock_motor(false);
+ }
return 5;