Changed the motor implementation on PicoExplorer to used breaking mode

encoder-pio
ZodiusInfuser 2021-02-10 16:26:49 +00:00
rodzic 8b4badb4b9
commit c113f30da6
1 zmienionych plików z 8 dodań i 8 usunięć

Wyświetl plik

@ -35,7 +35,7 @@ namespace pimoroni {
// setup motor pins
pwm_config motor_pwm_cfg = pwm_get_default_config();
pwm_config_set_wrap(&motor_pwm_cfg, 255);
pwm_config_set_wrap(&motor_pwm_cfg, 5500);
pwm_init(pwm_gpio_to_slice_num(MOTOR1N), &motor_pwm_cfg, true);
gpio_set_function(MOTOR1N, GPIO_FUNC_PWM);
@ -76,20 +76,20 @@ namespace pimoroni {
switch(action) {
case FORWARD: {
pwm_set_gpio_level(p, speed * 255);
pwm_set_gpio_level(n, 0);
pwm_set_gpio_level(n, (1 - speed) * 5500);
pwm_set_gpio_level(p, 5500);
break;
}
case REVERSE: {
pwm_set_gpio_level(p, 0);
pwm_set_gpio_level(n, speed * 255);
pwm_set_gpio_level(n, 5500);
pwm_set_gpio_level(p, (1 - speed) * 5500);
break;
}
case STOP: {
pwm_set_gpio_level(p, 0);
pwm_set_gpio_level(n, 0);
pwm_set_gpio_level(p, 5500);
pwm_set_gpio_level(n, 5500);
break;
}
}
@ -116,4 +116,4 @@ namespace pimoroni {
}
}
}
}