Changing some const variables
This commit is contained in:
parent
590ced4bd5
commit
b2995b9894
|
@ -25,11 +25,11 @@ void init_motors(void)
|
|||
const motor_def_t *motor_def = &MOTORS_DEFS[actual_motor];
|
||||
|
||||
// Init PWM
|
||||
uint slice_num = pwm_gpio_to_slice_num(motor_def->pwm_pin);
|
||||
const uint SLICE_NUM = pwm_gpio_to_slice_num(motor_def->pwm_pin);
|
||||
|
||||
gpio_set_function(motor_def->pwm_pin, GPIO_FUNC_PWM);
|
||||
pwm_set_wrap(slice_num, 128);
|
||||
pwm_set_enabled(slice_num, true);
|
||||
pwm_set_wrap(SLICE_NUM, 128);
|
||||
pwm_set_enabled(SLICE_NUM, true);
|
||||
|
||||
// Init dir pins
|
||||
gpio_init(motor_def->dir1_pin);
|
||||
|
@ -50,12 +50,12 @@ void init_servo_motors(void)
|
|||
const servo_motor_def_t *servo_motor_def = &SERVO_MOTORS_DEFS[actual_servo_motor];
|
||||
|
||||
// Init PWM //
|
||||
uint slice_num = pwm_gpio_to_slice_num(servo_motor_def->pwm_pin);
|
||||
const uint SLICE_NUM = pwm_gpio_to_slice_num(servo_motor_def->pwm_pin);
|
||||
|
||||
gpio_set_function(servo_motor_def->pwm_pin, GPIO_FUNC_PWM);
|
||||
pwm_set_wrap(slice_num, 25000);
|
||||
pwm_set_clkdiv(slice_num, 100);
|
||||
pwm_set_enabled(slice_num, true);
|
||||
pwm_set_wrap(SLICE_NUM, 25000);
|
||||
pwm_set_clkdiv(SLICE_NUM, 100);
|
||||
pwm_set_enabled(SLICE_NUM, true);
|
||||
|
||||
servo_motor_zero(actual_servo_motor);
|
||||
}
|
||||
|
|
Loading…
Reference in New Issue