|
@@ -37,6 +37,7 @@ static int lpc32xx_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm,
|
|
|
struct lpc32xx_pwm_chip *lpc32xx = to_lpc32xx_pwm_chip(chip);
|
|
|
unsigned long long c;
|
|
|
int period_cycles, duty_cycles;
|
|
|
+ u32 val;
|
|
|
|
|
|
c = clk_get_rate(lpc32xx->clk) / 256;
|
|
|
c = c * period_ns;
|
|
@@ -68,8 +69,10 @@ static int lpc32xx_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm,
|
|
|
c = 255;
|
|
|
duty_cycles = 256 - c;
|
|
|
|
|
|
- writel(PWM_ENABLE | PWM_RELOADV(period_cycles) | PWM_DUTY(duty_cycles),
|
|
|
- lpc32xx->base + (pwm->hwpwm << 2));
|
|
|
+ val = readl(lpc32xx->base + (pwm->hwpwm << 2));
|
|
|
+ val &= ~0xFFFF;
|
|
|
+ val |= PWM_RELOADV(period_cycles) | PWM_DUTY(duty_cycles);
|
|
|
+ writel(val, lpc32xx->base + (pwm->hwpwm << 2));
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -77,15 +80,29 @@ static int lpc32xx_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm,
|
|
|
static int lpc32xx_pwm_enable(struct pwm_chip *chip, struct pwm_device *pwm)
|
|
|
{
|
|
|
struct lpc32xx_pwm_chip *lpc32xx = to_lpc32xx_pwm_chip(chip);
|
|
|
+ u32 val;
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ ret = clk_enable(lpc32xx->clk);
|
|
|
+ if (ret)
|
|
|
+ return ret;
|
|
|
|
|
|
- return clk_enable(lpc32xx->clk);
|
|
|
+ val = readl(lpc32xx->base + (pwm->hwpwm << 2));
|
|
|
+ val |= PWM_ENABLE;
|
|
|
+ writel(val, lpc32xx->base + (pwm->hwpwm << 2));
|
|
|
+
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
static void lpc32xx_pwm_disable(struct pwm_chip *chip, struct pwm_device *pwm)
|
|
|
{
|
|
|
struct lpc32xx_pwm_chip *lpc32xx = to_lpc32xx_pwm_chip(chip);
|
|
|
+ u32 val;
|
|
|
+
|
|
|
+ val = readl(lpc32xx->base + (pwm->hwpwm << 2));
|
|
|
+ val &= ~PWM_ENABLE;
|
|
|
+ writel(val, lpc32xx->base + (pwm->hwpwm << 2));
|
|
|
|
|
|
- writel(0, lpc32xx->base + (pwm->hwpwm << 2));
|
|
|
clk_disable(lpc32xx->clk);
|
|
|
}
|
|
|
|
|
@@ -145,7 +162,7 @@ static int lpc32xx_pwm_remove(struct platform_device *pdev)
|
|
|
return pwmchip_remove(&lpc32xx->chip);
|
|
|
}
|
|
|
|
|
|
-static struct of_device_id lpc32xx_pwm_dt_ids[] = {
|
|
|
+static const struct of_device_id lpc32xx_pwm_dt_ids[] = {
|
|
|
{ .compatible = "nxp,lpc3220-pwm", },
|
|
|
{ /* sentinel */ }
|
|
|
};
|