Some GPIO based rfkill devices can wake their host up from suspend by
toggling an input (from the host perspective) GPIO.
This patch adds a generic support for that feature by registering a
threaded interrupt routine and thus setting the corresponding GPIO as a
wake up source.

Signed-off-by: Loic Poulain <loic.poul...@intel.com>
---
 net/rfkill/rfkill-gpio.c | 49 ++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 49 insertions(+)

diff --git a/net/rfkill/rfkill-gpio.c b/net/rfkill/rfkill-gpio.c
index 29369d6..2f6aad1 100644
--- a/net/rfkill/rfkill-gpio.c
+++ b/net/rfkill/rfkill-gpio.c
@@ -26,6 +26,7 @@
 #include <linux/slab.h>
 #include <linux/acpi.h>
 #include <linux/gpio/consumer.h>
+#include <linux/interrupt.h>
 
 #include <linux/rfkill-gpio.h>
 
@@ -36,6 +37,8 @@ struct rfkill_gpio_data {
        struct gpio_desc        *shutdown_gpio;
        struct gpio_desc        *wake_gpio;
 
+       int                     host_wake_irq;
+
        struct rfkill           *rfkill_dev;
        struct clk              *clk;
 
@@ -48,6 +51,7 @@ struct rfkill_gpio_desc {
        int                     reset_idx;
        int                     shutdown_idx;
        int                     wake_idx;
+       int                     host_wake_idx;
 };
 
 static int rfkill_gpio_set_power(void *data, bool blocked)
@@ -73,6 +77,15 @@ static const struct rfkill_ops rfkill_gpio_ops = {
        .set_block = rfkill_gpio_set_power,
 };
 
+static irqreturn_t rfkill_gpio_host_wake(int irq, void *dev)
+{
+       struct rfkill_gpio_data *rfkill = dev;
+
+       pr_info("Host wake IRQ for %s\n", rfkill->name);
+
+       return IRQ_HANDLED;
+}
+
 static int rfkill_gpio_init(struct device *dev, struct rfkill_gpio_desc *desc)
 {
        int ret;
@@ -125,6 +138,34 @@ static int rfkill_gpio_init(struct device *dev, struct 
rfkill_gpio_desc *desc)
                }
        }
 
+       rfkill->host_wake_irq = -1;
+
+       if (desc && (desc->host_wake_idx >= 0)) {
+               gpio = devm_gpiod_get_index(dev, "host_wake",
+                                           desc->host_wake_idx);
+               if (!IS_ERR(gpio)) {
+                       int irqf = IRQF_TRIGGER_RISING | IRQF_NO_SUSPEND |
+                                  IRQF_ONESHOT;
+
+                       ret = gpiod_direction_input(gpio);
+                       if (ret)
+                               return ret;
+
+                       rfkill->host_wake_irq = gpiod_to_irq(gpio);
+                       ret = devm_request_threaded_irq(dev,
+                                                       rfkill->host_wake_irq,
+                                                       NULL,
+                                                       rfkill_gpio_host_wake,
+                                                       irqf, "host_wake",
+                                                       rfkill);
+                       if (ret)
+                               return ret;
+
+                       /* Wakeup IRQ, only used in suspend */
+                       disable_irq(rfkill->host_wake_irq);
+               }
+       }
+
        /* Make sure at-least one of the GPIO is defined */
        if (!rfkill->reset_gpio && !rfkill->shutdown_gpio) {
                dev_err(dev, "invalid platform data\n");
@@ -205,6 +246,9 @@ static int rfkill_gpio_suspend(struct device *dev)
        if (!rfkill->clk_enabled)
                return 0;
 
+       if (rfkill->host_wake_irq >= 0)
+               enable_irq(rfkill->host_wake_irq);
+
        gpiod_set_value_cansleep(rfkill->wake_gpio, 0);
 
        return 0;
@@ -219,6 +263,9 @@ static int rfkill_gpio_resume(struct device *dev)
        if (!rfkill->clk_enabled)
                return 0;
 
+       if (rfkill->host_wake_irq >= 0)
+               disable_irq(rfkill->host_wake_irq);
+
        gpiod_set_value_cansleep(rfkill->wake_gpio, 1);
 
        return 0;
@@ -243,6 +290,7 @@ static struct rfkill_gpio_desc acpi_default_bluetooth = {
        .reset_idx = 0,
        .shutdown_idx = 1,
        .wake_idx = -1,
+       .host_wake_idx = -1,
 };
 
 static struct rfkill_gpio_desc acpi_default_gps = {
@@ -250,6 +298,7 @@ static struct rfkill_gpio_desc acpi_default_gps = {
        .reset_idx = 0,
        .shutdown_idx = 1,
        .wake_idx = -1,
+       .host_wake_idx = -1,
 };
 
 static const struct acpi_device_id rfkill_acpi_match[] = {
-- 
1.8.3.2

--
To unsubscribe from this list: send the line "unsubscribe linux-wireless" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to