drivers/misc/tps6594-esm.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * ESM (Error Signal Monitor) driver for TI TPS6594/TPS6593/LP8764 PMICs
   4  *
   5  * Copyright (C) 2023 BayLibre Incorporated - https://www.baylibre.com/
   6  */
   7
   8 #include <linux/interrupt.h>
   9 #include <linux/module.h>
  10 #include <linux/platform_device.h>
  11 #include <linux/pm_runtime.h>
  12 #include <linux/regmap.h>
  13
  14 #include <linux/mfd/tps6594.h>
  15
  16 static irqreturn_t tps6594_esm_isr(int irq, void *dev_id)
  17 {
  18         struct platform_device *pdev = dev_id;
  19         int i;
  20
  21         for (i = 0 ; i < pdev->num_resources ; i++) {
  22                 if (irq == platform_get_irq_byname(pdev, pdev->resource[i].name)) {
  23                         dev_err(pdev->dev.parent, "%s error detected\n", pdev->resource[i].name);
  24                         return IRQ_HANDLED;
  25                 }
  26         }
  27
  28         return IRQ_NONE;
  29 }
  30
  31 static int tps6594_esm_probe(struct platform_device *pdev)
  32 {
  33         struct tps6594 *tps = dev_get_drvdata(pdev->dev.parent);
  34         struct device *dev = &pdev->dev;
  35         int irq;
  36         int ret;
  37         int i;
  38
  39         for (i = 0 ; i < pdev->num_resources ; i++) {
  40                 irq = platform_get_irq_byname(pdev, pdev->resource[i].name);
  41                 if (irq < 0)
  42                         return irq;
  43
  44                 ret = devm_request_threaded_irq(dev, irq, NULL,
  45                                                 tps6594_esm_isr, IRQF_ONESHOT,
  46                                                 pdev->resource[i].name, pdev);
  47                 if (ret)
  48                         return dev_err_probe(dev, ret, "Failed to request irq\n");
  49         }
  50
  51         ret = regmap_set_bits(tps->regmap, TPS6594_REG_ESM_SOC_MODE_CFG,
  52                               TPS6594_BIT_ESM_SOC_EN | TPS6594_BIT_ESM_SOC_ENDRV);
  53         if (ret)
  54                 return dev_err_probe(dev, ret, "Failed to configure ESM\n");
  55
  56         ret = regmap_set_bits(tps->regmap, TPS6594_REG_ESM_SOC_START_REG,
  57                               TPS6594_BIT_ESM_SOC_START);
  58         if (ret)
  59                 return dev_err_probe(dev, ret, "Failed to start ESM\n");
  60
  61         pm_runtime_enable(dev);
  62         pm_runtime_get_sync(dev);
  63
  64         return 0;
  65 }
  66
  67 static void tps6594_esm_remove(struct platform_device *pdev)
  68 {
  69         struct tps6594 *tps = dev_get_drvdata(pdev->dev.parent);
  70         struct device *dev = &pdev->dev;
  71         int ret;
  72
  73         ret = regmap_clear_bits(tps->regmap, TPS6594_REG_ESM_SOC_START_REG,
  74                                 TPS6594_BIT_ESM_SOC_START);
  75         if (ret) {
  76                 dev_err(dev, "Failed to stop ESM\n");
  77                 goto out;
  78         }
  79
  80         ret = regmap_clear_bits(tps->regmap, TPS6594_REG_ESM_SOC_MODE_CFG,
  81                                 TPS6594_BIT_ESM_SOC_EN | TPS6594_BIT_ESM_SOC_ENDRV);
  82         if (ret)
  83                 dev_err(dev, "Failed to unconfigure ESM\n");
  84
  85 out:
  86         pm_runtime_put_sync(dev);
  87         pm_runtime_disable(dev);
  88 }
  89
  90 static int tps6594_esm_suspend(struct device *dev)
  91 {
  92         struct tps6594 *tps = dev_get_drvdata(dev->parent);
  93         int ret;
  94
  95         ret = regmap_clear_bits(tps->regmap, TPS6594_REG_ESM_SOC_START_REG,
  96                                 TPS6594_BIT_ESM_SOC_START);
  97
  98         pm_runtime_put_sync(dev);
  99
 100         return ret;
 101 }
 102
 103 static int tps6594_esm_resume(struct device *dev)
 104 {
 105         struct tps6594 *tps = dev_get_drvdata(dev->parent);
 106
 107         pm_runtime_get_sync(dev);
 108
 109         return regmap_set_bits(tps->regmap, TPS6594_REG_ESM_SOC_START_REG,
 110                                TPS6594_BIT_ESM_SOC_START);
 111 }
 112
 113 static DEFINE_SIMPLE_DEV_PM_OPS(tps6594_esm_pm_ops, tps6594_esm_suspend, tps6594_esm_resume);
 114
 115 static struct platform_driver tps6594_esm_driver = {
 116         .driver = {
 117                 .name = "tps6594-esm",
 118                 .pm = pm_sleep_ptr(&tps6594_esm_pm_ops),
 119         },
 120         .probe = tps6594_esm_probe,
 121         .remove_new = tps6594_esm_remove,
 122 };
 123
 124 module_platform_driver(tps6594_esm_driver);
 125
 126 MODULE_ALIAS("platform:tps6594-esm");
 127 MODULE_AUTHOR("Julien Panis <jpanis@baylibre.com>");
 128 MODULE_DESCRIPTION("TPS6594 Error Signal Monitor Driver");
 129 MODULE_LICENSE("GPL");