Return-Path: From: Frederic Danis To: linux-bluetooth@vger.kernel.org Subject: [PATCH v4 4/4] Bluetooth: hci_bcm: Add suspend/resume PM functions Date: Tue, 11 Aug 2015 12:12:13 +0200 Message-Id: <1439287933-21069-5-git-send-email-frederic.danis@linux.intel.com> In-Reply-To: <1439287933-21069-1-git-send-email-frederic.danis@linux.intel.com> References: <1439287933-21069-1-git-send-email-frederic.danis@linux.intel.com> Content-Type: text/plain; charset="utf-8" Sender: linux-bluetooth-owner@vger.kernel.org List-ID: Add reference to hci_uart structure to bcm_device. This allows suspend/resume callbacks to manage UART flow control. Signed-off-by: Frederic Danis --- drivers/bluetooth/hci_bcm.c | 61 ++++++++++++++++++++++++++++++++++++++++++++- 1 file changed, 60 insertions(+), 1 deletion(-) diff --git a/drivers/bluetooth/hci_bcm.c b/drivers/bluetooth/hci_bcm.c index 12490eb..11782fa 100644 --- a/drivers/bluetooth/hci_bcm.c +++ b/drivers/bluetooth/hci_bcm.c @@ -51,6 +51,9 @@ struct bcm_device { bool clk_enabled; u32 init_speed; + + struct hci_uart *hu; + bool is_suspended; /* suspend/resume flag */ }; struct bcm_data { @@ -170,6 +173,7 @@ static int bcm_open(struct hci_uart *hu) if (hu->tty->dev->parent == dev->pdev->dev.parent) { bcm->dev = dev; hu->init_speed = dev->init_speed; + dev->hu = hu; break; } } @@ -190,8 +194,10 @@ static int bcm_close(struct hci_uart *hu) /* Protect bcm->dev against removal of the device or driver */ spin_lock(&bcm_device_list_lock); - if (bcm_device_exists(bcm->dev)) + if (bcm_device_exists(bcm->dev)) { bcm_gpio_set_power(bcm->dev, false); + bcm->dev->hu = NULL; + } spin_unlock(&bcm_device_list_lock); skb_queue_purge(&bcm->txq); @@ -318,6 +324,53 @@ static struct sk_buff *bcm_dequeue(struct hci_uart *hu) return skb_dequeue(&bcm->txq); } +/* Platform suspend callback */ +static int bcm_suspend(struct device *pdev) +{ + struct bcm_device *dev = platform_get_drvdata(to_platform_device(pdev)); + + BT_DBG("suspend (%p): is_suspended %d", dev, dev->is_suspended); + + if (!dev->is_suspended) { + hci_uart_set_flow_control(dev->hu, true); + + /* Once this callback returns, driver suspends BT via GPIO */ + dev->is_suspended = true; + } + + /* Suspend the device */ + if (dev->device_wakeup) { + gpiod_set_value(dev->device_wakeup, false); + BT_DBG("suspend, delaying 15 ms"); + mdelay(15); + } + + return 0; +} + +/* Platform resume callback */ +static int bcm_resume(struct device *pdev) +{ + struct bcm_device *dev = platform_get_drvdata(to_platform_device(pdev)); + + BT_DBG("resume (%p): is_suspended %d", dev, dev->is_suspended); + + if (dev->device_wakeup) { + gpiod_set_value(dev->device_wakeup, true); + BT_DBG("resume, delaying 15 ms"); + mdelay(15); + } + + /* When this callback executes, the device has woken up already */ + if (dev->is_suspended) { + dev->is_suspended = false; + + hci_uart_set_flow_control(dev->hu, false); + } + + return 0; +} + static const struct acpi_gpio_params device_wakeup_gpios = { 0, 0, false }; static const struct acpi_gpio_params shutdown_gpios = { 1, 0, false }; @@ -474,12 +527,18 @@ static const struct acpi_device_id bcm_acpi_match[] = { MODULE_DEVICE_TABLE(acpi, bcm_acpi_match); #endif +/* Platform suspend and resume callbacks */ +static const struct dev_pm_ops bcm_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(bcm_suspend, bcm_resume) +}; + static struct platform_driver bcm_driver = { .probe = bcm_probe, .remove = bcm_remove, .driver = { .name = "hci_bcm", .acpi_match_table = ACPI_PTR(bcm_acpi_match), + .pm = &bcm_pm_ops, }, }; -- 1.9.1