From patchwork Wed Apr 8 05:15:49 2009 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Yu Zhao X-Patchwork-Id: 17003 Received: from vger.kernel.org (vger.kernel.org [209.132.176.167]) by demeter.kernel.org (8.14.2/8.14.2) with ESMTP id n385EfPB008188 for ; Wed, 8 Apr 2009 05:14:41 GMT Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1756742AbZDHFOi (ORCPT ); Wed, 8 Apr 2009 01:14:38 -0400 Received: (majordomo@vger.kernel.org) by vger.kernel.org id S1757805AbZDHFOi (ORCPT ); Wed, 8 Apr 2009 01:14:38 -0400 Received: from mga03.intel.com ([143.182.124.21]:48082 "EHLO mga03.intel.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1756742AbZDHFOh (ORCPT ); Wed, 8 Apr 2009 01:14:37 -0400 Received: from azsmga001.ch.intel.com ([10.2.17.19]) by azsmga101.ch.intel.com with ESMTP; 07 Apr 2009 22:14:36 -0700 X-ExtLoop1: 1 X-IronPort-AV: E=Sophos;i="4.39,342,1235980800"; d="scan'208";a="129117461" Received: from yzhao-otc.sh.intel.com ([10.239.48.165]) by azsmga001.ch.intel.com with ESMTP; 07 Apr 2009 22:14:36 -0700 From: Yu Zhao To: jbarnes@virtuousgeek.org Cc: linux-pci@vger.kernel.org, Yu Zhao Subject: [PATCH] PCI: only save/restore existent registers in the PCIe capability Date: Wed, 8 Apr 2009 13:15:49 +0800 Message-Id: <1239167749-15843-1-git-send-email-yu.zhao@intel.com> X-Mailer: git-send-email 1.6.1 In-Reply-To: <20090407145349.63f9aa52@hobbes> References: <20090407145349.63f9aa52@hobbes> Sender: linux-pci-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-pci@vger.kernel.org PCIe 1.1 spec neither requires the endpoint to implement the entire PCIe capability structure nor specifies default value of registers that are not implemented by the device. So we only save and restore registers that must be implemented by different device types if the device PCIe capability version is 1. PCIe 1.1 Capability Structure Expansion ENC and PCIe 2.0 requires all registers in the PCIe capability to be either implemented or hardwired to 0. Their PCIe capability version is 2. Signed-off-by: Yu Zhao --- drivers/pci/pci.c | 58 +++++++++++++++++++++++++++++++++++++++++---- include/linux/pci_regs.h | 1 + 2 files changed, 53 insertions(+), 6 deletions(-) diff --git a/drivers/pci/pci.c b/drivers/pci/pci.c index fe7ac2c..635bb6b 100644 --- a/drivers/pci/pci.c +++ b/drivers/pci/pci.c @@ -686,6 +686,8 @@ static int pci_save_pcie_state(struct pci_dev *dev) int pos, i = 0; struct pci_cap_saved_state *save_state; u16 *cap; + u16 flags; + int cap_version; pos = pci_find_capability(dev, PCI_CAP_ID_EXP); if (pos <= 0) @@ -698,10 +700,31 @@ static int pci_save_pcie_state(struct pci_dev *dev) } cap = (u16 *)&save_state->data[0]; + pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags); + cap_version = flags & PCI_EXP_FLAGS_VERS; + pci_read_config_word(dev, pos + PCI_EXP_DEVCTL, &cap[i++]); - pci_read_config_word(dev, pos + PCI_EXP_LNKCTL, &cap[i++]); - pci_read_config_word(dev, pos + PCI_EXP_SLTCTL, &cap[i++]); - pci_read_config_word(dev, pos + PCI_EXP_RTCTL, &cap[i++]); + + if (cap_version > 1 || + (dev->pcie_type == PCI_EXP_TYPE_ROOT_PORT || + dev->pcie_type == PCI_EXP_TYPE_ENDPOINT || + dev->pcie_type == PCI_EXP_TYPE_LEG_END)) + pci_read_config_word(dev, pos + PCI_EXP_LNKCTL, &cap[i++]); + + if (cap_version > 1 || + ((dev->pcie_type == PCI_EXP_TYPE_ROOT_PORT) || + (dev->pcie_type == PCI_EXP_TYPE_DOWNSTREAM && + (flags & PCI_EXP_FLAGS_SLOT)))) + pci_read_config_word(dev, pos + PCI_EXP_SLTCTL, &cap[i++]); + + if (cap_version > 1 || + (dev->pcie_type == PCI_EXP_TYPE_ROOT_PORT || + dev->pcie_type == PCI_EXP_TYPE_RC_EC)) + pci_read_config_word(dev, pos + PCI_EXP_RTCTL, &cap[i++]); + + if (cap_version == 1) + return 0; + pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &cap[i++]); pci_read_config_word(dev, pos + PCI_EXP_LNKCTL2, &cap[i++]); pci_read_config_word(dev, pos + PCI_EXP_SLTCTL2, &cap[i++]); @@ -714,6 +737,8 @@ static void pci_restore_pcie_state(struct pci_dev *dev) int i = 0, pos; struct pci_cap_saved_state *save_state; u16 *cap; + u16 flags; + int cap_version; save_state = pci_find_saved_cap(dev, PCI_CAP_ID_EXP); pos = pci_find_capability(dev, PCI_CAP_ID_EXP); @@ -721,10 +746,31 @@ static void pci_restore_pcie_state(struct pci_dev *dev) return; cap = (u16 *)&save_state->data[0]; + pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags); + cap_version = flags & PCI_EXP_FLAGS_VERS; + pci_write_config_word(dev, pos + PCI_EXP_DEVCTL, cap[i++]); - pci_write_config_word(dev, pos + PCI_EXP_LNKCTL, cap[i++]); - pci_write_config_word(dev, pos + PCI_EXP_SLTCTL, cap[i++]); - pci_write_config_word(dev, pos + PCI_EXP_RTCTL, cap[i++]); + + if (cap_version > 1 || + (dev->pcie_type == PCI_EXP_TYPE_ROOT_PORT || + dev->pcie_type == PCI_EXP_TYPE_ENDPOINT || + dev->pcie_type == PCI_EXP_TYPE_LEG_END)) + pci_read_config_word(dev, pos + PCI_EXP_LNKCTL, &cap[i++]); + + if (cap_version > 1 || + ((dev->pcie_type == PCI_EXP_TYPE_ROOT_PORT) || + (dev->pcie_type == PCI_EXP_TYPE_DOWNSTREAM && + (flags & PCI_EXP_FLAGS_SLOT)))) + pci_read_config_word(dev, pos + PCI_EXP_SLTCTL, &cap[i++]); + + if (cap_version > 1 || + (dev->pcie_type == PCI_EXP_TYPE_ROOT_PORT || + dev->pcie_type == PCI_EXP_TYPE_RC_EC)) + pci_read_config_word(dev, pos + PCI_EXP_RTCTL, &cap[i++]); + + if (cap_version == 1) + return; + pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, cap[i++]); pci_write_config_word(dev, pos + PCI_EXP_LNKCTL2, cap[i++]); pci_write_config_word(dev, pos + PCI_EXP_SLTCTL2, cap[i++]); diff --git a/include/linux/pci_regs.h b/include/linux/pci_regs.h index e4d08c1..616bf8b 100644 --- a/include/linux/pci_regs.h +++ b/include/linux/pci_regs.h @@ -376,6 +376,7 @@ #define PCI_EXP_TYPE_DOWNSTREAM 0x6 /* Downstream Port */ #define PCI_EXP_TYPE_PCI_BRIDGE 0x7 /* PCI/PCI-X Bridge */ #define PCI_EXP_TYPE_RC_END 0x9 /* Root Complex Integrated Endpoint */ +#define PCI_EXP_TYPE_RC_EC 0x10 /* Root Complex Event Collector */ #define PCI_EXP_FLAGS_SLOT 0x0100 /* Slot implemented */ #define PCI_EXP_FLAGS_IRQ 0x3e00 /* Interrupt message number */ #define PCI_EXP_DEVCAP 4 /* Device capabilities */