mfd: max77686: Fix 'line over 80 chars' warning
[firefly-linux-kernel-4.4.55.git] / drivers / mfd / max77686.c
index ce869acf27aebea28dcee07465c3677727b72f43..f2bd699159878d95d76ed8fb79c9eff03fa00a4f 100644 (file)
@@ -25,6 +25,8 @@
 #include <linux/export.h>
 #include <linux/slab.h>
 #include <linux/i2c.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
 #include <linux/pm_runtime.h>
 #include <linux/module.h>
 #include <linux/mfd/core.h>
@@ -46,7 +48,54 @@ static struct regmap_config max77686_regmap_config = {
        .val_bits = 8,
 };
 
-#ifdef CONFIG_OF
+static struct regmap_config max77686_rtc_regmap_config = {
+       .reg_bits = 8,
+       .val_bits = 8,
+};
+
+static const struct regmap_irq max77686_irqs[] = {
+       /* INT1 interrupts */
+       { .reg_offset = 0, .mask = MAX77686_INT1_PWRONF_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_INT1_PWRONR_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_INT1_JIGONBF_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_INT1_JIGONBR_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_INT1_ACOKBF_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_INT1_ACOKBR_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_INT1_ONKEY1S_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_INT1_MRSTB_MSK, },
+       /* INT2 interrupts */
+       { .reg_offset = 1, .mask = MAX77686_INT2_140C_MSK, },
+       { .reg_offset = 1, .mask = MAX77686_INT2_120C_MSK, },
+};
+
+static const struct regmap_irq_chip max77686_irq_chip = {
+       .name                   = "max77686-pmic",
+       .status_base            = MAX77686_REG_INT1,
+       .mask_base              = MAX77686_REG_INT1MSK,
+       .num_regs               = 2,
+       .irqs                   = max77686_irqs,
+       .num_irqs               = ARRAY_SIZE(max77686_irqs),
+};
+
+static const struct regmap_irq max77686_rtc_irqs[] = {
+       /* RTC interrupts */
+       { .reg_offset = 0, .mask = MAX77686_RTCINT_RTC60S_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_RTCINT_RTCA1_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_RTCINT_RTCA2_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_RTCINT_SMPL_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_RTCINT_RTC1S_MSK, },
+       { .reg_offset = 0, .mask = MAX77686_RTCINT_WTSR_MSK, },
+};
+
+static const struct regmap_irq_chip max77686_rtc_irq_chip = {
+       .name                   = "max77686-rtc",
+       .status_base            = MAX77686_RTC_INT,
+       .mask_base              = MAX77686_RTC_INTM,
+       .num_regs               = 1,
+       .irqs                   = max77686_rtc_irqs,
+       .num_irqs               = ARRAY_SIZE(max77686_rtc_irqs),
+};
+
 static const struct of_device_id max77686_pmic_dt_match[] = {
        {.compatible = "maxim,max77686", .data = NULL},
        {},
@@ -58,21 +107,12 @@ static struct max77686_platform_data *max77686_i2c_parse_dt_pdata(struct device
        struct max77686_platform_data *pd;
 
        pd = devm_kzalloc(dev, sizeof(*pd), GFP_KERNEL);
-       if (!pd) {
-               dev_err(dev, "could not allocate memory for pdata\n");
+       if (!pd)
                return NULL;
-       }
 
        dev->platform_data = pd;
        return pd;
 }
-#else
-static struct max77686_platform_data *max77686_i2c_parse_dt_pdata(struct device
-                                                                 *dev)
-{
-       return 0;
-}
-#endif
 
 static int max77686_i2c_probe(struct i2c_client *i2c,
                              const struct i2c_device_id *id)
@@ -82,17 +122,17 @@ static int max77686_i2c_probe(struct i2c_client *i2c,
        unsigned int data;
        int ret = 0;
 
-       if (i2c->dev.of_node)
+       if (IS_ENABLED(CONFIG_OF) && i2c->dev.of_node && !pdata)
                pdata = max77686_i2c_parse_dt_pdata(&i2c->dev);
 
        if (!pdata) {
                dev_err(&i2c->dev, "No platform data found.\n");
-               return -EIO;
+               return -EINVAL;
        }
 
        max77686 = devm_kzalloc(&i2c->dev,
                                sizeof(struct max77686_dev), GFP_KERNEL);
-       if (max77686 == NULL)
+       if (!max77686)
                return -ENOMEM;
 
        i2c_set_clientdata(i2c, max77686);
@@ -101,7 +141,6 @@ static int max77686_i2c_probe(struct i2c_client *i2c,
        max77686->type = id->driver_data;
 
        max77686->wakeup = pdata->wakeup;
-       max77686->irq_gpio = pdata->irq_gpio;
        max77686->irq = i2c->irq;
 
        max77686->regmap = devm_regmap_init_i2c(i2c, &max77686_regmap_config);
@@ -112,13 +151,12 @@ static int max77686_i2c_probe(struct i2c_client *i2c,
                return ret;
        }
 
-       if (regmap_read(max77686->regmap,
-                        MAX77686_REG_DEVICE_ID, &data) < 0) {
+       ret = regmap_read(max77686->regmap, MAX77686_REG_DEVICE_ID, &data);
+       if (ret < 0) {
                dev_err(max77686->dev,
                        "device not found on this channel (this is not an error)\n");
                return -ENODEV;
-       } else
-               dev_info(max77686->dev, "device found\n");
+       }
 
        max77686->rtc = i2c_new_dummy(i2c->adapter, I2C_ADDR_RTC);
        if (!max77686->rtc) {
@@ -127,15 +165,48 @@ static int max77686_i2c_probe(struct i2c_client *i2c,
        }
        i2c_set_clientdata(max77686->rtc, max77686);
 
-       max77686_irq_init(max77686);
+       max77686->rtc_regmap = devm_regmap_init_i2c(max77686->rtc,
+                                               &max77686_rtc_regmap_config);
+       if (IS_ERR(max77686->rtc_regmap)) {
+               ret = PTR_ERR(max77686->rtc_regmap);
+               dev_err(max77686->dev, "failed to allocate RTC regmap: %d\n",
+                       ret);
+               goto err_unregister_i2c;
+       }
+
+       ret = regmap_add_irq_chip(max77686->regmap, max77686->irq,
+                                 IRQF_TRIGGER_FALLING | IRQF_ONESHOT |
+                                 IRQF_SHARED, 0, &max77686_irq_chip,
+                                 &max77686->irq_data);
+       if (ret) {
+               dev_err(&i2c->dev, "failed to add PMIC irq chip: %d\n", ret);
+               goto err_unregister_i2c;
+       }
+       ret = regmap_add_irq_chip(max77686->rtc_regmap, max77686->irq,
+                                 IRQF_TRIGGER_FALLING | IRQF_ONESHOT |
+                                 IRQF_SHARED, 0, &max77686_rtc_irq_chip,
+                                 &max77686->rtc_irq_data);
+       if (ret) {
+               dev_err(&i2c->dev, "failed to add RTC irq chip: %d\n", ret);
+               goto err_del_irqc;
+       }
 
        ret = mfd_add_devices(max77686->dev, -1, max77686_devs,
                              ARRAY_SIZE(max77686_devs), NULL, 0, NULL);
        if (ret < 0) {
-               mfd_remove_devices(max77686->dev);
-               i2c_unregister_device(max77686->rtc);
+               dev_err(&i2c->dev, "failed to add MFD devices: %d\n", ret);
+               goto err_del_rtc_irqc;
        }
 
+       return 0;
+
+err_del_rtc_irqc:
+       regmap_del_irq_chip(max77686->irq, max77686->rtc_irq_data);
+err_del_irqc:
+       regmap_del_irq_chip(max77686->irq, max77686->irq_data);
+err_unregister_i2c:
+       i2c_unregister_device(max77686->rtc);
+
        return ret;
 }
 
@@ -144,6 +215,10 @@ static int max77686_i2c_remove(struct i2c_client *i2c)
        struct max77686_dev *max77686 = i2c_get_clientdata(i2c);
 
        mfd_remove_devices(max77686->dev);
+
+       regmap_del_irq_chip(max77686->irq, max77686->rtc_irq_data);
+       regmap_del_irq_chip(max77686->irq, max77686->irq_data);
+
        i2c_unregister_device(max77686->rtc);
 
        return 0;
@@ -155,10 +230,50 @@ static const struct i2c_device_id max77686_i2c_id[] = {
 };
 MODULE_DEVICE_TABLE(i2c, max77686_i2c_id);
 
+#ifdef CONFIG_PM_SLEEP
+static int max77686_suspend(struct device *dev)
+{
+       struct i2c_client *i2c = container_of(dev, struct i2c_client, dev);
+       struct max77686_dev *max77686 = i2c_get_clientdata(i2c);
+
+       if (device_may_wakeup(dev))
+               enable_irq_wake(max77686->irq);
+
+       /*
+        * IRQ must be disabled during suspend because if it happens
+        * while suspended it will be handled before resuming I2C.
+        *
+        * When device is woken up from suspend (e.g. by RTC wake alarm),
+        * an interrupt occurs before resuming I2C bus controller.
+        * Interrupt handler tries to read registers but this read
+        * will fail because I2C is still suspended.
+        */
+       disable_irq(max77686->irq);
+
+       return 0;
+}
+
+static int max77686_resume(struct device *dev)
+{
+       struct i2c_client *i2c = container_of(dev, struct i2c_client, dev);
+       struct max77686_dev *max77686 = i2c_get_clientdata(i2c);
+
+       if (device_may_wakeup(dev))
+               disable_irq_wake(max77686->irq);
+
+       enable_irq(max77686->irq);
+
+       return 0;
+}
+#endif /* CONFIG_PM_SLEEP */
+
+static SIMPLE_DEV_PM_OPS(max77686_pm, max77686_suspend, max77686_resume);
+
 static struct i2c_driver max77686_i2c_driver = {
        .driver = {
                   .name = "max77686",
                   .owner = THIS_MODULE,
+                  .pm = &max77686_pm,
                   .of_match_table = of_match_ptr(max77686_pmic_dt_match),
        },
        .probe = max77686_i2c_probe,