From 9a31a4765473ff23adaff5bf72b06f87a70b6fb2 Mon Sep 17 00:00:00 2001 From: Enrico Scholz Date: Wed, 3 Aug 2016 16:14:54 +0200 Subject: mfd: da9063: add device specific init function Provide some more information about the used PMIC type; later patches will add support for DA9062 which needs a custom init function. Signed-off-by: Enrico Scholz Tested-by: Stefan Christ Signed-off-by: Christian Hemp --- drivers/mfd/da9063.c | 17 ++++++++++++++++- 1 file changed, 16 insertions(+), 1 deletion(-) diff --git a/drivers/mfd/da9063.c b/drivers/mfd/da9063.c index 4f09bd384e..a1c748610a 100644 --- a/drivers/mfd/da9063.c +++ b/drivers/mfd/da9063.c @@ -52,6 +52,10 @@ struct da9063 { #define DA9063_WATCHDOG 0x01 #define DA9063_SHUTDOWN 0x02 +struct da906x_device_data { + int (*init)(struct da9063 *priv); +}; + static int da906x_reg_update(struct da9063 *priv, unsigned int reg, uint8_t mask, uint8_t val) { @@ -182,8 +186,13 @@ static void da9063_restart(struct restart_handler *rst) static int da9063_probe(struct device_d *dev) { struct da9063 *priv = NULL; + struct da906x_device_data const *dev_data; + void const *dev_data_tmp; int ret; + ret = dev_get_drvdata(dev, &dev_data_tmp); + dev_data = ret < 0 ? NULL : dev_data_tmp; + priv = xzalloc(sizeof(struct da9063)); priv->wd.priority = of_get_watchdog_priority(dev->device_node); priv->wd.set_timeout = da9063_watchdog_set_timeout; @@ -192,6 +201,12 @@ static int da9063_probe(struct device_d *dev) priv->client = to_i2c_client(dev); priv->dev = dev; + if (dev_data && dev_data->init) { + ret = dev_data->init(priv); + if (ret < 0) + goto on_error; + } + ret = watchdog_register(&priv->wd); if (ret) goto on_error; @@ -213,7 +228,7 @@ on_error: } static struct platform_device_id da9063_id[] = { - { "da9063", }, + { "da9063", (uintptr_t)(NULL) }, { } }; -- cgit v1.2.3