gpio: mvebu: switch pwm duration registers to regmap

Commit 2233bf7a92 ("gpio: mvebu: switch to regmap for register access")
changed most readl/writel registers access calls to the regmap API in
preparation for Armada 7K/8K support. PWM duration registers were left using
readl/writel, as the driver does not support PWM for Armada 7K/8K.

Switch PWM duration registers to regmap as first step in adding Armada 7K/8K
PWM functionality support.

Reviewed-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: Baruch Siach <baruch@tkos.co.il>
Signed-off-by: Bartosz Golaszewski <bgolaszewski@baylibre.com>
This commit is contained in:
Baruch Siach 2020-12-02 09:15:34 +02:00 committed by Bartosz Golaszewski
parent 64b19f6abe
commit 48f32a8353
1 changed files with 36 additions and 32 deletions

View File

@ -92,7 +92,7 @@
#define MVEBU_MAX_GPIO_PER_BANK 32 #define MVEBU_MAX_GPIO_PER_BANK 32
struct mvebu_pwm { struct mvebu_pwm {
void __iomem *membase; struct regmap *regs;
unsigned long clk_rate; unsigned long clk_rate;
struct gpio_desc *gpiod; struct gpio_desc *gpiod;
struct pwm_chip chip; struct pwm_chip chip;
@ -278,17 +278,17 @@ mvebu_gpio_write_level_mask(struct mvebu_gpio_chip *mvchip, u32 val)
} }
/* /*
* Functions returning addresses of individual registers for a given * Functions returning offsets of individual registers for a given
* PWM controller. * PWM controller.
*/ */
static void __iomem *mvebu_pwmreg_blink_on_duration(struct mvebu_pwm *mvpwm) static unsigned int mvebu_pwmreg_blink_on_duration(struct mvebu_pwm *mvpwm)
{ {
return mvpwm->membase + PWM_BLINK_ON_DURATION_OFF; return PWM_BLINK_ON_DURATION_OFF;
} }
static void __iomem *mvebu_pwmreg_blink_off_duration(struct mvebu_pwm *mvpwm) static unsigned int mvebu_pwmreg_blink_off_duration(struct mvebu_pwm *mvpwm)
{ {
return mvpwm->membase + PWM_BLINK_OFF_DURATION_OFF; return PWM_BLINK_OFF_DURATION_OFF;
} }
/* /*
@ -599,6 +599,13 @@ static void mvebu_gpio_irq_handler(struct irq_desc *desc)
chained_irq_exit(chip, desc); chained_irq_exit(chip, desc);
} }
static const struct regmap_config mvebu_gpio_regmap_config = {
.reg_bits = 32,
.reg_stride = 4,
.val_bits = 32,
.fast_io = true,
};
/* /*
* Functions implementing the pwm_chip methods * Functions implementing the pwm_chip methods
*/ */
@ -659,9 +666,8 @@ static void mvebu_pwm_get_state(struct pwm_chip *chip,
spin_lock_irqsave(&mvpwm->lock, flags); spin_lock_irqsave(&mvpwm->lock, flags);
val = (unsigned long long) regmap_read(mvpwm->regs, mvebu_pwmreg_blink_on_duration(mvpwm), &u);
readl_relaxed(mvebu_pwmreg_blink_on_duration(mvpwm)); val = (unsigned long long) u * NSEC_PER_SEC;
val *= NSEC_PER_SEC;
do_div(val, mvpwm->clk_rate); do_div(val, mvpwm->clk_rate);
if (val > UINT_MAX) if (val > UINT_MAX)
state->duty_cycle = UINT_MAX; state->duty_cycle = UINT_MAX;
@ -670,9 +676,8 @@ static void mvebu_pwm_get_state(struct pwm_chip *chip,
else else
state->duty_cycle = 1; state->duty_cycle = 1;
val = (unsigned long long) regmap_read(mvpwm->regs, mvebu_pwmreg_blink_off_duration(mvpwm), &u);
readl_relaxed(mvebu_pwmreg_blink_off_duration(mvpwm)); val = (unsigned long long) u * NSEC_PER_SEC;
val *= NSEC_PER_SEC;
do_div(val, mvpwm->clk_rate); do_div(val, mvpwm->clk_rate);
if (val < state->duty_cycle) { if (val < state->duty_cycle) {
state->period = 1; state->period = 1;
@ -725,8 +730,8 @@ static int mvebu_pwm_apply(struct pwm_chip *chip, struct pwm_device *pwm,
spin_lock_irqsave(&mvpwm->lock, flags); spin_lock_irqsave(&mvpwm->lock, flags);
writel_relaxed(on, mvebu_pwmreg_blink_on_duration(mvpwm)); regmap_write(mvpwm->regs, mvebu_pwmreg_blink_on_duration(mvpwm), on);
writel_relaxed(off, mvebu_pwmreg_blink_off_duration(mvpwm)); regmap_write(mvpwm->regs, mvebu_pwmreg_blink_off_duration(mvpwm), off);
if (state->enabled) if (state->enabled)
mvebu_gpio_blink(&mvchip->chip, pwm->hwpwm, 1); mvebu_gpio_blink(&mvchip->chip, pwm->hwpwm, 1);
else else
@ -751,10 +756,10 @@ static void __maybe_unused mvebu_pwm_suspend(struct mvebu_gpio_chip *mvchip)
regmap_read(mvchip->regs, GPIO_BLINK_CNT_SELECT_OFF + mvchip->offset, regmap_read(mvchip->regs, GPIO_BLINK_CNT_SELECT_OFF + mvchip->offset,
&mvpwm->blink_select); &mvpwm->blink_select);
mvpwm->blink_on_duration = regmap_read(mvpwm->regs, mvebu_pwmreg_blink_on_duration(mvpwm),
readl_relaxed(mvebu_pwmreg_blink_on_duration(mvpwm)); &mvpwm->blink_on_duration);
mvpwm->blink_off_duration = regmap_read(mvpwm->regs, mvebu_pwmreg_blink_off_duration(mvpwm),
readl_relaxed(mvebu_pwmreg_blink_off_duration(mvpwm)); &mvpwm->blink_off_duration);
} }
static void __maybe_unused mvebu_pwm_resume(struct mvebu_gpio_chip *mvchip) static void __maybe_unused mvebu_pwm_resume(struct mvebu_gpio_chip *mvchip)
@ -763,10 +768,10 @@ static void __maybe_unused mvebu_pwm_resume(struct mvebu_gpio_chip *mvchip)
regmap_write(mvchip->regs, GPIO_BLINK_CNT_SELECT_OFF + mvchip->offset, regmap_write(mvchip->regs, GPIO_BLINK_CNT_SELECT_OFF + mvchip->offset,
mvpwm->blink_select); mvpwm->blink_select);
writel_relaxed(mvpwm->blink_on_duration, regmap_write(mvpwm->regs, mvebu_pwmreg_blink_on_duration(mvpwm),
mvebu_pwmreg_blink_on_duration(mvpwm)); mvpwm->blink_on_duration);
writel_relaxed(mvpwm->blink_off_duration, regmap_write(mvpwm->regs, mvebu_pwmreg_blink_off_duration(mvpwm),
mvebu_pwmreg_blink_off_duration(mvpwm)); mvpwm->blink_off_duration);
} }
static int mvebu_pwm_probe(struct platform_device *pdev, static int mvebu_pwm_probe(struct platform_device *pdev,
@ -775,6 +780,7 @@ static int mvebu_pwm_probe(struct platform_device *pdev,
{ {
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
struct mvebu_pwm *mvpwm; struct mvebu_pwm *mvpwm;
void __iomem *base;
u32 set; u32 set;
if (!of_device_is_compatible(mvchip->chip.of_node, if (!of_device_is_compatible(mvchip->chip.of_node,
@ -812,9 +818,14 @@ static int mvebu_pwm_probe(struct platform_device *pdev,
mvchip->mvpwm = mvpwm; mvchip->mvpwm = mvpwm;
mvpwm->mvchip = mvchip; mvpwm->mvchip = mvchip;
mvpwm->membase = devm_platform_ioremap_resource_byname(pdev, "pwm"); base = devm_platform_ioremap_resource_byname(pdev, "pwm");
if (IS_ERR(mvpwm->membase)) if (IS_ERR(base))
return PTR_ERR(mvpwm->membase); return PTR_ERR(base);
mvpwm->regs = devm_regmap_init_mmio(&pdev->dev, base,
&mvebu_gpio_regmap_config);
if (IS_ERR(mvpwm->regs))
return PTR_ERR(mvpwm->regs);
mvpwm->clk_rate = clk_get_rate(mvchip->clk); mvpwm->clk_rate = clk_get_rate(mvchip->clk);
if (!mvpwm->clk_rate) { if (!mvpwm->clk_rate) {
@ -1021,13 +1032,6 @@ static int mvebu_gpio_resume(struct platform_device *pdev)
return 0; return 0;
} }
static const struct regmap_config mvebu_gpio_regmap_config = {
.reg_bits = 32,
.reg_stride = 4,
.val_bits = 32,
.fast_io = true,
};
static int mvebu_gpio_probe_raw(struct platform_device *pdev, static int mvebu_gpio_probe_raw(struct platform_device *pdev,
struct mvebu_gpio_chip *mvchip) struct mvebu_gpio_chip *mvchip)
{ {