From patchwork Wed Nov 8 09:28:06 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Marek Vasut X-Patchwork-Id: 10048079 X-Patchwork-Delegate: bhelgaas@google.com Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 51EED6032D for ; Wed, 8 Nov 2017 09:28:36 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 4EF232A4EF for ; Wed, 8 Nov 2017 09:28:36 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 43F412A4F9; Wed, 8 Nov 2017 09:28:36 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-6.5 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID, DKIM_VALID_AU, FREEMAIL_FROM, RCVD_IN_DNSWL_HI, RCVD_IN_SORBS_SPAM autolearn=unavailable version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id DA3E72A4EF for ; Wed, 8 Nov 2017 09:28:35 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1751350AbdKHJ2b (ORCPT ); Wed, 8 Nov 2017 04:28:31 -0500 Received: from mail-wm0-f67.google.com ([74.125.82.67]:44455 "EHLO mail-wm0-f67.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1751278AbdKHJ2X (ORCPT ); Wed, 8 Nov 2017 04:28:23 -0500 Received: by mail-wm0-f67.google.com with SMTP id n74so17280909wmi.1; Wed, 08 Nov 2017 01:28:22 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=+ozX7fCHlXESqhZgwAG0jECJhUvbPkHOff4iNvCHAyc=; b=kIEUQ7tljBWL1bdO6jvxgW87H5DbdxV9eIMEFBvAhaZJMC1RKZmYAgD/bUY/HpzRvC C+COznYmSLBY8Q3t6a7o90+nMtMUFKimtKSMxE8/c3Ww8Rw5gCfYWbn8TkjgV4+frzI3 xqY/XpJzml9V1C9BGdIu4tmJUOm9COMzifRnQh84cd7D/FtvMkuz5B7avChJvcWG0QC8 I6UsAlPhaksm6HlkO3yPnpGF/B09A+1X8RzPPg/iIZiA+P8/O2jN0vBC4APWmLsqTdsb YL6OTWY3KvLGfKe4OJXzwIqN2IWfl1NxidDHa+X3jU4gNRisgRiioHTz0N3bFfSqWpi8 mDvg== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references; bh=+ozX7fCHlXESqhZgwAG0jECJhUvbPkHOff4iNvCHAyc=; b=YYHkJ1Ud0gATORvcvIXQQuep+1chMNUsW3PoA/81QY4yVJa2fxz/EIJC6cKCaBpEXW JyrdrS6jwvdWIapUN62ZKnJ+DmFXQBdGDzr78MymPSViRztYjbU0NfR85cyge8m9DJdT f3levaGjrft5UtEivaA/quxGLbragt7Q57BxAiW2PWc/lJVV7HMFCYi/9sKc1ChtPQv1 3fLyqny5nLAj180m37rFvLdWuTjTAauP6wEBF5R8je6NlH5Tt/g6OR9fJxYIeWtoX2mR japthFExMQ+5ISEXg1zDP3kADfiIiijIfQQXfyVVFOHxRM2wZ/xjo74Ool6fS9CxoZIM PVSw== X-Gm-Message-State: AJaThX4qwPZZ3RlOu1fRt1PC2qYuLPWoGilwUc1Zu5GHbLo/V0AmunzT 771gvEe2+dX6cTEHtqaQVdB7ZhEk X-Google-Smtp-Source: ABhQp+Rjq/PP74THr4wiE9mfFh9iq2af5dSKItUj/wzccglaNq3pWVz/IDXq6zWXt4dHgDLIIIBJrA== X-Received: by 10.28.1.199 with SMTP id 190mr1561236wmb.51.1510133301941; Wed, 08 Nov 2017 01:28:21 -0800 (PST) Received: from kurokawa.lan (ip-86-49-107-50.net.upcbroadband.cz. [86.49.107.50]) by smtp.gmail.com with ESMTPSA id o135sm4489691wmg.1.2017.11.08.01.28.20 (version=TLS1_2 cipher=ECDHE-RSA-AES128-GCM-SHA256 bits=128/128); Wed, 08 Nov 2017 01:28:21 -0800 (PST) From: Marek Vasut X-Google-Original-From: Marek Vasut To: linux-pci@vger.kernel.org Cc: Kazufumi Ikeda , Gaku Inami , Marek Vasut , Geert Uytterhoeven , Simon Horman , Wolfram Sang , linux-renesas-soc@vger.kernel.org Subject: [PATCH 3/3] PCI: rcar: Add the suspend/resume for pcie-rcar driver Date: Wed, 8 Nov 2017 10:28:06 +0100 Message-Id: <20171108092806.10335-3-marek.vasut+renesas@gmail.com> X-Mailer: git-send-email 2.11.0 In-Reply-To: <20171108092806.10335-1-marek.vasut+renesas@gmail.com> References: <20171108092806.10335-1-marek.vasut+renesas@gmail.com> Sender: linux-pci-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-pci@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP From: Kazufumi Ikeda This adds the suspend/resume supports for pcie-rcar. The resume handler reprogram the hardware based on the software state kept in specific device structures. Also it doesn't need to save any registers. Signed-off-by: Kazufumi Ikeda Signed-off-by: Gaku Inami Signed-off-by: Marek Vasut Cc: Geert Uytterhoeven Cc: Simon Horman Cc: Wolfram Sang Cc: linux-renesas-soc@vger.kernel.org --- drivers/pci/host/pcie-rcar.c | 86 +++++++++++++++++++++++++++++++++++++++----- 1 file changed, 78 insertions(+), 8 deletions(-) diff --git a/drivers/pci/host/pcie-rcar.c b/drivers/pci/host/pcie-rcar.c index 2b28292de93a..7a9e30185c79 100644 --- a/drivers/pci/host/pcie-rcar.c +++ b/drivers/pci/host/pcie-rcar.c @@ -471,6 +471,36 @@ static void rcar_pcie_force_speedup(struct rcar_pcie *pcie) (macsr & LINK_SPEED) == LINK_SPEED_5_0GTS ? "5" : "2.5"); } +static int rcar_pcie_hw_enable(struct rcar_pcie *pcie) +{ + struct resource_entry *win; + LIST_HEAD(res); + int i = 0; + + /* Try setting 5 GT/s link speed */ + rcar_pcie_force_speedup(pcie); + + /* Setup PCI resources */ + resource_list_for_each_entry(win, &pcie->resources) { + struct resource *res = win->res; + + if (!res->flags) + continue; + + switch (resource_type(res)) { + case IORESOURCE_IO: + case IORESOURCE_MEM: + rcar_pcie_setup_window(i, pcie, res); + i++; + break; + default: + continue; + } + } + + return 0; +} + static int rcar_pcie_enable(struct rcar_pcie *pcie) { struct device *dev = pcie->dev; @@ -872,11 +902,25 @@ static const struct irq_domain_ops msi_domain_ops = { .map = rcar_msi_map, }; +static void rcar_pcie_hw_enable_msi(struct rcar_pcie *pcie) +{ + struct rcar_msi *msi = &pcie->msi; + unsigned long base; + + /* setup MSI data target */ + base = virt_to_phys((void *)msi->pages); + + rcar_pci_write_reg(pcie, base | MSIFE, PCIEMSIALR); + rcar_pci_write_reg(pcie, 0, PCIEMSIAUR); + + /* enable all MSI interrupts */ + rcar_pci_write_reg(pcie, 0xffffffff, PCIEMSIIER); +} + static int rcar_pcie_enable_msi(struct rcar_pcie *pcie) { struct device *dev = pcie->dev; struct rcar_msi *msi = &pcie->msi; - unsigned long base; int err, i; mutex_init(&msi->lock); @@ -915,13 +959,7 @@ static int rcar_pcie_enable_msi(struct rcar_pcie *pcie) /* setup MSI data target */ msi->pages = __get_free_pages(GFP_KERNEL, 0); - base = virt_to_phys((void *)msi->pages); - - rcar_pci_write_reg(pcie, base | MSIFE, PCIEMSIALR); - rcar_pci_write_reg(pcie, 0, PCIEMSIAUR); - - /* enable all MSI interrupts */ - rcar_pci_write_reg(pcie, 0xffffffff, PCIEMSIIER); + rcar_pcie_hw_enable_msi(pcie); return 0; @@ -1202,6 +1240,37 @@ static int rcar_pcie_probe(struct platform_device *pdev) return err; } +static int rcar_pcie_resume(struct device *dev) +{ + struct rcar_pcie *pcie = dev_get_drvdata(dev); + unsigned int data; + int err; + int (*hw_init_fn)(struct rcar_pcie *); + + err = rcar_pcie_parse_map_dma_ranges(pcie, dev->of_node); + if (err) + return 0; + + /* Failure to get a link might just be that no cards are inserted */ + hw_init_fn = of_device_get_match_data(dev); + err = hw_init_fn(pcie); + if (err) { + dev_info(dev, "PCIe link down\n"); + return 0; + } + + data = rcar_pci_read_reg(pcie, MACSR); + dev_info(dev, "PCIe x%d: link up\n", (data >> 20) & 0x3f); + + /* Enable MSI */ + if (IS_ENABLED(CONFIG_PCI_MSI)) + rcar_pcie_hw_enable_msi(pcie); + + rcar_pcie_hw_enable(pcie); + + return 0; +} + static int rcar_pcie_resume_noirq(struct device *dev) { struct rcar_pcie *pcie = dev_get_drvdata(dev); @@ -1218,6 +1287,7 @@ static int rcar_pcie_resume_noirq(struct device *dev) } static const struct dev_pm_ops rcar_pcie_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(NULL, rcar_pcie_resume) .resume_noirq = rcar_pcie_resume_noirq, };