Commit ea31c0cf authored by Boris Brezillon's avatar Boris Brezillon Committed by Lee Jones

mfd: atmel-hlcdc: Implement config synchronization

Some HLCDC registers cannot be written until the hardware has finished
applying the previous configuration request. If they are written while
an action is still in progress, the new configuration might be silently
ignored, resulting in unpredictable behavior.

Hide the config synchronization stuff in a regmap implementation and use
this implementation instead of the generic mmio one.
Signed-off-by: default avatarBoris Brezillon <boris.brezillon@free-electrons.com>
Acked-by: default avatarNicolas Ferre <nicolas.ferre@atmel.com>
Signed-off-by: default avatarLee Jones <lee.jones@linaro.org>
parent 3811405e
...@@ -18,6 +18,7 @@ ...@@ -18,6 +18,7 @@
*/ */
#include <linux/clk.h> #include <linux/clk.h>
#include <linux/iopoll.h>
#include <linux/mfd/atmel-hlcdc.h> #include <linux/mfd/atmel-hlcdc.h>
#include <linux/mfd/core.h> #include <linux/mfd/core.h>
#include <linux/module.h> #include <linux/module.h>
...@@ -26,6 +27,10 @@ ...@@ -26,6 +27,10 @@
#define ATMEL_HLCDC_REG_MAX (0x4000 - 0x4) #define ATMEL_HLCDC_REG_MAX (0x4000 - 0x4)
struct atmel_hlcdc_regmap {
void __iomem *regs;
};
static const struct mfd_cell atmel_hlcdc_cells[] = { static const struct mfd_cell atmel_hlcdc_cells[] = {
{ {
.name = "atmel-hlcdc-pwm", .name = "atmel-hlcdc-pwm",
...@@ -37,28 +42,62 @@ static const struct mfd_cell atmel_hlcdc_cells[] = { ...@@ -37,28 +42,62 @@ static const struct mfd_cell atmel_hlcdc_cells[] = {
}, },
}; };
static int regmap_atmel_hlcdc_reg_write(void *context, unsigned int reg,
unsigned int val)
{
struct atmel_hlcdc_regmap *hregmap = context;
if (reg <= ATMEL_HLCDC_DIS) {
u32 status;
readl_poll_timeout(hregmap->regs + ATMEL_HLCDC_SR, status,
!(status & ATMEL_HLCDC_SIP), 1, 100);
}
writel(val, hregmap->regs + reg);
return 0;
}
static int regmap_atmel_hlcdc_reg_read(void *context, unsigned int reg,
unsigned int *val)
{
struct atmel_hlcdc_regmap *hregmap = context;
*val = readl(hregmap->regs + reg);
return 0;
}
static const struct regmap_config atmel_hlcdc_regmap_config = { static const struct regmap_config atmel_hlcdc_regmap_config = {
.reg_bits = 32, .reg_bits = 32,
.val_bits = 32, .val_bits = 32,
.reg_stride = 4, .reg_stride = 4,
.max_register = ATMEL_HLCDC_REG_MAX, .max_register = ATMEL_HLCDC_REG_MAX,
.reg_write = regmap_atmel_hlcdc_reg_write,
.reg_read = regmap_atmel_hlcdc_reg_read,
.fast_io = true,
}; };
static int atmel_hlcdc_probe(struct platform_device *pdev) static int atmel_hlcdc_probe(struct platform_device *pdev)
{ {
struct atmel_hlcdc_regmap *hregmap;
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
struct atmel_hlcdc *hlcdc; struct atmel_hlcdc *hlcdc;
struct resource *res; struct resource *res;
void __iomem *regs;
hregmap = devm_kzalloc(dev, sizeof(*hregmap), GFP_KERNEL);
if (!hregmap)
return -ENOMEM;
hlcdc = devm_kzalloc(dev, sizeof(*hlcdc), GFP_KERNEL); hlcdc = devm_kzalloc(dev, sizeof(*hlcdc), GFP_KERNEL);
if (!hlcdc) if (!hlcdc)
return -ENOMEM; return -ENOMEM;
res = platform_get_resource(pdev, IORESOURCE_MEM, 0); res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
regs = devm_ioremap_resource(dev, res); hregmap->regs = devm_ioremap_resource(dev, res);
if (IS_ERR(regs)) if (IS_ERR(hregmap->regs))
return PTR_ERR(regs); return PTR_ERR(hregmap->regs);
hlcdc->irq = platform_get_irq(pdev, 0); hlcdc->irq = platform_get_irq(pdev, 0);
if (hlcdc->irq < 0) if (hlcdc->irq < 0)
...@@ -82,7 +121,7 @@ static int atmel_hlcdc_probe(struct platform_device *pdev) ...@@ -82,7 +121,7 @@ static int atmel_hlcdc_probe(struct platform_device *pdev)
return PTR_ERR(hlcdc->slow_clk); return PTR_ERR(hlcdc->slow_clk);
} }
hlcdc->regmap = devm_regmap_init_mmio(dev, regs, hlcdc->regmap = devm_regmap_init(dev, NULL, hregmap,
&atmel_hlcdc_regmap_config); &atmel_hlcdc_regmap_config);
if (IS_ERR(hlcdc->regmap)) if (IS_ERR(hlcdc->regmap))
return PTR_ERR(hlcdc->regmap); return PTR_ERR(hlcdc->regmap);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment