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 X-Spam-Level: X-Spam-Status: No, score=-16.6 required=3.0 tests=DKIMWL_WL_MED,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_PATCH, MAILING_LIST_MULTI,SIGNED_OFF_BY,SPF_PASS,USER_AGENT_GIT,USER_IN_DEF_DKIM_WL autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 9572DC282C0 for ; Wed, 23 Jan 2019 20:57:35 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id 4BE55218A1 for ; Wed, 23 Jan 2019 20:57:35 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (2048-bit key) header.d=google.com header.i=@google.com header.b="tlzkQDI8" Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1726694AbfAWU5d (ORCPT ); Wed, 23 Jan 2019 15:57:33 -0500 Received: from mail-vs1-f74.google.com ([209.85.217.74]:36687 "EHLO mail-vs1-f74.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1726322AbfAWU5c (ORCPT ); Wed, 23 Jan 2019 15:57:32 -0500 Received: by mail-vs1-f74.google.com with SMTP id r133so1306079vsc.3 for ; Wed, 23 Jan 2019 12:57:31 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=20161025; h=date:in-reply-to:message-id:mime-version:references:subject:from:to :cc; bh=66N0nnVy7ZeFP1SFsZPBRguoq/ldZpv35aMOmW31chg=; b=tlzkQDI8+8AB5azQXeDGuNm6veoYP9zWn2BhPDZnxYjaWrlBFQppyVEWx1QkYS85k6 IygNYRfuhGdYy5aap5OlpxJz1UmT23SidjQlRDlcbBItKcr7ZkJv0KvCT++pz2uWMVIo 5o167QWlZ/oU16oOVSmeZei+aCu9U5eG7kvCm6YZ+N8Oq6Xp5kdi/lJIVp9DKeRxpt9A L7o51ufTgWdq0H5XX7ss6pAR3uK+T6pV+Xj9mKPYNjDWln5LMwSO5p1lUe0yw+ylv0kt 7seMiDbNukqzGDuEcMVnj+fp62QF4b+VOUhFNyuUNBSY6/AhB2Jv3zTXBEb4SaljkwMY TSwg== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:date:in-reply-to:message-id:mime-version :references:subject:from:to:cc; bh=66N0nnVy7ZeFP1SFsZPBRguoq/ldZpv35aMOmW31chg=; b=qKoahHmtlJcZNBdUTcB/L/C4rEv8wqeq3cSqqb/vGnXw5wIonnotNCnar7umdodOPE jy2ZbyaJ9+rWX692DQ5+pvONTVja0xOREooo6UViYJ0VKdKO7FC3LTkmOzxybp8uFmvh zYntEITMZ+4EBS45ow0ZKGvW1XHW7V/Tgic4j9l4p6FRiiuaFVJx41ht4RZDud6VLMVc bXVFzbXlaFn42F8cm64ByZ4157GvzxNlGTkzzdouec2lL5lqi6JUwwrRyYhLWyCMsM7r td4ce6tR989ng/bt4obyEm05+GhOT1++Bfnh9yvsi4h3939ihtSGqK4Kmf6VnAfh9AmU PcGQ== X-Gm-Message-State: AJcUukfjxYCTk+p/7mOVyCHX7Adi2JjsoK2lMbSgp+KiNE0GMeQwS9Zp Wa5q88nKa/2PRpjvsN32PDd65U8LrVxv X-Google-Smtp-Source: ALg8bN5xc2h05A/VYfCqaHxF8KwkVT3SaJ7TWLCck9Rjba8cSJhAzC4zTTtPfx0XsOwng+tJDM+puWr9vRhT X-Received: by 2002:a1f:91d4:: with SMTP id t203mr2948783vkd.2.1548277051177; Wed, 23 Jan 2019 12:57:31 -0800 (PST) Date: Wed, 23 Jan 2019 12:57:22 -0800 In-Reply-To: <20181117010748.24347-1-rajatja@google.com> Message-Id: <20190123205725.239661-1-rajatja@google.com> Mime-Version: 1.0 References: <20181117010748.24347-1-rajatja@google.com> X-Mailer: git-send-email 2.20.1.321.g9e740568ce-goog Subject: [PATCH v5 1/4] usb: split code locating ACPI companion into port and device From: Rajat Jain To: Marcel Holtmann , Johan Hedberg , Greg Kroah-Hartman , "David S. Miller" , Dmitry Torokhov , Rajat Jain , Alex Hung , linux-bluetooth@vger.kernel.org, linux-kernel@vger.kernel.org, linux-usb@vger.kernel.org, netdev@vger.kernel.org Cc: rajatxjain@gmail.com, dtor@google.com, raghuram.hegde@intel.com, chethan.tumkur.narayan@intel.com, sukumar.ghorai@intel.com Content-Type: text/plain; charset="UTF-8" Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org From: Dmitry Torokhov In preparation for handling embedded USB devices let's split usb_acpi_find_companion() into usb_acpi_find_companion_for_device() and usb_acpi_find_companion_for_port(). Signed-off-by: Dmitry Torokhov Signed-off-by: Rajat Jain Acked-by: Greg Kroah-Hartman Tested-by: Sukumar Ghorai --- v5: same as v4 v4: Add Acked-by and Tested-by in signatures. v3: same as v1 v2: same as v1 drivers/usb/core/usb-acpi.c | 133 +++++++++++++++++++----------------- 1 file changed, 72 insertions(+), 61 deletions(-) diff --git a/drivers/usb/core/usb-acpi.c b/drivers/usb/core/usb-acpi.c index e221861b3187..8ff73c83e8e8 100644 --- a/drivers/usb/core/usb-acpi.c +++ b/drivers/usb/core/usb-acpi.c @@ -139,12 +139,79 @@ static struct acpi_device *usb_acpi_find_port(struct acpi_device *parent, return acpi_find_child_device(parent, raw, false); } -static struct acpi_device *usb_acpi_find_companion(struct device *dev) +static struct acpi_device * +usb_acpi_get_companion_for_port(struct usb_port *port_dev) { struct usb_device *udev; struct acpi_device *adev; acpi_handle *parent_handle; + int port1; + + /* Get the struct usb_device point of port's hub */ + udev = to_usb_device(port_dev->dev.parent->parent); + + /* + * The root hub ports' parent is the root hub. The non-root-hub + * ports' parent is the parent hub port which the hub is + * connected to. + */ + if (!udev->parent) { + adev = ACPI_COMPANION(&udev->dev); + port1 = usb_hcd_find_raw_port_number(bus_to_hcd(udev->bus), + port_dev->portnum); + } else { + parent_handle = usb_get_hub_port_acpi_handle(udev->parent, + udev->portnum); + if (!parent_handle) + return NULL; + + acpi_bus_get_device(parent_handle, &adev); + port1 = port_dev->portnum; + } + + return usb_acpi_find_port(adev, port1); +} + +static struct acpi_device * +usb_acpi_find_companion_for_port(struct usb_port *port_dev) +{ + struct acpi_device *adev; + struct acpi_pld_info *pld; + acpi_handle *handle; + acpi_status status; + + adev = usb_acpi_get_companion_for_port(port_dev); + if (!adev) + return NULL; + + handle = adev->handle; + status = acpi_get_physical_device_location(handle, &pld); + if (!ACPI_FAILURE(status) && pld) { + port_dev->location = USB_ACPI_LOCATION_VALID + | pld->group_token << 8 | pld->group_position; + port_dev->connect_type = usb_acpi_get_connect_type(handle, pld); + ACPI_FREE(pld); + } + return adev; +} + +static struct acpi_device * +usb_acpi_find_companion_for_device(struct usb_device *udev) +{ + struct acpi_device *adev; + + if (!udev->parent) + return NULL; + + /* root hub is only child (_ADR=0) under its parent, the HC */ + adev = ACPI_COMPANION(udev->dev.parent); + return acpi_find_child_device(adev, 0, false); +} + + +static struct acpi_device *usb_acpi_find_companion(struct device *dev) +{ /* * In the ACPI DSDT table, only usb root hub and usb ports are * acpi device nodes. The hierarchy like following. @@ -158,66 +225,10 @@ static struct acpi_device *usb_acpi_find_companion(struct device *dev) * So all binding process is divided into two parts. binding * root hub and usb ports. */ - if (is_usb_device(dev)) { - udev = to_usb_device(dev); - if (udev->parent) - return NULL; - - /* root hub is only child (_ADR=0) under its parent, the HC */ - adev = ACPI_COMPANION(dev->parent); - return acpi_find_child_device(adev, 0, false); - } else if (is_usb_port(dev)) { - struct usb_port *port_dev = to_usb_port(dev); - int port1 = port_dev->portnum; - struct acpi_pld_info *pld; - acpi_handle *handle; - acpi_status status; - - /* Get the struct usb_device point of port's hub */ - udev = to_usb_device(dev->parent->parent); - - /* - * The root hub ports' parent is the root hub. The non-root-hub - * ports' parent is the parent hub port which the hub is - * connected to. - */ - if (!udev->parent) { - struct usb_hcd *hcd = bus_to_hcd(udev->bus); - int raw; - - raw = usb_hcd_find_raw_port_number(hcd, port1); - - adev = usb_acpi_find_port(ACPI_COMPANION(&udev->dev), - raw); - - if (!adev) - return NULL; - } else { - parent_handle = - usb_get_hub_port_acpi_handle(udev->parent, - udev->portnum); - if (!parent_handle) - return NULL; - - acpi_bus_get_device(parent_handle, &adev); - - adev = usb_acpi_find_port(adev, port1); - - if (!adev) - return NULL; - } - handle = adev->handle; - status = acpi_get_physical_device_location(handle, &pld); - if (ACPI_FAILURE(status) || !pld) - return adev; - - port_dev->location = USB_ACPI_LOCATION_VALID - | pld->group_token << 8 | pld->group_position; - port_dev->connect_type = usb_acpi_get_connect_type(handle, pld); - ACPI_FREE(pld); - - return adev; - } + if (is_usb_device(dev)) + return usb_acpi_find_companion_for_device(to_usb_device(dev)); + else if (is_usb_port(dev)) + return usb_acpi_find_companion_for_port(to_usb_port(dev)); return NULL; } -- 2.20.1.321.g9e740568ce-goog From mboxrd@z Thu Jan 1 00:00:00 1970 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: base64 Subject: [v5,1/4] usb: split code locating ACPI companion into port and device From: Rajat Jain Message-Id: <20190123205725.239661-1-rajatja@google.com> Date: Wed, 23 Jan 2019 12:57:22 -0800 To: Marcel Holtmann , Johan Hedberg , Greg Kroah-Hartman , "David S. Miller" , Dmitry Torokhov , Rajat Jain , Alex Hung , linux-bluetooth@vger.kernel.org, linux-kernel@vger.kernel.org, linux-usb@vger.kernel.org, netdev@vger.kernel.org Cc: rajatxjain@gmail.com, dtor@google.com, raghuram.hegde@intel.com, chethan.tumkur.narayan@intel.com, sukumar.ghorai@intel.com List-ID: RnJvbTogRG1pdHJ5IFRvcm9raG92IDxkdG9yQGNocm9taXVtLm9yZz4KCkluIHByZXBhcmF0aW9u IGZvciBoYW5kbGluZyBlbWJlZGRlZCBVU0IgZGV2aWNlcyBsZXQncyBzcGxpdAp1c2JfYWNwaV9m aW5kX2NvbXBhbmlvbigpIGludG8gdXNiX2FjcGlfZmluZF9jb21wYW5pb25fZm9yX2RldmljZSgp IGFuZAp1c2JfYWNwaV9maW5kX2NvbXBhbmlvbl9mb3JfcG9ydCgpLgoKU2lnbmVkLW9mZi1ieTog RG1pdHJ5IFRvcm9raG92IDxkdG9yQGNocm9taXVtLm9yZz4KU2lnbmVkLW9mZi1ieTogUmFqYXQg SmFpbiA8cmFqYXRqYUBnb29nbGUuY29tPgpBY2tlZC1ieTogR3JlZyBLcm9haC1IYXJ0bWFuIDxn cmVna2hAbGludXhmb3VuZGF0aW9uLm9yZz4KVGVzdGVkLWJ5OiBTdWt1bWFyIEdob3JhaSA8c3Vr dW1hci5naG9yYWlAaW50ZWwuY29tPgotLS0KdjU6IHNhbWUgYXMgdjQKdjQ6IEFkZCBBY2tlZC1i eSBhbmQgVGVzdGVkLWJ5IGluIHNpZ25hdHVyZXMuCnYzOiBzYW1lIGFzIHYxCnYyOiBzYW1lIGFz IHYxCgogZHJpdmVycy91c2IvY29yZS91c2ItYWNwaS5jIHwgMTMzICsrKysrKysrKysrKysrKysr KystLS0tLS0tLS0tLS0tLS0tLQogMSBmaWxlIGNoYW5nZWQsIDcyIGluc2VydGlvbnMoKyksIDYx IGRlbGV0aW9ucygtKQoKZGlmZiAtLWdpdCBhL2RyaXZlcnMvdXNiL2NvcmUvdXNiLWFjcGkuYyBi L2RyaXZlcnMvdXNiL2NvcmUvdXNiLWFjcGkuYwppbmRleCBlMjIxODYxYjMxODcuLjhmZjczYzgz ZThlOCAxMDA2NDQKLS0tIGEvZHJpdmVycy91c2IvY29yZS91c2ItYWNwaS5jCisrKyBiL2RyaXZl cnMvdXNiL2NvcmUvdXNiLWFjcGkuYwpAQCAtMTM5LDEyICsxMzksNzkgQEAgc3RhdGljIHN0cnVj dCBhY3BpX2RldmljZSAqdXNiX2FjcGlfZmluZF9wb3J0KHN0cnVjdCBhY3BpX2RldmljZSAqcGFy ZW50LAogCXJldHVybiBhY3BpX2ZpbmRfY2hpbGRfZGV2aWNlKHBhcmVudCwgcmF3LCBmYWxzZSk7 CiB9CiAKLXN0YXRpYyBzdHJ1Y3QgYWNwaV9kZXZpY2UgKnVzYl9hY3BpX2ZpbmRfY29tcGFuaW9u KHN0cnVjdCBkZXZpY2UgKmRldikKK3N0YXRpYyBzdHJ1Y3QgYWNwaV9kZXZpY2UgKgordXNiX2Fj cGlfZ2V0X2NvbXBhbmlvbl9mb3JfcG9ydChzdHJ1Y3QgdXNiX3BvcnQgKnBvcnRfZGV2KQogewog CXN0cnVjdCB1c2JfZGV2aWNlICp1ZGV2OwogCXN0cnVjdCBhY3BpX2RldmljZSAqYWRldjsKIAlh Y3BpX2hhbmRsZSAqcGFyZW50X2hhbmRsZTsKKwlpbnQgcG9ydDE7CisKKwkvKiBHZXQgdGhlIHN0 cnVjdCB1c2JfZGV2aWNlIHBvaW50IG9mIHBvcnQncyBodWIgKi8KKwl1ZGV2ID0gdG9fdXNiX2Rl dmljZShwb3J0X2Rldi0+ZGV2LnBhcmVudC0+cGFyZW50KTsKKworCS8qCisJICogVGhlIHJvb3Qg aHViIHBvcnRzJyBwYXJlbnQgaXMgdGhlIHJvb3QgaHViLiBUaGUgbm9uLXJvb3QtaHViCisJICog cG9ydHMnIHBhcmVudCBpcyB0aGUgcGFyZW50IGh1YiBwb3J0IHdoaWNoIHRoZSBodWIgaXMKKwkg KiBjb25uZWN0ZWQgdG8uCisJICovCisJaWYgKCF1ZGV2LT5wYXJlbnQpIHsKKwkJYWRldiA9IEFD UElfQ09NUEFOSU9OKCZ1ZGV2LT5kZXYpOworCQlwb3J0MSA9IHVzYl9oY2RfZmluZF9yYXdfcG9y dF9udW1iZXIoYnVzX3RvX2hjZCh1ZGV2LT5idXMpLAorCQkJCQkJICAgICBwb3J0X2Rldi0+cG9y dG51bSk7CisJfSBlbHNlIHsKKwkJcGFyZW50X2hhbmRsZSA9IHVzYl9nZXRfaHViX3BvcnRfYWNw aV9oYW5kbGUodWRldi0+cGFyZW50LAorCQkJCQkJCSAgICAgdWRldi0+cG9ydG51bSk7CisJCWlm ICghcGFyZW50X2hhbmRsZSkKKwkJCXJldHVybiBOVUxMOworCisJCWFjcGlfYnVzX2dldF9kZXZp Y2UocGFyZW50X2hhbmRsZSwgJmFkZXYpOworCQlwb3J0MSA9IHBvcnRfZGV2LT5wb3J0bnVtOwor CX0KKworCXJldHVybiB1c2JfYWNwaV9maW5kX3BvcnQoYWRldiwgcG9ydDEpOworfQorCitzdGF0 aWMgc3RydWN0IGFjcGlfZGV2aWNlICoKK3VzYl9hY3BpX2ZpbmRfY29tcGFuaW9uX2Zvcl9wb3J0 KHN0cnVjdCB1c2JfcG9ydCAqcG9ydF9kZXYpCit7CisJc3RydWN0IGFjcGlfZGV2aWNlICphZGV2 OworCXN0cnVjdCBhY3BpX3BsZF9pbmZvICpwbGQ7CisJYWNwaV9oYW5kbGUgKmhhbmRsZTsKKwlh Y3BpX3N0YXR1cyBzdGF0dXM7CisKKwlhZGV2ID0gdXNiX2FjcGlfZ2V0X2NvbXBhbmlvbl9mb3Jf cG9ydChwb3J0X2Rldik7CisJaWYgKCFhZGV2KQorCQlyZXR1cm4gTlVMTDsKKworCWhhbmRsZSA9 IGFkZXYtPmhhbmRsZTsKKwlzdGF0dXMgPSBhY3BpX2dldF9waHlzaWNhbF9kZXZpY2VfbG9jYXRp b24oaGFuZGxlLCAmcGxkKTsKKwlpZiAoIUFDUElfRkFJTFVSRShzdGF0dXMpICYmIHBsZCkgewor CQlwb3J0X2Rldi0+bG9jYXRpb24gPSBVU0JfQUNQSV9MT0NBVElPTl9WQUxJRAorCQkJfCBwbGQt Pmdyb3VwX3Rva2VuIDw8IDggfCBwbGQtPmdyb3VwX3Bvc2l0aW9uOworCQlwb3J0X2Rldi0+Y29u bmVjdF90eXBlID0gdXNiX2FjcGlfZ2V0X2Nvbm5lY3RfdHlwZShoYW5kbGUsIHBsZCk7CisJCUFD UElfRlJFRShwbGQpOworCX0KIAorCXJldHVybiBhZGV2OworfQorCitzdGF0aWMgc3RydWN0IGFj cGlfZGV2aWNlICoKK3VzYl9hY3BpX2ZpbmRfY29tcGFuaW9uX2Zvcl9kZXZpY2Uoc3RydWN0IHVz Yl9kZXZpY2UgKnVkZXYpCit7CisJc3RydWN0IGFjcGlfZGV2aWNlICphZGV2OworCisJaWYgKCF1 ZGV2LT5wYXJlbnQpCisJCXJldHVybiBOVUxMOworCisJLyogcm9vdCBodWIgaXMgb25seSBjaGls ZCAoX0FEUj0wKSB1bmRlciBpdHMgcGFyZW50LCB0aGUgSEMgKi8KKwlhZGV2ID0gQUNQSV9DT01Q QU5JT04odWRldi0+ZGV2LnBhcmVudCk7CisJcmV0dXJuIGFjcGlfZmluZF9jaGlsZF9kZXZpY2Uo YWRldiwgMCwgZmFsc2UpOworfQorCisKK3N0YXRpYyBzdHJ1Y3QgYWNwaV9kZXZpY2UgKnVzYl9h Y3BpX2ZpbmRfY29tcGFuaW9uKHN0cnVjdCBkZXZpY2UgKmRldikKK3sKIAkvKgogCSAqIEluIHRo ZSBBQ1BJIERTRFQgdGFibGUsIG9ubHkgdXNiIHJvb3QgaHViIGFuZCB1c2IgcG9ydHMgYXJlCiAJ ICogYWNwaSBkZXZpY2Ugbm9kZXMuIFRoZSBoaWVyYXJjaHkgbGlrZSBmb2xsb3dpbmcuCkBAIC0x NTgsNjYgKzIyNSwxMCBAQCBzdGF0aWMgc3RydWN0IGFjcGlfZGV2aWNlICp1c2JfYWNwaV9maW5k X2NvbXBhbmlvbihzdHJ1Y3QgZGV2aWNlICpkZXYpCiAJICogU28gYWxsIGJpbmRpbmcgcHJvY2Vz cyBpcyBkaXZpZGVkIGludG8gdHdvIHBhcnRzLiBiaW5kaW5nCiAJICogcm9vdCBodWIgYW5kIHVz YiBwb3J0cy4KIAkgKi8KLQlpZiAoaXNfdXNiX2RldmljZShkZXYpKSB7Ci0JCXVkZXYgPSB0b191 c2JfZGV2aWNlKGRldik7Ci0JCWlmICh1ZGV2LT5wYXJlbnQpCi0JCQlyZXR1cm4gTlVMTDsKLQot CQkvKiByb290IGh1YiBpcyBvbmx5IGNoaWxkIChfQURSPTApIHVuZGVyIGl0cyBwYXJlbnQsIHRo ZSBIQyAqLwotCQlhZGV2ID0gQUNQSV9DT01QQU5JT04oZGV2LT5wYXJlbnQpOwotCQlyZXR1cm4g YWNwaV9maW5kX2NoaWxkX2RldmljZShhZGV2LCAwLCBmYWxzZSk7Ci0JfSBlbHNlIGlmIChpc191 c2JfcG9ydChkZXYpKSB7Ci0JCXN0cnVjdCB1c2JfcG9ydCAqcG9ydF9kZXYgPSB0b191c2JfcG9y dChkZXYpOwotCQlpbnQgcG9ydDEgPSBwb3J0X2Rldi0+cG9ydG51bTsKLQkJc3RydWN0IGFjcGlf cGxkX2luZm8gKnBsZDsKLQkJYWNwaV9oYW5kbGUgKmhhbmRsZTsKLQkJYWNwaV9zdGF0dXMgc3Rh dHVzOwotCi0JCS8qIEdldCB0aGUgc3RydWN0IHVzYl9kZXZpY2UgcG9pbnQgb2YgcG9ydCdzIGh1 YiAqLwotCQl1ZGV2ID0gdG9fdXNiX2RldmljZShkZXYtPnBhcmVudC0+cGFyZW50KTsKLQotCQkv KgotCQkgKiBUaGUgcm9vdCBodWIgcG9ydHMnIHBhcmVudCBpcyB0aGUgcm9vdCBodWIuIFRoZSBu b24tcm9vdC1odWIKLQkJICogcG9ydHMnIHBhcmVudCBpcyB0aGUgcGFyZW50IGh1YiBwb3J0IHdo aWNoIHRoZSBodWIgaXMKLQkJICogY29ubmVjdGVkIHRvLgotCQkgKi8KLQkJaWYgKCF1ZGV2LT5w YXJlbnQpIHsKLQkJCXN0cnVjdCB1c2JfaGNkICpoY2QgPSBidXNfdG9faGNkKHVkZXYtPmJ1cyk7 Ci0JCQlpbnQgcmF3OwotCi0JCQlyYXcgPSB1c2JfaGNkX2ZpbmRfcmF3X3BvcnRfbnVtYmVyKGhj ZCwgcG9ydDEpOwotCi0JCQlhZGV2ID0gdXNiX2FjcGlfZmluZF9wb3J0KEFDUElfQ09NUEFOSU9O KCZ1ZGV2LT5kZXYpLAotCQkJCQkJICByYXcpOwotCi0JCQlpZiAoIWFkZXYpCi0JCQkJcmV0dXJu IE5VTEw7Ci0JCX0gZWxzZSB7Ci0JCQlwYXJlbnRfaGFuZGxlID0KLQkJCQl1c2JfZ2V0X2h1Yl9w b3J0X2FjcGlfaGFuZGxlKHVkZXYtPnBhcmVudCwKLQkJCQl1ZGV2LT5wb3J0bnVtKTsKLQkJCWlm ICghcGFyZW50X2hhbmRsZSkKLQkJCQlyZXR1cm4gTlVMTDsKLQotCQkJYWNwaV9idXNfZ2V0X2Rl dmljZShwYXJlbnRfaGFuZGxlLCAmYWRldik7Ci0KLQkJCWFkZXYgPSB1c2JfYWNwaV9maW5kX3Bv cnQoYWRldiwgcG9ydDEpOwotCi0JCQlpZiAoIWFkZXYpCi0JCQkJcmV0dXJuIE5VTEw7Ci0JCX0K LQkJaGFuZGxlID0gYWRldi0+aGFuZGxlOwotCQlzdGF0dXMgPSBhY3BpX2dldF9waHlzaWNhbF9k ZXZpY2VfbG9jYXRpb24oaGFuZGxlLCAmcGxkKTsKLQkJaWYgKEFDUElfRkFJTFVSRShzdGF0dXMp IHx8ICFwbGQpCi0JCQlyZXR1cm4gYWRldjsKLQotCQlwb3J0X2Rldi0+bG9jYXRpb24gPSBVU0Jf QUNQSV9MT0NBVElPTl9WQUxJRAotCQkJfCBwbGQtPmdyb3VwX3Rva2VuIDw8IDggfCBwbGQtPmdy b3VwX3Bvc2l0aW9uOwotCQlwb3J0X2Rldi0+Y29ubmVjdF90eXBlID0gdXNiX2FjcGlfZ2V0X2Nv bm5lY3RfdHlwZShoYW5kbGUsIHBsZCk7Ci0JCUFDUElfRlJFRShwbGQpOwotCi0JCXJldHVybiBh ZGV2OwotCX0KKwlpZiAoaXNfdXNiX2RldmljZShkZXYpKQorCQlyZXR1cm4gdXNiX2FjcGlfZmlu ZF9jb21wYW5pb25fZm9yX2RldmljZSh0b191c2JfZGV2aWNlKGRldikpOworCWVsc2UgaWYgKGlz X3VzYl9wb3J0KGRldikpCisJCXJldHVybiB1c2JfYWNwaV9maW5kX2NvbXBhbmlvbl9mb3JfcG9y dCh0b191c2JfcG9ydChkZXYpKTsKIAogCXJldHVybiBOVUxMOwogfQo=