From patchwork Wed Nov 16 20:27:59 2011 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Brian Norris X-Patchwork-Id: 126032 X-Patchwork-Delegate: davem@davemloft.net Return-Path: X-Original-To: incoming@patchwork.ozlabs.org Delivered-To: patchwork-incoming@bilbo.ozlabs.org Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by ozlabs.org (Postfix) with ESMTP id 23705B7199 for ; Thu, 17 Nov 2011 07:28:27 +1100 (EST) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1752093Ab1KPU2K (ORCPT ); Wed, 16 Nov 2011 15:28:10 -0500 Received: from mail-gx0-f174.google.com ([209.85.161.174]:52070 "EHLO mail-gx0-f174.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1751907Ab1KPU2J (ORCPT ); Wed, 16 Nov 2011 15:28:09 -0500 Received: by ggnb2 with SMTP id b2so135868ggn.19 for ; Wed, 16 Nov 2011 12:28:09 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=gamma; h=from:to:cc:subject:date:message-id:x-mailer; bh=s6dfPJnS73Stvi4UQEuVdXUFK2NzdkdAO53HSuvw8Xw=; b=XqNrrbSG1DVYjnIvEVNBgPwm0ALKTwC9a6PIcUUU/W544Z64bIcauvptQeE7jWW0UC OVJoJEFA78mddyHtqOVtRricBnKsKvQ5K9OrCmSGXPK3PuZpvjNUw1bHN8WOG6WeB/f+ 26ek9rj2Qiz+zxFDeLfFiz3tTvepKXXxrzO98= Received: by 10.50.158.227 with SMTP id wx3mr34756659igb.52.1321475288470; Wed, 16 Nov 2011 12:28:08 -0800 (PST) Received: from localhost.localdomain (5520-maca-inet1-outside.broadcom.com. [216.31.211.11]) by mx.google.com with ESMTPS id wo4sm16455284igc.5.2011.11.16.12.28.05 (version=TLSv1/SSLv3 cipher=OTHER); Wed, 16 Nov 2011 12:28:07 -0800 (PST) From: Brian Norris To: Jeff Garzik Cc: Brian Norris , , Tejun Heo , Kevin Cernekee , Linux Kernel , Anton Vorontsov Subject: [PATCH] ahci: platform support for suspend/resume Date: Wed, 16 Nov 2011 12:27:59 -0800 Message-Id: <1321475279-29930-1-git-send-email-computersforpeace@gmail.com> X-Mailer: git-send-email 1.7.5.4 Sender: linux-ide-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-ide@vger.kernel.org Add platform hooks for custom suspend() and resume() functions. The generic suspend/resume code in drivers/ata/ahci_platform.c is adapted from the PCI version in drivers/ata/ahci.c. Note that in order to suspend, we require that both suspend() and resume() functions be supplied. Signed-off-by: Brian Norris --- Based on: git://github.com/jgarzik/libata-dev.git ALL drivers/ata/ahci_platform.c | 72 +++++++++++++++++++++++++++++++++++++++++ include/linux/ahci_platform.h | 2 + 2 files changed, 74 insertions(+), 0 deletions(-) diff --git a/drivers/ata/ahci_platform.c b/drivers/ata/ahci_platform.c index ec55595..98bf5e9 100644 --- a/drivers/ata/ahci_platform.c +++ b/drivers/ata/ahci_platform.c @@ -202,6 +202,75 @@ static int __devexit ahci_remove(struct platform_device *pdev) return 0; } +#ifdef CONFIG_PM +static int ahci_suspend(struct device *dev) +{ + struct ahci_platform_data *pdata = dev_get_platdata(dev); + struct ata_host *host = dev_get_drvdata(dev); + struct ahci_host_priv *hpriv = host->private_data; + void __iomem *mmio = hpriv->mmio; + u32 ctl; + int rc; + + /* Does platform support suspend/resume? */ + if (!pdata->suspend || !pdata->resume) + return -EINVAL; + + if (hpriv->flags & AHCI_HFLAG_NO_SUSPEND) { + dev_err(dev, "firmware update required for suspend/resume\n"); + return -EIO; + } + + /* + * AHCI spec rev1.1 section 8.3.3: + * Software must disable interrupts prior to requesting a + * transition of the HBA to D3 state. + */ + ctl = readl(mmio + HOST_CTL); + ctl &= ~HOST_IRQ_EN; + writel(ctl, mmio + HOST_CTL); + readl(mmio + HOST_CTL); /* flush */ + + rc = ata_host_suspend(host, PMSG_SUSPEND); + if (rc) + return rc; + + return pdata->suspend(dev); +} + +static int ahci_resume(struct device *dev) +{ + struct ahci_platform_data *pdata = dev->platform_data; + struct ata_host *host = dev_get_drvdata(dev); + int rc; + + /* Does platform support suspend/resume? */ + if (!pdata->resume) + return -EINVAL; + + rc = pdata->resume(dev); + if (rc) + return rc; + + if (dev->power.power_state.event == PM_EVENT_SUSPEND) { + rc = ahci_reset_controller(host); + if (rc) + return rc; + + ahci_init_controller(host); + } + + ata_host_resume(host); + + return 0; +} + +static struct dev_pm_ops ahci_pm_ops = { + .suspend = &ahci_suspend, + .resume = &ahci_resume, +}; +#endif + static const struct of_device_id ahci_of_match[] = { { .compatible = "calxeda,hb-ahci", }, {}, @@ -214,6 +283,9 @@ static struct platform_driver ahci_driver = { .name = "ahci", .owner = THIS_MODULE, .of_match_table = ahci_of_match, +#ifdef CONFIG_PM + .pm = &ahci_pm_ops, +#endif }, .id_table = ahci_devtype, }; diff --git a/include/linux/ahci_platform.h b/include/linux/ahci_platform.h index be3d9a7..73a2500 100644 --- a/include/linux/ahci_platform.h +++ b/include/linux/ahci_platform.h @@ -23,6 +23,8 @@ struct ata_port_info; struct ahci_platform_data { int (*init)(struct device *dev, void __iomem *addr); void (*exit)(struct device *dev); + int (*suspend)(struct device *dev); + int (*resume)(struct device *dev); const struct ata_port_info *ata_port_info; unsigned int force_port_map; unsigned int mask_port_map;