9
0
Fork 0

gpio: omap: Add devicetree probe support

This adds devicetree probe support for the OMAP gpio ports and
also makes sure the corresponding platform_devices don't get
registered when they are already present from devicetree.

Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
This commit is contained in:
Sascha Hauer 2013-11-21 11:19:36 +01:00
parent 5c8ea4ff9a
commit 15d60e5230
1 changed files with 38 additions and 1 deletions

View File

@ -48,6 +48,18 @@ struct omap_gpio_chip {
struct gpio_chip chip;
};
struct omap_gpio_drvdata {
unsigned int regofs;
};
static struct omap_gpio_drvdata gpio_omap3_drvdata = {
.regofs = 0x0,
};
static struct omap_gpio_drvdata gpio_omap4_drvdata = {
.regofs = 0x100,
};
static inline int omap_get_gpio_index(int gpio)
{
return gpio & 0x1f;
@ -129,11 +141,24 @@ static struct gpio_ops omap_gpio_ops = {
static int omap_gpio_probe(struct device_d *dev)
{
struct omap_gpio_chip *omapgpio;
struct omap_gpio_drvdata *drvdata = NULL;
dev_get_drvdata(dev, (unsigned long *)&drvdata);
omapgpio = xzalloc(sizeof(*omapgpio));
omapgpio->base = dev_request_mem_region(dev, 0);
if (drvdata)
omapgpio->base += drvdata->regofs;
omapgpio->chip.ops = &omap_gpio_ops;
omapgpio->chip.base = dev->id * 32;
if (dev->id < 0) {
omapgpio->chip.base = of_alias_get_id(dev->device_node, "gpio");
if (omapgpio->chip.base < 0)
return omapgpio->chip.base;
omapgpio->chip.base *= 32;
} else {
omapgpio->chip.base = dev->id * 32;
}
omapgpio->chip.ngpio = 32;
omapgpio->chip.dev = dev;
gpiochip_add(&omapgpio->chip);
@ -144,9 +169,21 @@ static int omap_gpio_probe(struct device_d *dev)
return 0;
}
static __maybe_unused struct of_device_id omap_gpio_dt_ids[] = {
{
.compatible = "ti,omap4-gpio",
.data = (unsigned long)&gpio_omap4_drvdata,
}, {
.compatible = "ti,omap3-gpio",
.data = (unsigned long)&gpio_omap3_drvdata,
}, {
}
};
static struct driver_d omap_gpio_driver = {
.name = "omap-gpio",
.probe = omap_gpio_probe,
.of_compatible = DRV_OF_COMPAT(omap_gpio_dt_ids),
};
static int omap_gpio_add(void)