From patchwork Thu Aug 1 13:06:26 2013 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Yijing Wang X-Patchwork-Id: 2836981 X-Patchwork-Delegate: bhelgaas@google.com Return-Path: X-Original-To: patchwork-linux-pci@patchwork.kernel.org Delivered-To: patchwork-parsemail@patchwork2.web.kernel.org Received: from mail.kernel.org (mail.kernel.org [198.145.19.201]) by patchwork2.web.kernel.org (Postfix) with ESMTP id 24B90C0319 for ; Thu, 1 Aug 2013 13:07:26 +0000 (UTC) Received: from mail.kernel.org (localhost [127.0.0.1]) by mail.kernel.org (Postfix) with ESMTP id 523F920262 for ; Thu, 1 Aug 2013 13:07:21 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id 9649320299 for ; Thu, 1 Aug 2013 13:07:15 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1754561Ab3HANHJ (ORCPT ); Thu, 1 Aug 2013 09:07:09 -0400 Received: from szxga01-in.huawei.com ([119.145.14.64]:58601 "EHLO szxga01-in.huawei.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1754688Ab3HANHI (ORCPT ); Thu, 1 Aug 2013 09:07:08 -0400 Received: from 172.24.2.119 (EHLO szxeml214-edg.china.huawei.com) ([172.24.2.119]) by szxrg01-dlp.huawei.com (MOS 4.3.4-GA FastPath queued) with ESMTP id BGC48532; Thu, 01 Aug 2013 21:07:00 +0800 (CST) Received: from SZXEML461-HUB.china.huawei.com (10.82.67.204) by szxeml214-edg.china.huawei.com (172.24.2.29) with Microsoft SMTP Server (TLS) id 14.1.323.7; Thu, 1 Aug 2013 21:07:01 +0800 Received: from localhost (10.135.76.69) by szxeml461-hub.china.huawei.com (10.82.67.204) with Microsoft SMTP Server id 14.1.323.7; Thu, 1 Aug 2013 21:06:51 +0800 From: Yijing Wang To: Bjorn Helgaas CC: , Hanjun Guo , , Yijing Wang , Paul Bolle , "Rafael J. Wysocki" , Oliver Neukum , Gu Zheng Subject: [PATCH -v4 3/6] PCI: Introduce Vital Product Data Serial Number capability support Date: Thu, 1 Aug 2013 21:06:26 +0800 Message-ID: <1375362389-26096-4-git-send-email-wangyijing@huawei.com> X-Mailer: git-send-email 1.7.11.msysgit.1 In-Reply-To: <1375362389-26096-1-git-send-email-wangyijing@huawei.com> References: <1375362389-26096-1-git-send-email-wangyijing@huawei.com> MIME-Version: 1.0 X-Originating-IP: [10.135.76.69] X-CFilter-Loop: Reflected Sender: linux-pci-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-pci@vger.kernel.org X-Spam-Status: No, score=-8.4 required=5.0 tests=BAYES_00, RCVD_IN_DNSWL_HI, RP_MATCHES_RCVD, UNPARSEABLE_RELAY autolearn=unavailable version=3.3.1 X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on mail.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP Vital Product Data Serial Number is another capability to support device serial number, some devices may implement this cap. So we introduce VPD SN support here to enhance the device change identification. Suggested-by: Bjorn Helgaas Signed-off-by: Yijing Wang Cc: Paul Bolle Cc: "Rafael J. Wysocki" Cc: Oliver Neukum Cc: Gu Zheng Cc: linux-pci@vger.kernel.org --- drivers/pci/access.c | 4 ++- drivers/pci/pci.h | 4 +++ drivers/pci/vpd.c | 70 ++++++++++++++++++++++++++++++++++++++++++++++++++ include/linux/pci.h | 1 + 4 files changed, 78 insertions(+), 1 deletions(-) diff --git a/drivers/pci/access.c b/drivers/pci/access.c index 1cc2366..0069981 100644 --- a/drivers/pci/access.c +++ b/drivers/pci/access.c @@ -194,7 +194,6 @@ PCI_USER_WRITE_CONFIG(dword, u32) /* VPD access through PCI 2.2+ VPD capability */ -#define PCI_VPD_PCI22_SIZE (PCI_VPD_ADDR_MASK + 1) struct pci_vpd_pci22 { struct pci_vpd base; @@ -350,6 +349,7 @@ out: static void pci_vpd_pci22_release(struct pci_dev *dev) { + kfree(dev->vpd->sn); kfree(container_of(dev->vpd, struct pci_vpd_pci22, base)); } @@ -377,6 +377,8 @@ int pci_vpd_pci22_init(struct pci_dev *dev) vpd->cap = cap; vpd->busy = false; dev->vpd = &vpd->base; + + pci_vpd_serial_number_init(dev, dev->vpd); return 0; } diff --git a/drivers/pci/pci.h b/drivers/pci/pci.h index 5f398a5..aed8751 100644 --- a/drivers/pci/pci.h +++ b/drivers/pci/pci.h @@ -83,6 +83,8 @@ static inline bool pci_is_bridge(struct pci_dev *pci_dev) return !!(pci_dev->subordinate); } +#define PCI_VPD_PCI22_SIZE (PCI_VPD_ADDR_MASK + 1) + struct pci_vpd_ops { ssize_t (*read)(struct pci_dev *dev, loff_t pos, size_t count, void *buf); ssize_t (*write)(struct pci_dev *dev, loff_t pos, size_t count, const void *buf); @@ -91,6 +93,7 @@ struct pci_vpd_ops { struct pci_vpd { unsigned int len; + char *sn; /* serial number */ const struct pci_vpd_ops *ops; struct bin_attribute *attr; /* descriptor for sysfs VPD entry */ }; @@ -208,6 +211,7 @@ void __ref __pci_bus_assign_resources(const struct pci_bus *bus, struct list_head *realloc_head, struct list_head *fail_head); void pci_dsn_init(struct pci_dev *dev); +struct pci_vpd *pci_vpd_serial_number_init(struct pci_dev *dev, struct pci_vpd *vpd); /** * pci_ari_enabled - query ARI forwarding status * @bus: the PCI bus diff --git a/drivers/pci/vpd.c b/drivers/pci/vpd.c index 39b7907..e5a4853 100644 --- a/drivers/pci/vpd.c +++ b/drivers/pci/vpd.c @@ -7,6 +7,7 @@ #include #include +#include "pci.h" int pci_vpd_find_tag(const u8 *buf, unsigned int off, unsigned int len, u8 rdt) { @@ -60,3 +61,71 @@ int pci_vpd_find_info_keyword(const u8 *buf, unsigned int off, return -ENOENT; } EXPORT_SYMBOL_GPL(pci_vpd_find_info_keyword); + +/** + * pci_vpd_serial_number_init - initialize the device VPD SN + * @dev: the PCI device + * @vpd: the VPD used to initialize SN + * + * Initialize the device VPD Serial Number, if vpd passed as NULL, + * allocate a new VPD and initialize its SN. + */ +struct pci_vpd *pci_vpd_serial_number_init(struct pci_dev *dev, + struct pci_vpd *vpd) +{ + char *buf = NULL; + struct pci_vpd *old = dev->vpd; + struct pci_vpd *new = NULL; + int cnt, i, end, j, len; + + /* To detect whether the device is changed, we should + * allocate a new VPD to initialize serial number, + * because if the device has been changed, the cap + * info is stale. + */ + if (!vpd) { + dev->vpd = NULL; + pci_vpd_pci22_init(dev); + if (!dev->vpd) + goto fail; + } + + new = dev->vpd; + buf = kzalloc(PCI_VPD_PCI22_SIZE, GFP_KERNEL); + if (!buf) + goto fail; + + cnt = pci_read_vpd(dev, 0, PCI_VPD_PCI22_SIZE, buf); + if (cnt < 0) + goto fail; + + i = pci_vpd_find_tag(buf, 0, PCI_VPD_PCI22_SIZE, + PCI_VPD_LRDT_RO_DATA); + if (i < 0) + goto fail; + + end = i + PCI_VPD_LRDT_TAG_SIZE + pci_vpd_lrdt_size(&buf[i]); + i += PCI_VPD_LRDT_TAG_SIZE; + + j = pci_vpd_find_info_keyword(buf, i, end, + PCI_VPD_RO_KEYWORD_SN); + if (j < 0) + goto fail; + + len = pci_vpd_info_field_size(&buf[j]); + new->sn = kzalloc(len + 1, GFP_KERNEL); + if (!new->sn) + goto fail; + + j += PCI_VPD_INFO_FLD_HDR_SIZE; + memcpy(new->sn, &buf[j], len); + kfree(buf); + dev->vpd = old; + return new; +fail: + kfree(buf); + if (new != old) + pci_vpd_release(dev); + dev->vpd = old; + return NULL; +} diff --git a/include/linux/pci.h b/include/linux/pci.h index 4354eaf..5c38b55 100644 --- a/include/linux/pci.h +++ b/include/linux/pci.h @@ -1781,6 +1781,7 @@ bool pci_acs_path_enabled(struct pci_dev *start, #define PCI_VPD_RO_KEYWORD_PARTNO "PN" #define PCI_VPD_RO_KEYWORD_MFR_ID "MN" +#define PCI_VPD_RO_KEYWORD_SN "SN" #define PCI_VPD_RO_KEYWORD_VENDOR0 "V0" #define PCI_VPD_RO_KEYWORD_CHKSUM "RV"