88ccabbd20
commit a75bfc824a
upstream.
When changing to use suspend-to-idle to save power, the PMIC irq can not
wakeup the system due to lack of wakeup capability, which will cause
the sub-irqs (such as power key) of the PMIC can not wake up the system.
Thus we can add the wakeup capability for PMIC irq to solve this issue,
as well as removing the IRQF_NO_SUSPEND flag to allow PMIC irq to be
a wakeup source.
Reported-by: Chunyan Zhang <zhang.lyra@gmail.com>
Signed-off-by: Baolin Wang <baolin.wang7@gmail.com>
Tested-by: Chunyan Zhang <chunyan.zhang@unisoc.com>
Signed-off-by: Lee Jones <lee.jones@linaro.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
282 lines
6.7 KiB
C
282 lines
6.7 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Copyright (C) 2017 Spreadtrum Communications Inc.
|
|
*/
|
|
|
|
#include <linux/interrupt.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/mfd/core.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/spi/spi.h>
|
|
|
|
#define SPRD_PMIC_INT_MASK_STATUS 0x0
|
|
#define SPRD_PMIC_INT_RAW_STATUS 0x4
|
|
#define SPRD_PMIC_INT_EN 0x8
|
|
|
|
#define SPRD_SC2731_IRQ_BASE 0x140
|
|
#define SPRD_SC2731_IRQ_NUMS 16
|
|
|
|
struct sprd_pmic {
|
|
struct regmap *regmap;
|
|
struct device *dev;
|
|
struct regmap_irq *irqs;
|
|
struct regmap_irq_chip irq_chip;
|
|
struct regmap_irq_chip_data *irq_data;
|
|
int irq;
|
|
};
|
|
|
|
struct sprd_pmic_data {
|
|
u32 irq_base;
|
|
u32 num_irqs;
|
|
};
|
|
|
|
/*
|
|
* Since different PMICs of SC27xx series can have different interrupt
|
|
* base address and irq number, we should save irq number and irq base
|
|
* in the device data structure.
|
|
*/
|
|
static const struct sprd_pmic_data sc2731_data = {
|
|
.irq_base = SPRD_SC2731_IRQ_BASE,
|
|
.num_irqs = SPRD_SC2731_IRQ_NUMS,
|
|
};
|
|
|
|
static const struct mfd_cell sprd_pmic_devs[] = {
|
|
{
|
|
.name = "sc27xx-wdt",
|
|
.of_compatible = "sprd,sc2731-wdt",
|
|
}, {
|
|
.name = "sc27xx-rtc",
|
|
.of_compatible = "sprd,sc2731-rtc",
|
|
}, {
|
|
.name = "sc27xx-charger",
|
|
.of_compatible = "sprd,sc2731-charger",
|
|
}, {
|
|
.name = "sc27xx-chg-timer",
|
|
.of_compatible = "sprd,sc2731-chg-timer",
|
|
}, {
|
|
.name = "sc27xx-fast-chg",
|
|
.of_compatible = "sprd,sc2731-fast-chg",
|
|
}, {
|
|
.name = "sc27xx-chg-wdt",
|
|
.of_compatible = "sprd,sc2731-chg-wdt",
|
|
}, {
|
|
.name = "sc27xx-typec",
|
|
.of_compatible = "sprd,sc2731-typec",
|
|
}, {
|
|
.name = "sc27xx-flash",
|
|
.of_compatible = "sprd,sc2731-flash",
|
|
}, {
|
|
.name = "sc27xx-eic",
|
|
.of_compatible = "sprd,sc2731-eic",
|
|
}, {
|
|
.name = "sc27xx-efuse",
|
|
.of_compatible = "sprd,sc2731-efuse",
|
|
}, {
|
|
.name = "sc27xx-thermal",
|
|
.of_compatible = "sprd,sc2731-thermal",
|
|
}, {
|
|
.name = "sc27xx-adc",
|
|
.of_compatible = "sprd,sc2731-adc",
|
|
}, {
|
|
.name = "sc27xx-audio-codec",
|
|
.of_compatible = "sprd,sc2731-audio-codec",
|
|
}, {
|
|
.name = "sc27xx-regulator",
|
|
.of_compatible = "sprd,sc2731-regulator",
|
|
}, {
|
|
.name = "sc27xx-vibrator",
|
|
.of_compatible = "sprd,sc2731-vibrator",
|
|
}, {
|
|
.name = "sc27xx-keypad-led",
|
|
.of_compatible = "sprd,sc2731-keypad-led",
|
|
}, {
|
|
.name = "sc27xx-bltc",
|
|
.of_compatible = "sprd,sc2731-bltc",
|
|
}, {
|
|
.name = "sc27xx-fgu",
|
|
.of_compatible = "sprd,sc2731-fgu",
|
|
}, {
|
|
.name = "sc27xx-7sreset",
|
|
.of_compatible = "sprd,sc2731-7sreset",
|
|
}, {
|
|
.name = "sc27xx-poweroff",
|
|
.of_compatible = "sprd,sc2731-poweroff",
|
|
}, {
|
|
.name = "sc27xx-syscon",
|
|
.of_compatible = "sprd,sc2731-syscon",
|
|
},
|
|
};
|
|
|
|
static int sprd_pmic_spi_write(void *context, const void *data, size_t count)
|
|
{
|
|
struct device *dev = context;
|
|
struct spi_device *spi = to_spi_device(dev);
|
|
|
|
return spi_write(spi, data, count);
|
|
}
|
|
|
|
static int sprd_pmic_spi_read(void *context,
|
|
const void *reg, size_t reg_size,
|
|
void *val, size_t val_size)
|
|
{
|
|
struct device *dev = context;
|
|
struct spi_device *spi = to_spi_device(dev);
|
|
u32 rx_buf[2] = { 0 };
|
|
int ret;
|
|
|
|
/* Now we only support one PMIC register to read every time. */
|
|
if (reg_size != sizeof(u32) || val_size != sizeof(u32))
|
|
return -EINVAL;
|
|
|
|
/* Copy address to read from into first element of SPI buffer. */
|
|
memcpy(rx_buf, reg, sizeof(u32));
|
|
ret = spi_read(spi, rx_buf, 1);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
memcpy(val, rx_buf, val_size);
|
|
return 0;
|
|
}
|
|
|
|
static struct regmap_bus sprd_pmic_regmap = {
|
|
.write = sprd_pmic_spi_write,
|
|
.read = sprd_pmic_spi_read,
|
|
.reg_format_endian_default = REGMAP_ENDIAN_NATIVE,
|
|
.val_format_endian_default = REGMAP_ENDIAN_NATIVE,
|
|
};
|
|
|
|
static const struct regmap_config sprd_pmic_config = {
|
|
.reg_bits = 32,
|
|
.val_bits = 32,
|
|
.reg_stride = 4,
|
|
.max_register = 0xffff,
|
|
};
|
|
|
|
static int sprd_pmic_probe(struct spi_device *spi)
|
|
{
|
|
struct sprd_pmic *ddata;
|
|
const struct sprd_pmic_data *pdata;
|
|
int ret, i;
|
|
|
|
pdata = of_device_get_match_data(&spi->dev);
|
|
if (!pdata) {
|
|
dev_err(&spi->dev, "No matching driver data found\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ddata = devm_kzalloc(&spi->dev, sizeof(*ddata), GFP_KERNEL);
|
|
if (!ddata)
|
|
return -ENOMEM;
|
|
|
|
ddata->regmap = devm_regmap_init(&spi->dev, &sprd_pmic_regmap,
|
|
&spi->dev, &sprd_pmic_config);
|
|
if (IS_ERR(ddata->regmap)) {
|
|
ret = PTR_ERR(ddata->regmap);
|
|
dev_err(&spi->dev, "Failed to allocate register map %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
spi_set_drvdata(spi, ddata);
|
|
ddata->dev = &spi->dev;
|
|
ddata->irq = spi->irq;
|
|
|
|
ddata->irq_chip.name = dev_name(&spi->dev);
|
|
ddata->irq_chip.status_base =
|
|
pdata->irq_base + SPRD_PMIC_INT_MASK_STATUS;
|
|
ddata->irq_chip.mask_base = pdata->irq_base + SPRD_PMIC_INT_EN;
|
|
ddata->irq_chip.ack_base = 0;
|
|
ddata->irq_chip.num_regs = 1;
|
|
ddata->irq_chip.num_irqs = pdata->num_irqs;
|
|
ddata->irq_chip.mask_invert = true;
|
|
|
|
ddata->irqs = devm_kcalloc(&spi->dev,
|
|
pdata->num_irqs, sizeof(struct regmap_irq),
|
|
GFP_KERNEL);
|
|
if (!ddata->irqs)
|
|
return -ENOMEM;
|
|
|
|
ddata->irq_chip.irqs = ddata->irqs;
|
|
for (i = 0; i < pdata->num_irqs; i++) {
|
|
ddata->irqs[i].reg_offset = i / pdata->num_irqs;
|
|
ddata->irqs[i].mask = BIT(i % pdata->num_irqs);
|
|
}
|
|
|
|
ret = devm_regmap_add_irq_chip(&spi->dev, ddata->regmap, ddata->irq,
|
|
IRQF_ONESHOT, 0,
|
|
&ddata->irq_chip, &ddata->irq_data);
|
|
if (ret) {
|
|
dev_err(&spi->dev, "Failed to add PMIC irq chip %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = devm_mfd_add_devices(&spi->dev, PLATFORM_DEVID_AUTO,
|
|
sprd_pmic_devs, ARRAY_SIZE(sprd_pmic_devs),
|
|
NULL, 0,
|
|
regmap_irq_get_domain(ddata->irq_data));
|
|
if (ret) {
|
|
dev_err(&spi->dev, "Failed to register device %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
device_init_wakeup(&spi->dev, true);
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM_SLEEP
|
|
static int sprd_pmic_suspend(struct device *dev)
|
|
{
|
|
struct sprd_pmic *ddata = dev_get_drvdata(dev);
|
|
|
|
if (device_may_wakeup(dev))
|
|
enable_irq_wake(ddata->irq);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sprd_pmic_resume(struct device *dev)
|
|
{
|
|
struct sprd_pmic *ddata = dev_get_drvdata(dev);
|
|
|
|
if (device_may_wakeup(dev))
|
|
disable_irq_wake(ddata->irq);
|
|
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
static SIMPLE_DEV_PM_OPS(sprd_pmic_pm_ops, sprd_pmic_suspend, sprd_pmic_resume);
|
|
|
|
static const struct of_device_id sprd_pmic_match[] = {
|
|
{ .compatible = "sprd,sc2731", .data = &sc2731_data },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, sprd_pmic_match);
|
|
|
|
static struct spi_driver sprd_pmic_driver = {
|
|
.driver = {
|
|
.name = "sc27xx-pmic",
|
|
.bus = &spi_bus_type,
|
|
.of_match_table = sprd_pmic_match,
|
|
.pm = &sprd_pmic_pm_ops,
|
|
},
|
|
.probe = sprd_pmic_probe,
|
|
};
|
|
|
|
static int __init sprd_pmic_init(void)
|
|
{
|
|
return spi_register_driver(&sprd_pmic_driver);
|
|
}
|
|
subsys_initcall(sprd_pmic_init);
|
|
|
|
static void __exit sprd_pmic_exit(void)
|
|
{
|
|
spi_unregister_driver(&sprd_pmic_driver);
|
|
}
|
|
module_exit(sprd_pmic_exit);
|
|
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_DESCRIPTION("Spreadtrum SC27xx PMICs driver");
|
|
MODULE_AUTHOR("Baolin Wang <baolin.wang@spreadtrum.com>");
|