Commit e956a2a8 authored by Philipp Zabel's avatar Philipp Zabel Committed by Samuel Ortiz

mfd: asic3: add clock handling for MFD cells

Since ASIC3 has to work on both PXA and S3C and since their
struct clk implementations differ, we can't register out
clocks with the clkdev mechanism (yet?).
For now we have to keep clock handling internal to this
driver and enable/disable the clocks via the
mfd_cell->enable/disable functions.
Signed-off-by: default avatarPhilipp Zabel <philipp.zabel@gmail.com>
Signed-off-by: default avatarSamuel Ortiz <sameo@linux.intel.com>
parent 6483c1b5
...@@ -25,6 +25,48 @@ ...@@ -25,6 +25,48 @@
#include <linux/mfd/asic3.h> #include <linux/mfd/asic3.h>
enum {
ASIC3_CLOCK_SPI,
ASIC3_CLOCK_OWM,
ASIC3_CLOCK_PWM0,
ASIC3_CLOCK_PWM1,
ASIC3_CLOCK_LED0,
ASIC3_CLOCK_LED1,
ASIC3_CLOCK_LED2,
ASIC3_CLOCK_SD_HOST,
ASIC3_CLOCK_SD_BUS,
ASIC3_CLOCK_SMBUS,
ASIC3_CLOCK_EX0,
ASIC3_CLOCK_EX1,
};
struct asic3_clk {
int enabled;
unsigned int cdex;
unsigned long rate;
};
#define INIT_CDEX(_name, _rate) \
[ASIC3_CLOCK_##_name] = { \
.cdex = CLOCK_CDEX_##_name, \
.rate = _rate, \
}
struct asic3_clk asic3_clk_init[] __initdata = {
INIT_CDEX(SPI, 0),
INIT_CDEX(OWM, 5000000),
INIT_CDEX(PWM0, 0),
INIT_CDEX(PWM1, 0),
INIT_CDEX(LED0, 0),
INIT_CDEX(LED1, 0),
INIT_CDEX(LED2, 0),
INIT_CDEX(SD_HOST, 24576000),
INIT_CDEX(SD_BUS, 12288000),
INIT_CDEX(SMBUS, 0),
INIT_CDEX(EX0, 32768),
INIT_CDEX(EX1, 24576000),
};
struct asic3 { struct asic3 {
void __iomem *mapping; void __iomem *mapping;
unsigned int bus_shift; unsigned int bus_shift;
...@@ -34,6 +76,8 @@ struct asic3 { ...@@ -34,6 +76,8 @@ struct asic3 {
u16 irq_bothedge[4]; u16 irq_bothedge[4];
struct gpio_chip gpio; struct gpio_chip gpio;
struct device *dev; struct device *dev;
struct asic3_clk clocks[ARRAY_SIZE(asic3_clk_init)];
}; };
static int asic3_gpio_get(struct gpio_chip *chip, unsigned offset); static int asic3_gpio_get(struct gpio_chip *chip, unsigned offset);
...@@ -540,6 +584,37 @@ static int asic3_gpio_remove(struct platform_device *pdev) ...@@ -540,6 +584,37 @@ static int asic3_gpio_remove(struct platform_device *pdev)
return gpiochip_remove(&asic->gpio); return gpiochip_remove(&asic->gpio);
} }
static int asic3_clk_enable(struct asic3 *asic, struct asic3_clk *clk)
{
unsigned long flags;
u32 cdex;
spin_lock_irqsave(&asic->lock, flags);
if (clk->enabled++ == 0) {
cdex = asic3_read_register(asic, ASIC3_OFFSET(CLOCK, CDEX));
cdex |= clk->cdex;
asic3_write_register(asic, ASIC3_OFFSET(CLOCK, CDEX), cdex);
}
spin_unlock_irqrestore(&asic->lock, flags);
return 0;
}
static void asic3_clk_disable(struct asic3 *asic, struct asic3_clk *clk)
{
unsigned long flags;
u32 cdex;
WARN_ON(clk->enabled == 0);
spin_lock_irqsave(&asic->lock, flags);
if (--clk->enabled == 0) {
cdex = asic3_read_register(asic, ASIC3_OFFSET(CLOCK, CDEX));
cdex &= ~clk->cdex;
asic3_write_register(asic, ASIC3_OFFSET(CLOCK, CDEX), cdex);
}
spin_unlock_irqrestore(&asic->lock, flags);
}
/* Core */ /* Core */
static int __init asic3_probe(struct platform_device *pdev) static int __init asic3_probe(struct platform_device *pdev)
...@@ -605,6 +680,11 @@ static int __init asic3_probe(struct platform_device *pdev) ...@@ -605,6 +680,11 @@ static int __init asic3_probe(struct platform_device *pdev)
goto out_irq; goto out_irq;
} }
/* Making a per-device copy is only needed for the
* theoretical case of multiple ASIC3s on one board:
*/
memcpy(asic->clocks, asic3_clk_init, sizeof(asic3_clk_init));
dev_info(asic->dev, "ASIC3 Core driver\n"); dev_info(asic->dev, "ASIC3 Core driver\n");
return 0; return 0;
......
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