pwm: lpc32xx: Properly set PWM_ENABLE bit in lpc32xx_pwm_[enable|disable]

[karo-tx-linux.git] / drivers / pwm / pwm-lpc32xx.c

diff --git a/drivers/pwm/pwm-lpc32xx.c b/drivers/pwm/pwm-lpc32xx.c
index b55cc5c1d614ad098011cadd363b5872c04d1031..6b6272f61da5a62dc76c3b22e5c9a714b1c0911f 100644 (file)
--- a/drivers/pwm/pwm-lpc32xx.c
+++ b/drivers/pwm/pwm-lpc32xx.c
@@ -77,15 +77,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);
 }