diff --git a/motion controller code/src/motors.c b/motion controller code/src/motors.c index 15651bb..36545c5 100644 --- a/motion controller code/src/motors.c +++ b/motion controller code/src/motors.c @@ -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); }