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"); 130