From: Xinming Hu <h...@marvell.com>

This patch implement a framework for board specific wakeup.
driver parse irq/gpio number from device tree, corresponding
resources will be allocated, and used for host suspend/resume.
driver private binding file is also updated in the patch.

Signed-off-by: Xinming Hu <h...@marvell.com>
Signed-off-by: Amitkumar Karwar <akar...@marvell.com>
---
v4: Replaced #ifdef with __maybe_unused(Arnd Bergmann)
---
 .../bindings/net/wireless/marvell-sd8xxx.txt       | 10 +++
 .../net/wireless/marvell/mwifiex/platform_drv.c    | 91 ++++++++++++++++++++++
 2 files changed, 101 insertions(+)

diff --git a/Documentation/devicetree/bindings/net/wireless/marvell-sd8xxx.txt 
b/Documentation/devicetree/bindings/net/wireless/marvell-sd8xxx.txt
index c337fab..50138fd 100644
--- a/Documentation/devicetree/bindings/net/wireless/marvell-sd8xxx.txt
+++ b/Documentation/devicetree/bindings/net/wireless/marvell-sd8xxx.txt
@@ -14,6 +14,11 @@ Optional properties:
   - marvell,wakeup-gpios : Chip's wakeup gpio pin number. This needs to be 
downloaded
                        to to firmware. Chip notifies wifi wakeup signal to SOC
                        through this pin.
+  - interrupt-parent: phandle of the parent interrupt controller
+  - interrupts : interrupt number to the cpu
+  - gpios: specify SOC's wakeup GPIO
+  - pinctrl-names : a pinctrl state named "default" must be defined
+  - pinctrl-0 : pin control group to be used for this controller
 
 Example:
 
@@ -27,5 +32,10 @@ wlan {
        marvell,caldata_00_txpwrlimit_2g_cfg_set = /bits/ 8 <
 0x01 0x00 0x06 0x00 0x08 0x02 0x89 0x01 ...>;
        marvell,wakeup-gpios = <3>;
+       interrupt-parent = <&pio>;
+       interrupts = <38 IRQ_TYPE_LEVEL_LOW>;
+       gpios = <&pio 38 GPIO_ACTIVE_HIGH>;
+       pinctrl-names = "default";
+       pinctrl-0 = <&wake_pins>;
 };
 
diff --git a/drivers/net/wireless/marvell/mwifiex/platform_drv.c 
b/drivers/net/wireless/marvell/mwifiex/platform_drv.c
index 5fd5d80..5ae7dc0 100644
--- a/drivers/net/wireless/marvell/mwifiex/platform_drv.c
+++ b/drivers/net/wireless/marvell/mwifiex/platform_drv.c
@@ -18,9 +18,63 @@
 
 struct platform_device *mwifiex_plt_dev;
 
+struct mwifiex_wake_dev {
+       struct device *dev;
+       int irq_wifi;
+       bool wake_by_wifi;
+};
+
+static irqreturn_t mwifiex_wake_irq_wifi(int irq, void *priv)
+{
+       struct mwifiex_wake_dev *ctx = priv;
+
+       if (ctx->irq_wifi >= 0) {
+               ctx->wake_by_wifi = true;
+               disable_irq_nosync(ctx->irq_wifi);
+       }
+
+       return IRQ_HANDLED;
+}
+
 static int mwifiex_plt_probe(struct platform_device *pdev)
 {
+       int ret;
+       struct mwifiex_wake_dev *ctx;
+       int gpio;
+
        mwifiex_plt_dev = pdev;
+
+       ctx = devm_kzalloc(&pdev->dev, sizeof(*ctx), GFP_KERNEL);
+       if (!ctx)
+               return -ENOMEM;
+
+       ctx->dev = &pdev->dev;
+       ctx->irq_wifi = platform_get_irq(pdev, 0);
+       if (ctx->irq_wifi < 0)
+               dev_err(&pdev->dev, "Failed to get irq_wifi\n");
+
+       gpio = of_get_gpio(pdev->dev.of_node, 0);
+       if (gpio_is_valid(gpio))
+               gpio_direction_input(gpio);
+       else
+               dev_err(&pdev->dev, "gpio wifi is invalid\n");
+
+       if (ctx->irq_wifi >= 0) {
+               ret = devm_request_irq(&pdev->dev, ctx->irq_wifi,
+                                      mwifiex_wake_irq_wifi,
+                                      IRQF_TRIGGER_LOW,
+                                      "wifi_wake", ctx);
+               if (ret) {
+                       dev_err(&pdev->dev,
+                               "Failed to request irq_wifi %d (%d)\n",
+                               ctx->irq_wifi, ret);
+                       return -EINVAL;
+               }
+               disable_irq(ctx->irq_wifi);
+       }
+
+       platform_set_drvdata(pdev, ctx);
+
        return 0;
 }
 
@@ -30,6 +84,42 @@ static int mwifiex_plt_remove(struct platform_device *pdev)
        return 0;
 }
 
+static int __maybe_unused mwifiex_plt_suspend(struct device *dev)
+{
+       struct mwifiex_wake_dev *ctx = dev_get_drvdata(dev);
+       int ret;
+
+       if (ctx->irq_wifi >= 0) {
+               ctx->wake_by_wifi = false;
+               enable_irq(ctx->irq_wifi);
+               ret = enable_irq_wake(ctx->irq_wifi);
+               if (ret)
+                       return ret;
+       }
+
+       return 0;
+}
+
+static int __maybe_unused mwifiex_plt_resume(struct device *dev)
+{
+       struct mwifiex_wake_dev *ctx = dev_get_drvdata(dev);
+       int ret;
+
+       if (ctx->irq_wifi >= 0) {
+               ret = disable_irq_wake(ctx->irq_wifi);
+               if (!ctx->wake_by_wifi)
+                       disable_irq(ctx->irq_wifi);
+               if (ret)
+                       return ret;
+       }
+
+       return 0;
+}
+
+static const struct dev_pm_ops mwifiex_plt_pm_ops = {
+       SET_SYSTEM_SLEEP_PM_OPS(mwifiex_plt_suspend, mwifiex_plt_resume)
+};
+
 static const struct of_device_id mwifiex_dt_match[] = {
        {
                .compatible = "marvell,sd8xxx",
@@ -45,6 +135,7 @@ static struct platform_driver mwifiex_platform_driver = {
        .driver = {
                .name   = "mwifiex_plt",
                .of_match_table = mwifiex_dt_match,
+               .pm = &mwifiex_plt_pm_ops,
        }
 };
 
-- 
1.8.1.4

Reply via email to