From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id DC559C46467 for ; Fri, 18 Nov 2022 18:52:17 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S242835AbiKRSwQ (ORCPT ); Fri, 18 Nov 2022 13:52:16 -0500 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:51874 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S242889AbiKRSv7 (ORCPT ); Fri, 18 Nov 2022 13:51:59 -0500 Received: from mail.3ffe.de (0001.3ffe.de [IPv6:2a01:4f8:c0c:9d57::1]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 2F4E88FE4E for ; Fri, 18 Nov 2022 10:51:58 -0800 (PST) Received: from mwalle01.kontron.local. (unknown [213.135.10.150]) (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits) key-exchange X25519 server-signature RSA-PSS (2048 bits) server-digest SHA256) (No client certificate requested) by mail.3ffe.de (Postfix) with ESMTPSA id C26AC277F; Fri, 18 Nov 2022 19:51:32 +0100 (CET) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=walle.cc; s=mail2022082101; t=1668797492; h=from:from:reply-to:subject:subject:date:date:message-id:message-id: to:to:cc:cc:mime-version:mime-version:content-type:content-type: content-transfer-encoding:content-transfer-encoding: in-reply-to:in-reply-to:references:references; bh=FaSJ44U+7PRi5aOuAd8PAZIxwlTe2OPizVGNy/EG1oI=; b=OMwQQqyDBmvxQWS7GZExHcB+dn1MS+0/yMolRMmngNcT2PkUSs3afhicaPl0B72g6yzNsd AKocKsHrAQbSAzQP/hXUduhEn5WZWRbEumVgt7lCN+F5+Xzr3yAHK+TNFtDTkuTW1SvKoc b5+BH2sSrGIX0W3PbwZOedhnUNdSYGeOW+I1G8fvjo0OkJpQhl4w+OQTV1l/EoTTzKOdwp xhJanChk+ZaxKsYYITo1nV/IJPaXXnWhwSfSx5qqCdUyaJZEQ4ud3y/dQYyFrITbMe5QFx PT+Q0SC3zTXjiL/LuDDI6I7a0FxtJ115nR0Yul1KPRGbeH7Ry1qn+vjq7LnZmQ== From: Michael Walle To: Jonathan Corbet , Srinivas Kandagatla , Miquel Raynal , Rob Herring , Frank Rowand Cc: linux-doc@vger.kernel.org, linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org, devicetree@vger.kernel.org Subject: [PATCH v3 17/18] nvmem: layouts: Add ONIE tlv layout driver Date: Fri, 18 Nov 2022 19:51:17 +0100 Message-Id: <20221118185118.1190044-18-michael@walle.cc> X-Mailer: git-send-email 2.30.2 In-Reply-To: <20221118185118.1190044-1-michael@walle.cc> References: <20221118185118.1190044-1-michael@walle.cc> MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit Precedence: bulk List-ID: X-Mailing-List: linux-doc@vger.kernel.org From: Miquel Raynal This layout applies no top of any non volatile storage device containing an ONIE table factory flashed. This table follows the tlv (type-length-value) organization described in the link below. We cannot afford using regular parsers because the content of these tables is manufacturer specific and must be dynamically discovered. Link: https://opencomputeproject.github.io/onie/design-spec/hw_requirements.html Signed-off-by: Miquel Raynal --- changes since v2: - new patch drivers/nvmem/layouts/Kconfig | 9 ++ drivers/nvmem/layouts/Makefile | 1 + drivers/nvmem/layouts/onie-tlv.c | 249 +++++++++++++++++++++++++++++++ 3 files changed, 259 insertions(+) create mode 100644 drivers/nvmem/layouts/onie-tlv.c diff --git a/drivers/nvmem/layouts/Kconfig b/drivers/nvmem/layouts/Kconfig index 75082f6b471d..9ad50474cb77 100644 --- a/drivers/nvmem/layouts/Kconfig +++ b/drivers/nvmem/layouts/Kconfig @@ -11,4 +11,13 @@ config NVMEM_LAYOUT_SL28_VPD If unsure, say N. +config NVMEM_LAYOUT_ONIE_TLV + bool "ONIE tlv support" + select CRC32 + help + Say Y here if you want to support the Open Compute Project ONIE + Type-Length-Value standard table. + + If unsure, say N. + endmenu diff --git a/drivers/nvmem/layouts/Makefile b/drivers/nvmem/layouts/Makefile index fc617b9e87d0..2974bd7d33ed 100644 --- a/drivers/nvmem/layouts/Makefile +++ b/drivers/nvmem/layouts/Makefile @@ -4,3 +4,4 @@ # obj-$(CONFIG_NVMEM_LAYOUT_SL28_VPD) += sl28vpd.o +obj-$(CONFIG_NVMEM_LAYOUT_ONIE_TLV) += onie-tlv.o diff --git a/drivers/nvmem/layouts/onie-tlv.c b/drivers/nvmem/layouts/onie-tlv.c new file mode 100644 index 000000000000..86923c2e3052 --- /dev/null +++ b/drivers/nvmem/layouts/onie-tlv.c @@ -0,0 +1,249 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * ONIE tlv NVMEM cells provider + * + * Copyright (C) 2022 Open Compute Group ONIE + * Author: Miquel Raynal + * Based on the nvmem driver written by: Vadym Kochan + * Inspired by the first layout written by: Rafał Miłecki + */ + +#include +#include +#include +#include +#include + +#define ONIE_TLV_MAX_LEN 2048 +#define ONIE_TLV_CRC_FIELD_SZ 6 +#define ONIE_TLV_CRC_SZ 4 +#define ONIE_TLV_HDR_ID "TlvInfo" + +struct onie_tlv_hdr { + u8 id[8]; + u8 version; + __be16 data_len; +} __packed; + +struct onie_tlv { + u8 type; + u8 len; +} __packed; + +static const char *onie_tlv_cell_name(u8 type) +{ + switch (type) { + case 0x21: + return "product-name"; + case 0x22: + return "part-number"; + case 0x23: + return "serial-number"; + case 0x24: + return "mac-address"; + case 0x25: + return "manufacture-date"; + case 0x26: + return "device-version"; + case 0x27: + return "label-revision"; + case 0x28: + return "platforn-name"; + case 0x29: + return "onie-version"; + case 0x2A: + return "num-macs"; + case 0x2B: + return "manufacturer"; + case 0x2C: + return "country-code"; + case 0x2D: + return "vendor"; + case 0x2E: + return "diag-version"; + case 0x2F: + return "service-tag"; + case 0xFD: + return "vendor-extension"; + case 0xFE: + return "crc32"; + default: + break; + } + + return NULL; +} + +static int onie_tlv_mac_read_cb(void *priv, const char *id, int index, + unsigned int offset, void *buf, + size_t bytes) +{ + eth_addr_add(buf, index); + + return 0; +} + +static nvmem_cell_post_process_t onie_tlv_read_cb(u8 type, u8 *buf) +{ + switch (type) { + case 0x24: + return &onie_tlv_mac_read_cb; + default: + break; + } + + return NULL; +} + +static int onie_tlv_add_cells(struct device *dev, struct nvmem_device *nvmem, + size_t data_len, u8 *data) +{ + struct nvmem_cell_info cell = {}; + struct device_node *layout; + struct onie_tlv tlv; + unsigned int hdr_len = sizeof(struct onie_tlv_hdr); + unsigned int offset = 0; + int ret; + + layout = of_nvmem_layout_get_container(nvmem); + if (!layout) + return -ENOENT; + + while (offset < data_len) { + memcpy(&tlv, data + offset, sizeof(tlv)); + if (offset + tlv.len >= data_len) { + dev_err(dev, "Out of bounds field (0x%x bytes at 0x%x)\n", + tlv.len, hdr_len + offset); + break; + } + + cell.name = onie_tlv_cell_name(tlv.type); + if (!cell.name) + continue; + + cell.offset = hdr_len + offset + sizeof(tlv.type) + sizeof(tlv.len); + cell.bytes = tlv.len; + cell.np = of_get_child_by_name(layout, cell.name); + cell.read_post_process = onie_tlv_read_cb(tlv.type, data + offset + sizeof(tlv)); + + ret = nvmem_add_one_cell(nvmem, &cell); + if (ret) { + of_node_put(layout); + return ret; + } + + offset += sizeof(tlv) + tlv.len; + } + + of_node_put(layout); + + return 0; +} + +static bool onie_tlv_hdr_is_valid(struct device *dev, struct onie_tlv_hdr *hdr) +{ + if (memcmp(hdr->id, ONIE_TLV_HDR_ID, sizeof(hdr->id))) { + dev_err(dev, "Invalid header\n"); + return false; + } + + if (hdr->version != 0x1) { + dev_err(dev, "Invalid version number\n"); + return false; + } + + return true; +} + +static bool onie_tlv_crc_is_valid(struct device *dev, size_t table_len, u8 *table) +{ + struct onie_tlv crc_hdr; + u32 read_crc, calc_crc; + __be32 crc_be; + + memcpy(&crc_hdr, table + table_len - ONIE_TLV_CRC_FIELD_SZ, sizeof(crc_hdr)); + if (crc_hdr.type != 0xfe || crc_hdr.len != ONIE_TLV_CRC_SZ) { + dev_err(dev, "Invalid CRC field\n"); + return false; + } + + /* The table contains a JAMCRC, which is XOR'ed compared to the original + * CRC32 implementation as known in the Ethernet world. + */ + memcpy(&crc_be, table + table_len - ONIE_TLV_CRC_SZ, ONIE_TLV_CRC_SZ); + read_crc = be32_to_cpu(crc_be); + calc_crc = crc32(~0, table, table_len - ONIE_TLV_CRC_SZ) ^ 0xFFFFFFFF; + if (read_crc != calc_crc) { + dev_err(dev, "Invalid CRC read: 0x%08x, expected: 0x%08x\n", + read_crc, calc_crc); + return false; + } + + return true; +} + +static int onie_tlv_parse_table(struct device *dev, struct nvmem_device *nvmem, + struct nvmem_layout *layout) +{ + struct onie_tlv_hdr hdr; + size_t table_len, data_len, hdr_len; + u8 *table, *data; + int ret; + + ret = nvmem_device_read(nvmem, 0, sizeof(hdr), &hdr); + if (ret < 0) + return ret; + + if (!onie_tlv_hdr_is_valid(dev, &hdr)) { + dev_err(dev, "Invalid ONIE TLV header\n"); + return -EINVAL; + } + + hdr_len = sizeof(hdr.id) + sizeof(hdr.version) + sizeof(hdr.data_len); + data_len = be16_to_cpu(hdr.data_len); + table_len = hdr_len + data_len; + if (table_len > ONIE_TLV_MAX_LEN) { + dev_err(dev, "Invalid ONIE TLV data length\n"); + return -EINVAL; + } + + table = devm_kmalloc(dev, table_len, GFP_KERNEL); + if (!table) + return -ENOMEM; + + ret = nvmem_device_read(nvmem, 0, table_len, table); + if (ret != table_len) + goto free_data_buf; + + if (!onie_tlv_crc_is_valid(dev, table_len, table)) { + ret = -EINVAL; + goto free_data_buf; + } + + data = table + hdr_len; + ret = onie_tlv_add_cells(dev, nvmem, data_len, data); + if (ret) + goto free_data_buf; + +free_data_buf: + kfree(table); + + return ret; +} + +static const struct of_device_id onie_tlv_of_match_table[] = { + { .compatible = "onie,tlv-layout", }, + {}, +}; + +static struct nvmem_layout onie_tlv_layout = { + .name = "ONIE tlv layout", + .of_match_table = onie_tlv_of_match_table, + .add_cells = onie_tlv_parse_table, +}; + +static int __init onie_tlv_init(void) +{ + return nvmem_layout_register(&onie_tlv_layout); +} +subsys_initcall(onie_tlv_init); -- 2.30.2 From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id A6CC0C4332F for ; Fri, 18 Nov 2022 19:08:39 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender: Content-Transfer-Encoding:Content-Type:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To: Message-Id:Date:Subject:Cc:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=N4zSkBUlWDvuYE2lk/79oDvBIUj6wB3oQvP4KntQy2Q=; b=LGY81Uh2+0XkbC hxh14zyI7uxkR+oGKMVV9pzEDrAzGLaDSz7BPi2SEi7n96caWU6xYxzkoe1ZSVdrkYv+lKPuTmiEZ fJZzsZPyH/80Kcw4gFW+V3o1aZw3KNJYHJgp/Bbiyhb2dY5VrK3kz5TDzw07qeqQRK1rjMyUpU9Em mwXtmcQL9EWCFuOu8gEH5ssbfIveX2ZtULNK55b8cyf7GvVgJt99610InHgCF/WwCj8H/V0i1Uzxv 8Zz88R/IXBVA66tEtamFu70ODJTj/Z3+4uwoGCZPEdiZLMUMd4bSkCEK3VXLF8I6sF8PIHAnYyQjG EaZM9oXJPCj4+gagOVTA==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.94.2 #2 (Red Hat Linux)) id 1ow6hq-007R3U-6q; Fri, 18 Nov 2022 19:07:19 +0000 Received: from 0001.3ffe.de ([2a01:4f8:c0c:9d57::1] helo=mail.3ffe.de) by bombadil.infradead.org with esmtps (Exim 4.94.2 #2 (Red Hat Linux)) id 1ow6Si-007JVM-HZ for linux-arm-kernel@lists.infradead.org; Fri, 18 Nov 2022 18:51:47 +0000 Received: from mwalle01.kontron.local. (unknown [213.135.10.150]) (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits) key-exchange X25519 server-signature RSA-PSS (2048 bits) server-digest SHA256) (No client certificate requested) by mail.3ffe.de (Postfix) with ESMTPSA id C26AC277F; Fri, 18 Nov 2022 19:51:32 +0100 (CET) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=walle.cc; s=mail2022082101; t=1668797492; h=from:from:reply-to:subject:subject:date:date:message-id:message-id: to:to:cc:cc:mime-version:mime-version:content-type:content-type: content-transfer-encoding:content-transfer-encoding: in-reply-to:in-reply-to:references:references; bh=FaSJ44U+7PRi5aOuAd8PAZIxwlTe2OPizVGNy/EG1oI=; b=OMwQQqyDBmvxQWS7GZExHcB+dn1MS+0/yMolRMmngNcT2PkUSs3afhicaPl0B72g6yzNsd AKocKsHrAQbSAzQP/hXUduhEn5WZWRbEumVgt7lCN+F5+Xzr3yAHK+TNFtDTkuTW1SvKoc b5+BH2sSrGIX0W3PbwZOedhnUNdSYGeOW+I1G8fvjo0OkJpQhl4w+OQTV1l/EoTTzKOdwp xhJanChk+ZaxKsYYITo1nV/IJPaXXnWhwSfSx5qqCdUyaJZEQ4ud3y/dQYyFrITbMe5QFx PT+Q0SC3zTXjiL/LuDDI6I7a0FxtJ115nR0Yul1KPRGbeH7Ry1qn+vjq7LnZmQ== From: Michael Walle To: Jonathan Corbet , Srinivas Kandagatla , Miquel Raynal , Rob Herring , Frank Rowand Cc: linux-doc@vger.kernel.org, linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org, devicetree@vger.kernel.org Subject: [PATCH v3 17/18] nvmem: layouts: Add ONIE tlv layout driver Date: Fri, 18 Nov 2022 19:51:17 +0100 Message-Id: <20221118185118.1190044-18-michael@walle.cc> X-Mailer: git-send-email 2.30.2 In-Reply-To: <20221118185118.1190044-1-michael@walle.cc> References: <20221118185118.1190044-1-michael@walle.cc> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20221118_105140_865551_48F59065 X-CRM114-Status: GOOD ( 22.58 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: base64 Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org RnJvbTogTWlxdWVsIFJheW5hbCA8bWlxdWVsLnJheW5hbEBib290bGluLmNvbT4KClRoaXMgbGF5 b3V0IGFwcGxpZXMgbm8gdG9wIG9mIGFueSBub24gdm9sYXRpbGUgc3RvcmFnZSBkZXZpY2UgY29u dGFpbmluZwphbiBPTklFIHRhYmxlIGZhY3RvcnkgZmxhc2hlZC4gVGhpcyB0YWJsZSBmb2xsb3dz IHRoZSB0bHYKKHR5cGUtbGVuZ3RoLXZhbHVlKSBvcmdhbml6YXRpb24gZGVzY3JpYmVkIGluIHRo ZSBsaW5rIGJlbG93LiBXZSBjYW5ub3QKYWZmb3JkIHVzaW5nIHJlZ3VsYXIgcGFyc2VycyBiZWNh dXNlIHRoZSBjb250ZW50IG9mIHRoZXNlIHRhYmxlcyBpcwptYW51ZmFjdHVyZXIgc3BlY2lmaWMg YW5kIG11c3QgYmUgZHluYW1pY2FsbHkgZGlzY292ZXJlZC4KCkxpbms6IGh0dHBzOi8vb3BlbmNv bXB1dGVwcm9qZWN0LmdpdGh1Yi5pby9vbmllL2Rlc2lnbi1zcGVjL2h3X3JlcXVpcmVtZW50cy5o dG1sClNpZ25lZC1vZmYtYnk6IE1pcXVlbCBSYXluYWwgPG1pcXVlbC5yYXluYWxAYm9vdGxpbi5j b20+Ci0tLQpjaGFuZ2VzIHNpbmNlIHYyOgogLSBuZXcgcGF0Y2gKCiBkcml2ZXJzL252bWVtL2xh eW91dHMvS2NvbmZpZyAgICB8ICAgOSArKwogZHJpdmVycy9udm1lbS9sYXlvdXRzL01ha2VmaWxl ICAgfCAgIDEgKwogZHJpdmVycy9udm1lbS9sYXlvdXRzL29uaWUtdGx2LmMgfCAyNDkgKysrKysr KysrKysrKysrKysrKysrKysrKysrKysrKwogMyBmaWxlcyBjaGFuZ2VkLCAyNTkgaW5zZXJ0aW9u cygrKQogY3JlYXRlIG1vZGUgMTAwNjQ0IGRyaXZlcnMvbnZtZW0vbGF5b3V0cy9vbmllLXRsdi5j CgpkaWZmIC0tZ2l0IGEvZHJpdmVycy9udm1lbS9sYXlvdXRzL0tjb25maWcgYi9kcml2ZXJzL252 bWVtL2xheW91dHMvS2NvbmZpZwppbmRleCA3NTA4MmY2YjQ3MWQuLjlhZDUwNDc0Y2I3NyAxMDA2 NDQKLS0tIGEvZHJpdmVycy9udm1lbS9sYXlvdXRzL0tjb25maWcKKysrIGIvZHJpdmVycy9udm1l bS9sYXlvdXRzL0tjb25maWcKQEAgLTExLDQgKzExLDEzIEBAIGNvbmZpZyBOVk1FTV9MQVlPVVRf U0wyOF9WUEQKIAogCSAgSWYgdW5zdXJlLCBzYXkgTi4KIAorY29uZmlnIE5WTUVNX0xBWU9VVF9P TklFX1RMVgorCWJvb2wgIk9OSUUgdGx2IHN1cHBvcnQiCisJc2VsZWN0IENSQzMyCisJaGVscAor CSAgU2F5IFkgaGVyZSBpZiB5b3Ugd2FudCB0byBzdXBwb3J0IHRoZSBPcGVuIENvbXB1dGUgUHJv amVjdCBPTklFCisJICBUeXBlLUxlbmd0aC1WYWx1ZSBzdGFuZGFyZCB0YWJsZS4KKworCSAgSWYg dW5zdXJlLCBzYXkgTi4KKwogZW5kbWVudQpkaWZmIC0tZ2l0IGEvZHJpdmVycy9udm1lbS9sYXlv dXRzL01ha2VmaWxlIGIvZHJpdmVycy9udm1lbS9sYXlvdXRzL01ha2VmaWxlCmluZGV4IGZjNjE3 YjllODdkMC4uMjk3NGJkN2QzM2VkIDEwMDY0NAotLS0gYS9kcml2ZXJzL252bWVtL2xheW91dHMv TWFrZWZpbGUKKysrIGIvZHJpdmVycy9udm1lbS9sYXlvdXRzL01ha2VmaWxlCkBAIC00LDMgKzQs NCBAQAogIwogCiBvYmotJChDT05GSUdfTlZNRU1fTEFZT1VUX1NMMjhfVlBEKSArPSBzbDI4dnBk Lm8KK29iai0kKENPTkZJR19OVk1FTV9MQVlPVVRfT05JRV9UTFYpICs9IG9uaWUtdGx2Lm8KZGlm ZiAtLWdpdCBhL2RyaXZlcnMvbnZtZW0vbGF5b3V0cy9vbmllLXRsdi5jIGIvZHJpdmVycy9udm1l bS9sYXlvdXRzL29uaWUtdGx2LmMKbmV3IGZpbGUgbW9kZSAxMDA2NDQKaW5kZXggMDAwMDAwMDAw MDAwLi44NjkyM2MyZTMwNTIKLS0tIC9kZXYvbnVsbAorKysgYi9kcml2ZXJzL252bWVtL2xheW91 dHMvb25pZS10bHYuYwpAQCAtMCwwICsxLDI0OSBAQAorLy8gU1BEWC1MaWNlbnNlLUlkZW50aWZp ZXI6IEdQTC0yLjAtb25seQorLyoKKyAqIE9OSUUgdGx2IE5WTUVNIGNlbGxzIHByb3ZpZGVyCisg KgorICogQ29weXJpZ2h0IChDKSAyMDIyIE9wZW4gQ29tcHV0ZSBHcm91cCBPTklFCisgKiBBdXRo b3I6IE1pcXVlbCBSYXluYWwgPG1pcXVlbC5yYXluYWxAYm9vdGxpbi5jb20+CisgKiBCYXNlZCBv biB0aGUgbnZtZW0gZHJpdmVyIHdyaXR0ZW4gYnk6IFZhZHltIEtvY2hhbiA8dmFkeW0ua29jaGFu QHBsdmlzaW9uLmV1PgorICogSW5zcGlyZWQgYnkgdGhlIGZpcnN0IGxheW91dCB3cml0dGVuIGJ5 OiBSYWZhxYIgTWnFgmVja2kgPHJhZmFsQG1pbGVja2kucGw+CisgKi8KKworI2luY2x1ZGUgPGxp bnV4L2NyYzMyLmg+CisjaW5jbHVkZSA8bGludXgvZXRoZXJkZXZpY2UuaD4KKyNpbmNsdWRlIDxs aW51eC9udm1lbS1jb25zdW1lci5oPgorI2luY2x1ZGUgPGxpbnV4L252bWVtLXByb3ZpZGVyLmg+ CisjaW5jbHVkZSA8bGludXgvb2YuaD4KKworI2RlZmluZSBPTklFX1RMVl9NQVhfTEVOIDIwNDgK KyNkZWZpbmUgT05JRV9UTFZfQ1JDX0ZJRUxEX1NaIDYKKyNkZWZpbmUgT05JRV9UTFZfQ1JDX1Na IDQKKyNkZWZpbmUgT05JRV9UTFZfSERSX0lECSJUbHZJbmZvIgorCitzdHJ1Y3Qgb25pZV90bHZf aGRyIHsKKwl1OCBpZFs4XTsKKwl1OCB2ZXJzaW9uOworCV9fYmUxNiBkYXRhX2xlbjsKK30gX19w YWNrZWQ7CisKK3N0cnVjdCBvbmllX3RsdiB7CisJdTggdHlwZTsKKwl1OCBsZW47Cit9IF9fcGFj a2VkOworCitzdGF0aWMgY29uc3QgY2hhciAqb25pZV90bHZfY2VsbF9uYW1lKHU4IHR5cGUpCit7 CisJc3dpdGNoICh0eXBlKSB7CisJY2FzZSAweDIxOgorCQlyZXR1cm4gInByb2R1Y3QtbmFtZSI7 CisJY2FzZSAweDIyOgorCQlyZXR1cm4gInBhcnQtbnVtYmVyIjsKKwljYXNlIDB4MjM6CisJCXJl dHVybiAic2VyaWFsLW51bWJlciI7CisJY2FzZSAweDI0OgorCQlyZXR1cm4gIm1hYy1hZGRyZXNz IjsKKwljYXNlIDB4MjU6CisJCXJldHVybiAibWFudWZhY3R1cmUtZGF0ZSI7CisJY2FzZSAweDI2 OgorCQlyZXR1cm4gImRldmljZS12ZXJzaW9uIjsKKwljYXNlIDB4Mjc6CisJCXJldHVybiAibGFi ZWwtcmV2aXNpb24iOworCWNhc2UgMHgyODoKKwkJcmV0dXJuICJwbGF0Zm9ybi1uYW1lIjsKKwlj YXNlIDB4Mjk6CisJCXJldHVybiAib25pZS12ZXJzaW9uIjsKKwljYXNlIDB4MkE6CisJCXJldHVy biAibnVtLW1hY3MiOworCWNhc2UgMHgyQjoKKwkJcmV0dXJuICJtYW51ZmFjdHVyZXIiOworCWNh c2UgMHgyQzoKKwkJcmV0dXJuICJjb3VudHJ5LWNvZGUiOworCWNhc2UgMHgyRDoKKwkJcmV0dXJu ICJ2ZW5kb3IiOworCWNhc2UgMHgyRToKKwkJcmV0dXJuICJkaWFnLXZlcnNpb24iOworCWNhc2Ug MHgyRjoKKwkJcmV0dXJuICJzZXJ2aWNlLXRhZyI7CisJY2FzZSAweEZEOgorCQlyZXR1cm4gInZl bmRvci1leHRlbnNpb24iOworCWNhc2UgMHhGRToKKwkJcmV0dXJuICJjcmMzMiI7CisJZGVmYXVs dDoKKwkJYnJlYWs7CisJfQorCisJcmV0dXJuIE5VTEw7Cit9CisKK3N0YXRpYyBpbnQgb25pZV90 bHZfbWFjX3JlYWRfY2Iodm9pZCAqcHJpdiwgY29uc3QgY2hhciAqaWQsIGludCBpbmRleCwKKwkJ CQl1bnNpZ25lZCBpbnQgb2Zmc2V0LCB2b2lkICpidWYsCisJCQkJc2l6ZV90IGJ5dGVzKQorewor CWV0aF9hZGRyX2FkZChidWYsIGluZGV4KTsKKworCXJldHVybiAwOworfQorCitzdGF0aWMgbnZt ZW1fY2VsbF9wb3N0X3Byb2Nlc3NfdCBvbmllX3Rsdl9yZWFkX2NiKHU4IHR5cGUsIHU4ICpidWYp Cit7CisJc3dpdGNoICh0eXBlKSB7CisJY2FzZSAweDI0OgorCQlyZXR1cm4gJm9uaWVfdGx2X21h Y19yZWFkX2NiOworCWRlZmF1bHQ6CisJCWJyZWFrOworCX0KKworCXJldHVybiBOVUxMOworfQor CitzdGF0aWMgaW50IG9uaWVfdGx2X2FkZF9jZWxscyhzdHJ1Y3QgZGV2aWNlICpkZXYsIHN0cnVj dCBudm1lbV9kZXZpY2UgKm52bWVtLAorCQkJICAgICAgc2l6ZV90IGRhdGFfbGVuLCB1OCAqZGF0 YSkKK3sKKwlzdHJ1Y3QgbnZtZW1fY2VsbF9pbmZvIGNlbGwgPSB7fTsKKwlzdHJ1Y3QgZGV2aWNl X25vZGUgKmxheW91dDsKKwlzdHJ1Y3Qgb25pZV90bHYgdGx2OworCXVuc2lnbmVkIGludCBoZHJf bGVuID0gc2l6ZW9mKHN0cnVjdCBvbmllX3Rsdl9oZHIpOworCXVuc2lnbmVkIGludCBvZmZzZXQg PSAwOworCWludCByZXQ7CisKKwlsYXlvdXQgPSBvZl9udm1lbV9sYXlvdXRfZ2V0X2NvbnRhaW5l cihudm1lbSk7CisJaWYgKCFsYXlvdXQpCisJCXJldHVybiAtRU5PRU5UOworCisJd2hpbGUgKG9m ZnNldCA8IGRhdGFfbGVuKSB7CisJCW1lbWNweSgmdGx2LCBkYXRhICsgb2Zmc2V0LCBzaXplb2Yo dGx2KSk7CisJCWlmIChvZmZzZXQgKyB0bHYubGVuID49IGRhdGFfbGVuKSB7CisJCQlkZXZfZXJy KGRldiwgIk91dCBvZiBib3VuZHMgZmllbGQgKDB4JXggYnl0ZXMgYXQgMHgleClcbiIsCisJCQkJ dGx2LmxlbiwgaGRyX2xlbiArIG9mZnNldCk7CisJCQlicmVhazsKKwkJfQorCisJCWNlbGwubmFt ZSA9IG9uaWVfdGx2X2NlbGxfbmFtZSh0bHYudHlwZSk7CisJCWlmICghY2VsbC5uYW1lKQorCQkJ Y29udGludWU7CisKKwkJY2VsbC5vZmZzZXQgPSBoZHJfbGVuICsgb2Zmc2V0ICsgc2l6ZW9mKHRs di50eXBlKSArIHNpemVvZih0bHYubGVuKTsKKwkJY2VsbC5ieXRlcyA9IHRsdi5sZW47CisJCWNl bGwubnAgPSBvZl9nZXRfY2hpbGRfYnlfbmFtZShsYXlvdXQsIGNlbGwubmFtZSk7CisJCWNlbGwu cmVhZF9wb3N0X3Byb2Nlc3MgPSBvbmllX3Rsdl9yZWFkX2NiKHRsdi50eXBlLCBkYXRhICsgb2Zm c2V0ICsgc2l6ZW9mKHRsdikpOworCisJCXJldCA9IG52bWVtX2FkZF9vbmVfY2VsbChudm1lbSwg JmNlbGwpOworCQlpZiAocmV0KSB7CisJCQlvZl9ub2RlX3B1dChsYXlvdXQpOworCQkJcmV0dXJu IHJldDsKKwkJfQorCisJCW9mZnNldCArPSBzaXplb2YodGx2KSArIHRsdi5sZW47CisJfQorCisJ b2Zfbm9kZV9wdXQobGF5b3V0KTsKKworCXJldHVybiAwOworfQorCitzdGF0aWMgYm9vbCBvbmll X3Rsdl9oZHJfaXNfdmFsaWQoc3RydWN0IGRldmljZSAqZGV2LCBzdHJ1Y3Qgb25pZV90bHZfaGRy ICpoZHIpCit7CisJaWYgKG1lbWNtcChoZHItPmlkLCBPTklFX1RMVl9IRFJfSUQsIHNpemVvZiho ZHItPmlkKSkpIHsKKwkJZGV2X2VycihkZXYsICJJbnZhbGlkIGhlYWRlclxuIik7CisJCXJldHVy biBmYWxzZTsKKwl9CisKKwlpZiAoaGRyLT52ZXJzaW9uICE9IDB4MSkgeworCQlkZXZfZXJyKGRl diwgIkludmFsaWQgdmVyc2lvbiBudW1iZXJcbiIpOworCQlyZXR1cm4gZmFsc2U7CisJfQorCisJ cmV0dXJuIHRydWU7Cit9CisKK3N0YXRpYyBib29sIG9uaWVfdGx2X2NyY19pc192YWxpZChzdHJ1 Y3QgZGV2aWNlICpkZXYsIHNpemVfdCB0YWJsZV9sZW4sIHU4ICp0YWJsZSkKK3sKKwlzdHJ1Y3Qg b25pZV90bHYgY3JjX2hkcjsKKwl1MzIgcmVhZF9jcmMsIGNhbGNfY3JjOworCV9fYmUzMiBjcmNf YmU7CisKKwltZW1jcHkoJmNyY19oZHIsIHRhYmxlICsgdGFibGVfbGVuIC0gT05JRV9UTFZfQ1JD X0ZJRUxEX1NaLCBzaXplb2YoY3JjX2hkcikpOworCWlmIChjcmNfaGRyLnR5cGUgIT0gMHhmZSB8 fCBjcmNfaGRyLmxlbiAhPSBPTklFX1RMVl9DUkNfU1opIHsKKwkJZGV2X2VycihkZXYsICJJbnZh bGlkIENSQyBmaWVsZFxuIik7CisJCXJldHVybiBmYWxzZTsKKwl9CisKKwkvKiBUaGUgdGFibGUg Y29udGFpbnMgYSBKQU1DUkMsIHdoaWNoIGlzIFhPUidlZCBjb21wYXJlZCB0byB0aGUgb3JpZ2lu YWwKKwkgKiBDUkMzMiBpbXBsZW1lbnRhdGlvbiBhcyBrbm93biBpbiB0aGUgRXRoZXJuZXQgd29y bGQuCisJICovCisJbWVtY3B5KCZjcmNfYmUsIHRhYmxlICsgdGFibGVfbGVuIC0gT05JRV9UTFZf Q1JDX1NaLCBPTklFX1RMVl9DUkNfU1opOworCXJlYWRfY3JjID0gYmUzMl90b19jcHUoY3JjX2Jl KTsKKwljYWxjX2NyYyA9IGNyYzMyKH4wLCB0YWJsZSwgdGFibGVfbGVuIC0gT05JRV9UTFZfQ1JD X1NaKSBeIDB4RkZGRkZGRkY7CisJaWYgKHJlYWRfY3JjICE9IGNhbGNfY3JjKSB7CisJCWRldl9l cnIoZGV2LCAiSW52YWxpZCBDUkMgcmVhZDogMHglMDh4LCBleHBlY3RlZDogMHglMDh4XG4iLAor CQkJcmVhZF9jcmMsIGNhbGNfY3JjKTsKKwkJcmV0dXJuIGZhbHNlOworCX0KKworCXJldHVybiB0 cnVlOworfQorCitzdGF0aWMgaW50IG9uaWVfdGx2X3BhcnNlX3RhYmxlKHN0cnVjdCBkZXZpY2Ug KmRldiwgc3RydWN0IG52bWVtX2RldmljZSAqbnZtZW0sCisJCQkJc3RydWN0IG52bWVtX2xheW91 dCAqbGF5b3V0KQoreworCXN0cnVjdCBvbmllX3Rsdl9oZHIgaGRyOworCXNpemVfdCB0YWJsZV9s ZW4sIGRhdGFfbGVuLCBoZHJfbGVuOworCXU4ICp0YWJsZSwgKmRhdGE7CisJaW50IHJldDsKKwor CXJldCA9IG52bWVtX2RldmljZV9yZWFkKG52bWVtLCAwLCBzaXplb2YoaGRyKSwgJmhkcik7CisJ aWYgKHJldCA8IDApCisJCXJldHVybiByZXQ7CisKKwlpZiAoIW9uaWVfdGx2X2hkcl9pc192YWxp ZChkZXYsICZoZHIpKSB7CisJCWRldl9lcnIoZGV2LCAiSW52YWxpZCBPTklFIFRMViBoZWFkZXJc biIpOworCQlyZXR1cm4gLUVJTlZBTDsKKwl9CisKKwloZHJfbGVuID0gc2l6ZW9mKGhkci5pZCkg KyBzaXplb2YoaGRyLnZlcnNpb24pICsgc2l6ZW9mKGhkci5kYXRhX2xlbik7CisJZGF0YV9sZW4g PSBiZTE2X3RvX2NwdShoZHIuZGF0YV9sZW4pOworCXRhYmxlX2xlbiA9IGhkcl9sZW4gKyBkYXRh X2xlbjsKKwlpZiAodGFibGVfbGVuID4gT05JRV9UTFZfTUFYX0xFTikgeworCQlkZXZfZXJyKGRl diwgIkludmFsaWQgT05JRSBUTFYgZGF0YSBsZW5ndGhcbiIpOworCQlyZXR1cm4gLUVJTlZBTDsK Kwl9CisKKwl0YWJsZSA9IGRldm1fa21hbGxvYyhkZXYsIHRhYmxlX2xlbiwgR0ZQX0tFUk5FTCk7 CisJaWYgKCF0YWJsZSkKKwkJcmV0dXJuIC1FTk9NRU07CisKKwlyZXQgPSBudm1lbV9kZXZpY2Vf cmVhZChudm1lbSwgMCwgdGFibGVfbGVuLCB0YWJsZSk7CisJaWYgKHJldCAhPSB0YWJsZV9sZW4p CisJCWdvdG8gZnJlZV9kYXRhX2J1ZjsKKworCWlmICghb25pZV90bHZfY3JjX2lzX3ZhbGlkKGRl diwgdGFibGVfbGVuLCB0YWJsZSkpIHsKKwkJcmV0ID0gLUVJTlZBTDsKKwkJZ290byBmcmVlX2Rh dGFfYnVmOworCX0KKworCWRhdGEgPSB0YWJsZSArIGhkcl9sZW47CisJcmV0ID0gb25pZV90bHZf YWRkX2NlbGxzKGRldiwgbnZtZW0sIGRhdGFfbGVuLCBkYXRhKTsKKwlpZiAocmV0KQorCQlnb3Rv IGZyZWVfZGF0YV9idWY7CisKK2ZyZWVfZGF0YV9idWY6CisJa2ZyZWUodGFibGUpOworCisJcmV0 dXJuIHJldDsKK30KKworc3RhdGljIGNvbnN0IHN0cnVjdCBvZl9kZXZpY2VfaWQgb25pZV90bHZf b2ZfbWF0Y2hfdGFibGVbXSA9IHsKKwl7IC5jb21wYXRpYmxlID0gIm9uaWUsdGx2LWxheW91dCIs IH0sCisJe30sCit9OworCitzdGF0aWMgc3RydWN0IG52bWVtX2xheW91dCBvbmllX3Rsdl9sYXlv dXQgPSB7CisJLm5hbWUgPSAiT05JRSB0bHYgbGF5b3V0IiwKKwkub2ZfbWF0Y2hfdGFibGUgPSBv bmllX3Rsdl9vZl9tYXRjaF90YWJsZSwKKwkuYWRkX2NlbGxzID0gb25pZV90bHZfcGFyc2VfdGFi bGUsCit9OworCitzdGF0aWMgaW50IF9faW5pdCBvbmllX3Rsdl9pbml0KHZvaWQpCit7CisJcmV0 dXJuIG52bWVtX2xheW91dF9yZWdpc3Rlcigmb25pZV90bHZfbGF5b3V0KTsKK30KK3N1YnN5c19p bml0Y2FsbChvbmllX3Rsdl9pbml0KTsKLS0gCjIuMzAuMgoKCl9fX19fX19fX19fX19fX19fX19f X19fX19fX19fX19fX19fX19fX19fX19fX19fCmxpbnV4LWFybS1rZXJuZWwgbWFpbGluZyBsaXN0 CmxpbnV4LWFybS1rZXJuZWxAbGlzdHMuaW5mcmFkZWFkLm9yZwpodHRwOi8vbGlzdHMuaW5mcmFk ZWFkLm9yZy9tYWlsbWFuL2xpc3RpbmZvL2xpbnV4LWFybS1rZXJuZWwK