diff mbox series

[2/2,SRU,OEM-5.14] UBUNTU: SAUCE: pinctrl: amd: Handle wake-up interrupt

Message ID 20210909222853.1499951-3-alex.hung@canonical.com
State New
Headers show
Series UBUNTU: SAUCE: Fix AMD GPIO based power button | expand

Commit Message

Alex Hung Sept. 9, 2021, 10:28 p.m. UTC 
From: Basavaraj Natikar <Basavaraj.Natikar@amd.com>

Enable/disable power management wakeup mode, which is disabled by
default. enable_irq_wake enables wakes the system from sleep.

Hence added enable/disable irq_wake to handle wake-up interrupt.

BugLink: https://bugs.launchpad.net/bugs/1943185

Signed-off-by: Basavaraj Natikar <Basavaraj.Natikar@amd.com>
(cherry picked from https://patchwork.ozlabs.org/project/linux-gpio/patch/20210831120613.1514899-3-Basavaraj.Natikar@amd.com/)
Signed-off-by: Alex Hung <alex.hung@canonical.com>
---
 drivers/pinctrl/pinctrl-amd.c | 10 ++++++++++
 1 file changed, 10 insertions(+)
diff mbox series

Patch

diff --git a/drivers/pinctrl/pinctrl-amd.c b/drivers/pinctrl/pinctrl-amd.c
index 79b8b7f9..d19974a 100644
--- a/drivers/pinctrl/pinctrl-amd.c
+++ b/drivers/pinctrl/pinctrl-amd.c
@@ -445,6 +445,7 @@  static int amd_gpio_irq_set_wake(struct irq_data *d, unsigned int on)
 	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
 	struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
 	u32 wake_mask = BIT(WAKE_CNTRL_OFF_S0I3) | BIT(WAKE_CNTRL_OFF_S3);
+	int err;
 
 	raw_spin_lock_irqsave(&gpio_dev->lock, flags);
 	pin_reg = readl(gpio_dev->base + (d->hwirq)*4);
@@ -457,6 +458,15 @@  static int amd_gpio_irq_set_wake(struct irq_data *d, unsigned int on)
 	writel(pin_reg, gpio_dev->base + (d->hwirq)*4);
 	raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
 
+	if (on)
+		err = enable_irq_wake(gpio_dev->irq);
+	else
+		err = disable_irq_wake(gpio_dev->irq);
+
+	if (err)
+		dev_err(&gpio_dev->pdev->dev, "failed to %s wake-up interrupt\n",
+			on ? "enable" : "disable");
+
 	return 0;
 }