|
@@ -102,7 +102,7 @@ static int pwm_lpss_config(struct pwm_chip *chip, struct pwm_device *pwm,
|
|
* The equation is:
|
|
* The equation is:
|
|
* base_unit = round(base_unit_range * freq / c)
|
|
* base_unit = round(base_unit_range * freq / c)
|
|
*/
|
|
*/
|
|
- base_unit_range = BIT(lpwm->info->base_unit_bits);
|
|
|
|
|
|
+ base_unit_range = BIT(lpwm->info->base_unit_bits) - 1;
|
|
freq *= base_unit_range;
|
|
freq *= base_unit_range;
|
|
|
|
|
|
base_unit = DIV_ROUND_CLOSEST_ULL(freq, c);
|
|
base_unit = DIV_ROUND_CLOSEST_ULL(freq, c);
|
|
@@ -117,8 +117,8 @@ static int pwm_lpss_config(struct pwm_chip *chip, struct pwm_device *pwm,
|
|
|
|
|
|
ctrl = pwm_lpss_read(pwm);
|
|
ctrl = pwm_lpss_read(pwm);
|
|
ctrl &= ~PWM_ON_TIME_DIV_MASK;
|
|
ctrl &= ~PWM_ON_TIME_DIV_MASK;
|
|
- ctrl &= ~((base_unit_range - 1) << PWM_BASE_UNIT_SHIFT);
|
|
|
|
- base_unit &= (base_unit_range - 1);
|
|
|
|
|
|
+ ctrl &= ~(base_unit_range << PWM_BASE_UNIT_SHIFT);
|
|
|
|
+ base_unit &= base_unit_range;
|
|
ctrl |= (u32) base_unit << PWM_BASE_UNIT_SHIFT;
|
|
ctrl |= (u32) base_unit << PWM_BASE_UNIT_SHIFT;
|
|
ctrl |= on_time_div;
|
|
ctrl |= on_time_div;
|
|
pwm_lpss_write(pwm, ctrl);
|
|
pwm_lpss_write(pwm, ctrl);
|