Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: base64 Subject: [v3,6/8] phy: amlogic: Add Amlogic G12A USB3 + PCIE Combo PHY Driver From: Neil Armstrong Message-Id: <20190318101153.7531-7-narmstrong@baylibre.com> Date: Mon, 18 Mar 2019 11:11:51 +0100 To: gregkh@linuxfoundation.org, hminas@synopsys.com, balbi@kernel.org, kishon@ti.com Cc: Neil Armstrong , linux-amlogic@lists.infradead.org, linux-usb@vger.kernel.org, linux-arm-kernel@lists.infradead.org, linux-kernel@vger.kernel.org, Martin Blumenstingl List-ID: VGhpcyBhZGRzIHN1cHBvcnQgZm9yIHRoZSBzaGFyZWQgVVNCMyArIFBDSUUgUEhZIGZvdW5kIGlu IHRoZQpBbWxvZ2ljIEcxMkEgU29DIEZhbWlseS4KCkl0IHN1cHBvcnRzIFVTQjMgSG9zdCBtb2Rl IG9yIFBDSUUgMi4wIG1vZGUsIGRlcGVuZGluZyBvbiB0aGUgbGF5b3V0IG9mCnRoZSBib2FyZC4K ClNlbGVjdGlvbiBpcyBkb25lIGJ5IHRoZSAjcGh5LWNlbGxzLCBtYWtpbmcgdGhlIG1vZGUgc3Rh dGljIGFuZCBleGNsdXNpdmUuCgpTaWduZWQtb2ZmLWJ5OiBOZWlsIEFybXN0cm9uZyA8bmFybXN0 cm9uZ0BiYXlsaWJyZS5jb20+ClJldmlld2VkLWJ5OiBNYXJ0aW4gQmx1bWVuc3RpbmdsIDxtYXJ0 aW4uYmx1bWVuc3RpbmdsQGdvb2dsZW1haWwuY29tPgotLS0KIGRyaXZlcnMvcGh5L2FtbG9naWMv S2NvbmZpZyAgICAgICAgICAgICAgICAgICB8ICAxMSArCiBkcml2ZXJzL3BoeS9hbWxvZ2ljL01h a2VmaWxlICAgICAgICAgICAgICAgICAgfCAgIDEgKwogLi4uL3BoeS9hbWxvZ2ljL3BoeS1tZXNv bi1nMTJhLXVzYjMtcGNpZS5jICAgIHwgNDEzICsrKysrKysrKysrKysrKysrKwogMyBmaWxlcyBj aGFuZ2VkLCA0MjUgaW5zZXJ0aW9ucygrKQogY3JlYXRlIG1vZGUgMTAwNjQ0IGRyaXZlcnMvcGh5 L2FtbG9naWMvcGh5LW1lc29uLWcxMmEtdXNiMy1wY2llLmMKCmRpZmYgLS1naXQgYS9kcml2ZXJz L3BoeS9hbWxvZ2ljL0tjb25maWcgYi9kcml2ZXJzL3BoeS9hbWxvZ2ljL0tjb25maWcKaW5kZXgg NTYwZmYwZjFlZDRjLi40YzA4YzFjY2RkMDQgMTAwNjQ0Ci0tLSBhL2RyaXZlcnMvcGh5L2FtbG9n aWMvS2NvbmZpZworKysgYi9kcml2ZXJzL3BoeS9hbWxvZ2ljL0tjb25maWcKQEAgLTQ3LDMgKzQ3 LDE0IEBAIGNvbmZpZyBQSFlfTUVTT05fRzEyQV9VU0IyCiAJICBFbmFibGUgdGhpcyB0byBzdXBw b3J0IHRoZSBNZXNvbiBVU0IyIFBIWXMgZm91bmQgaW4gTWVzb24KIAkgIEcxMkEgU29Dcy4KIAkg IElmIHVuc3VyZSwgc2F5IE4uCisKK2NvbmZpZyBQSFlfTUVTT05fRzEyQV9VU0IzX1BDSUUKKwl0 cmlzdGF0ZSAiTWVzb24gRzEyQSBVU0IzK1BDSUUgQ29tYm8gUEhZIGRyaXZlciIKKwlkZWZhdWx0 IEFSQ0hfTUVTT04KKwlkZXBlbmRzIG9uIE9GICYmIChBUkNIX01FU09OIHx8IENPTVBJTEVfVEVT VCkKKwlzZWxlY3QgR0VORVJJQ19QSFkKKwlzZWxlY3QgUkVHTUFQX01NSU8KKwloZWxwCisJICBF bmFibGUgdGhpcyB0byBzdXBwb3J0IHRoZSBNZXNvbiBVU0IzICsgUENJRSBDb21ibyBQSFkgZm91 bmQKKwkgIGluIE1lc29uIEcxMkEgU29Dcy4KKwkgIElmIHVuc3VyZSwgc2F5IE4uCmRpZmYgLS1n aXQgYS9kcml2ZXJzL3BoeS9hbWxvZ2ljL01ha2VmaWxlIGIvZHJpdmVycy9waHkvYW1sb2dpYy9N YWtlZmlsZQppbmRleCA3ZDRkMTBmNWE2YjMuLmZkZDAwOGUxYjE5YiAxMDA2NDQKLS0tIGEvZHJp dmVycy9waHkvYW1sb2dpYy9NYWtlZmlsZQorKysgYi9kcml2ZXJzL3BoeS9hbWxvZ2ljL01ha2Vm aWxlCkBAIC0yLDMgKzIsNCBAQCBvYmotJChDT05GSUdfUEhZX01FU09OOEJfVVNCMikJCSs9IHBo eS1tZXNvbjhiLXVzYjIubwogb2JqLSQoQ09ORklHX1BIWV9NRVNPTl9HWExfVVNCMikJKz0gcGh5 LW1lc29uLWd4bC11c2IyLm8KIG9iai0kKENPTkZJR19QSFlfTUVTT05fRzEyQV9VU0IyKQkrPSBw aHktbWVzb24tZzEyYS11c2IyLm8KIG9iai0kKENPTkZJR19QSFlfTUVTT05fR1hMX1VTQjMpCSs9 IHBoeS1tZXNvbi1neGwtdXNiMy5vCitvYmotJChDT05GSUdfUEhZX01FU09OX0cxMkFfVVNCM19Q Q0lFKQkrPSBwaHktbWVzb24tZzEyYS11c2IzLXBjaWUubwpkaWZmIC0tZ2l0IGEvZHJpdmVycy9w aHkvYW1sb2dpYy9waHktbWVzb24tZzEyYS11c2IzLXBjaWUuYyBiL2RyaXZlcnMvcGh5L2FtbG9n aWMvcGh5LW1lc29uLWcxMmEtdXNiMy1wY2llLmMKbmV3IGZpbGUgbW9kZSAxMDA2NDQKaW5kZXgg MDAwMDAwMDAwMDAwLi42MjMzYTc5NzlhOTMKLS0tIC9kZXYvbnVsbAorKysgYi9kcml2ZXJzL3Bo eS9hbWxvZ2ljL3BoeS1tZXNvbi1nMTJhLXVzYjMtcGNpZS5jCkBAIC0wLDAgKzEsNDEzIEBACisv LyBTUERYLUxpY2Vuc2UtSWRlbnRpZmllcjogR1BMLTIuMAorLyoKKyAqIEFtbG9naWMgRzEyQSBV U0IzICsgUENJRSBDb21ibyBQSFkgZHJpdmVyCisgKgorICogQ29weXJpZ2h0IChDKSAyMDE3IEFt bG9naWMsIEluYy4gQWxsIHJpZ2h0cyByZXNlcnZlZAorICogQ29weXJpZ2h0IChDKSAyMDE5IEJh eUxpYnJlLCBTQVMKKyAqIEF1dGhvcjogTmVpbCBBcm1zdHJvbmcgPG5hcm1zdHJvbmdAYmF5bGli cmUuY29tPgorICovCisKKyNpbmNsdWRlIDxsaW51eC9iaXRmaWVsZC5oPgorI2luY2x1ZGUgPGxp bnV4L2JpdG9wcy5oPgorI2luY2x1ZGUgPGxpbnV4L2Nsay5oPgorI2luY2x1ZGUgPGxpbnV4L21v ZHVsZS5oPgorI2luY2x1ZGUgPGxpbnV4L29mX2RldmljZS5oPgorI2luY2x1ZGUgPGxpbnV4L3Bo eS9waHkuaD4KKyNpbmNsdWRlIDxsaW51eC9yZWdtYXAuaD4KKyNpbmNsdWRlIDxsaW51eC9yZXNl dC5oPgorI2luY2x1ZGUgPGxpbnV4L3BsYXRmb3JtX2RldmljZS5oPgorI2luY2x1ZGUgPGR0LWJp bmRpbmdzL3BoeS9waHkuaD4KKworI2RlZmluZSBQSFlfUjAJCQkJCQkJMHgwMAorCSNkZWZpbmUg UEhZX1IwX1BDSUVfUE9XRVJfU1RBVEUJCQkJR0VOTUFTSyg0LCAwKQorCSNkZWZpbmUgUEhZX1Iw X1BDSUVfVVNCM19TV0lUQ0gJCQkJR0VOTUFTSyg2LCA1KQorCisjZGVmaW5lIFBIWV9SMQkJCQkJ CQkweDA0CisJI2RlZmluZSBQSFlfUjFfUEhZX1RYMV9URVJNX09GRlNFVAkJCUdFTk1BU0soNCwg MCkKKwkjZGVmaW5lIFBIWV9SMV9QSFlfVFgwX1RFUk1fT0ZGU0VUCQkJR0VOTUFTSyg5LCA1KQor CSNkZWZpbmUgUEhZX1IxX1BIWV9SWDFfRVEJCQkJR0VOTUFTSygxMiwgMTApCisJI2RlZmluZSBQ SFlfUjFfUEhZX1JYMF9FUQkJCQlHRU5NQVNLKDE1LCAxMykKKwkjZGVmaW5lIFBIWV9SMV9QSFlf TE9TX0xFVkVMCQkJCUdFTk1BU0soMjAsIDE2KQorCSNkZWZpbmUgUEhZX1IxX1BIWV9MT1NfQklB UwkJCQlHRU5NQVNLKDIzLCAyMSkKKwkjZGVmaW5lIFBIWV9SMV9QSFlfUkVGX0NMS0RJVjIJCQkJ QklUKDI0KQorCSNkZWZpbmUgUEhZX1IxX1BIWV9NUExMX01VTFRJUExJRVIJCQlHRU5NQVNLKDMx LCAyNSkKKworI2RlZmluZSBQSFlfUjIJCQkJCQkJMHgwOAorCSNkZWZpbmUgUEhZX1IyX1BDU19U WF9ERUVNUEhfR0VOMl82REIJCQlHRU5NQVNLKDUsIDApCisJI2RlZmluZSBQSFlfUjJfUENTX1RY X0RFRU1QSF9HRU4yXzNQNURCCQkJR0VOTUFTSygxMSwgNikKKwkjZGVmaW5lIFBIWV9SMl9QQ1Nf VFhfREVFTVBIX0dFTjEJCQlHRU5NQVNLKDE3LCAxMikKKwkjZGVmaW5lIFBIWV9SMl9QSFlfVFhf VkJPT1NUX0xWTAkJCUdFTk1BU0soMjAsIDE4KQorCisjZGVmaW5lIFBIWV9SNAkJCQkJCQkweDEw CisJI2RlZmluZSBQSFlfUjRfUEhZX0NSX1dSSVRFCQkJCUJJVCgwKQorCSNkZWZpbmUgUEhZX1I0 X1BIWV9DUl9SRUFECQkJCUJJVCgxKQorCSNkZWZpbmUgUEhZX1I0X1BIWV9DUl9EQVRBX0lOCQkJ CUdFTk1BU0soMTcsIDIpCisJI2RlZmluZSBQSFlfUjRfUEhZX0NSX0NBUF9EQVRBCQkJCUJJVCgx OCkKKwkjZGVmaW5lIFBIWV9SNF9QSFlfQ1JfQ0FQX0FERFIJCQkJQklUKDE5KQorCisjZGVmaW5l IFBIWV9SNQkJCQkJCQkweDE0CisJI2RlZmluZSBQSFlfUjVfUEhZX0NSX0RBVEFfT1VUCQkJCUdF Tk1BU0soMTUsIDApCisJI2RlZmluZSBQSFlfUjVfUEhZX0NSX0FDSwkJCQlCSVQoMTYpCisJI2Rl ZmluZSBQSFlfUjVfUEhZX0JTX09VVAkJCQlCSVQoMTcpCisKK3N0cnVjdCBwaHlfZzEyYV91c2Iz X3BjaWVfcHJpdiB7CisJc3RydWN0IHJlZ21hcAkJKnJlZ21hcDsKKwlzdHJ1Y3QgcmVnbWFwCQkq cmVnbWFwX2NyOworCXN0cnVjdCBjbGsJCSpjbGtfcmVmOworCXN0cnVjdCByZXNldF9jb250cm9s CSpyZXNldDsKKwlzdHJ1Y3QgcGh5CQkqcGh5OworCXVuc2lnbmVkIGludAkJbW9kZTsKK307CisK K3N0YXRpYyBjb25zdCBzdHJ1Y3QgcmVnbWFwX2NvbmZpZyBwaHlfZzEyYV91c2IzX3BjaWVfcmVn bWFwX2NvbmYgPSB7CisJLnJlZ19iaXRzID0gOCwKKwkudmFsX2JpdHMgPSAzMiwKKwkucmVnX3N0 cmlkZSA9IDQsCisJLm1heF9yZWdpc3RlciA9IFBIWV9SNSwKK307CisKK3N0YXRpYyBpbnQgcGh5 X2cxMmFfdXNiM19wY2llX2NyX2J1c19hZGRyKHN0cnVjdCBwaHlfZzEyYV91c2IzX3BjaWVfcHJp diAqcHJpdiwKKwkJCQkJICB1bnNpZ25lZCBpbnQgYWRkcikKK3sKKwl1bnNpZ25lZCBpbnQgdmFs LCByZWc7CisJaW50IHJldDsKKworCXJlZyA9IEZJRUxEX1BSRVAoUEhZX1I0X1BIWV9DUl9EQVRB X0lOLCBhZGRyKTsKKworCXJlZ21hcF93cml0ZShwcml2LT5yZWdtYXAsIFBIWV9SNCwgcmVnKTsK KwlyZWdtYXBfd3JpdGUocHJpdi0+cmVnbWFwLCBQSFlfUjQsIHJlZyk7CisKKwlyZWdtYXBfd3Jp dGUocHJpdi0+cmVnbWFwLCBQSFlfUjQsIHJlZyB8IFBIWV9SNF9QSFlfQ1JfQ0FQX0FERFIpOwor CisJcmV0ID0gcmVnbWFwX3JlYWRfcG9sbF90aW1lb3V0KHByaXYtPnJlZ21hcCwgUEhZX1I1LCB2 YWwsCisJCQkJICAgICAgICh2YWwgJiBQSFlfUjVfUEhZX0NSX0FDSyksCisJCQkJICAgICAgIDUs IDEwMDApOworCWlmIChyZXQpCisJCXJldHVybiByZXQ7CisKKwlyZWdtYXBfd3JpdGUocHJpdi0+ cmVnbWFwLCBQSFlfUjQsIHJlZyk7CisKKwlyZXQgPSByZWdtYXBfcmVhZF9wb2xsX3RpbWVvdXQo cHJpdi0+cmVnbWFwLCBQSFlfUjUsIHZhbCwKKwkJCQkgICAgICAgISh2YWwgJiBQSFlfUjVfUEhZ X0NSX0FDSyksCisJCQkJICAgICAgIDUsIDEwMDApOworCWlmIChyZXQpCisJCXJldHVybiByZXQ7 CisKKwlyZXR1cm4gMDsKK30KKworc3RhdGljIGludCBwaHlfZzEyYV91c2IzX3BjaWVfY3JfYnVz X3JlYWQodm9pZCAqY29udGV4dCwgdW5zaWduZWQgaW50IGFkZHIsCisJCQkJCSAgdW5zaWduZWQg aW50ICpkYXRhKQoreworCXN0cnVjdCBwaHlfZzEyYV91c2IzX3BjaWVfcHJpdiAqcHJpdiA9IGNv bnRleHQ7CisJdW5zaWduZWQgaW50IHZhbDsKKwlpbnQgcmV0OworCisJcmV0ID0gcGh5X2cxMmFf dXNiM19wY2llX2NyX2J1c19hZGRyKHByaXYsIGFkZHIpOworCWlmIChyZXQpCisJCXJldHVybiBy ZXQ7CisKKwlyZWdtYXBfd3JpdGUocHJpdi0+cmVnbWFwLCBQSFlfUjQsIDApOworCXJlZ21hcF93 cml0ZShwcml2LT5yZWdtYXAsIFBIWV9SNCwgUEhZX1I0X1BIWV9DUl9SRUFEKTsKKworCXJldCA9 IHJlZ21hcF9yZWFkX3BvbGxfdGltZW91dChwcml2LT5yZWdtYXAsIFBIWV9SNSwgdmFsLAorCQkJ CSAgICAgICAodmFsICYgUEhZX1I1X1BIWV9DUl9BQ0spLAorCQkJCSAgICAgICA1LCAxMDAwKTsK KwlpZiAocmV0KQorCQlyZXR1cm4gcmV0OworCisJKmRhdGEgPSBGSUVMRF9HRVQoUEhZX1I1X1BI WV9DUl9EQVRBX09VVCwgdmFsKTsKKworCXJlZ21hcF93cml0ZShwcml2LT5yZWdtYXAsIFBIWV9S NCwgMCk7CisKKwlyZXQgPSByZWdtYXBfcmVhZF9wb2xsX3RpbWVvdXQocHJpdi0+cmVnbWFwLCBQ SFlfUjUsIHZhbCwKKwkJCQkgICAgICAgISh2YWwgJiBQSFlfUjVfUEhZX0NSX0FDSyksCisJCQkJ ICAgICAgIDUsIDEwMDApOworCWlmIChyZXQpCisJCXJldHVybiByZXQ7CisKKwlyZXR1cm4gMDsK K30KKworc3RhdGljIGludCBwaHlfZzEyYV91c2IzX3BjaWVfY3JfYnVzX3dyaXRlKHZvaWQgKmNv bnRleHQsIHVuc2lnbmVkIGludCBhZGRyLAorCQkJCQkgICB1bnNpZ25lZCBpbnQgZGF0YSkKK3sK KwlzdHJ1Y3QgcGh5X2cxMmFfdXNiM19wY2llX3ByaXYgKnByaXYgPSBjb250ZXh0OworCXVuc2ln bmVkIGludCB2YWwsIHJlZzsKKwlpbnQgcmV0OworCisJcmV0ID0gcGh5X2cxMmFfdXNiM19wY2ll X2NyX2J1c19hZGRyKHByaXYsIGFkZHIpOworCWlmIChyZXQpCisJCXJldHVybiByZXQ7CisKKwly ZWcgPSBGSUVMRF9QUkVQKFBIWV9SNF9QSFlfQ1JfREFUQV9JTiwgZGF0YSk7CisKKwlyZWdtYXBf d3JpdGUocHJpdi0+cmVnbWFwLCBQSFlfUjQsIHJlZyk7CisJcmVnbWFwX3dyaXRlKHByaXYtPnJl Z21hcCwgUEhZX1I0LCByZWcpOworCisJcmVnbWFwX3dyaXRlKHByaXYtPnJlZ21hcCwgUEhZX1I0 LCByZWcgfCBQSFlfUjRfUEhZX0NSX0NBUF9EQVRBKTsKKworCXJldCA9IHJlZ21hcF9yZWFkX3Bv bGxfdGltZW91dChwcml2LT5yZWdtYXAsIFBIWV9SNSwgdmFsLAorCQkJCSAgICAgICAodmFsICYg UEhZX1I1X1BIWV9DUl9BQ0spLAorCQkJCSAgICAgICA1LCAxMDAwKTsKKwlpZiAocmV0KQorCQly ZXR1cm4gcmV0OworCisJcmVnbWFwX3dyaXRlKHByaXYtPnJlZ21hcCwgUEhZX1I0LCByZWcpOwor CisJcmV0ID0gcmVnbWFwX3JlYWRfcG9sbF90aW1lb3V0KHByaXYtPnJlZ21hcCwgUEhZX1I1LCB2 YWwsCisJCQkJICAgICAgICh2YWwgJiBQSFlfUjVfUEhZX0NSX0FDSykgPT0gMCwKKwkJCQkgICAg ICAgNSwgMTAwMCk7CisJaWYgKHJldCkKKwkJcmV0dXJuIHJldDsKKworCXJlZ21hcF93cml0ZShw cml2LT5yZWdtYXAsIFBIWV9SNCwgcmVnKTsKKworCXJlZ21hcF93cml0ZShwcml2LT5yZWdtYXAs IFBIWV9SNCwgcmVnIHwgUEhZX1I0X1BIWV9DUl9XUklURSk7CisKKwlyZXQgPSByZWdtYXBfcmVh ZF9wb2xsX3RpbWVvdXQocHJpdi0+cmVnbWFwLCBQSFlfUjUsIHZhbCwKKwkJCQkgICAgICAgKHZh bCAmIFBIWV9SNV9QSFlfQ1JfQUNLKSwKKwkJCQkgICAgICAgNSwgMTAwMCk7CisJaWYgKHJldCkK KwkJcmV0dXJuIHJldDsKKworCXJlZ21hcF93cml0ZShwcml2LT5yZWdtYXAsIFBIWV9SNCwgcmVn KTsKKworCXJldCA9IHJlZ21hcF9yZWFkX3BvbGxfdGltZW91dChwcml2LT5yZWdtYXAsIFBIWV9S NSwgdmFsLAorCQkJCSAgICAgICAodmFsICYgUEhZX1I1X1BIWV9DUl9BQ0spID09IDAsCisJCQkJ ICAgICAgIDUsIDEwMDApOworCWlmIChyZXQpCisJCXJldHVybiByZXQ7CisKKwlyZXR1cm4gMDsK K30KKworc3RhdGljIGNvbnN0IHN0cnVjdCByZWdtYXBfY29uZmlnIHBoeV9nMTJhX3VzYjNfcGNp ZV9jcl9yZWdtYXBfY29uZiA9IHsKKwkucmVnX2JpdHMgPSAxNiwKKwkudmFsX2JpdHMgPSAxNiwK KwkucmVnX3JlYWQgPSBwaHlfZzEyYV91c2IzX3BjaWVfY3JfYnVzX3JlYWQsCisJLnJlZ193cml0 ZSA9IHBoeV9nMTJhX3VzYjNfcGNpZV9jcl9idXNfd3JpdGUsCisJLm1heF9yZWdpc3RlciA9IDB4 ZmZmZiwKKwkuZmFzdF9pbyA9IHRydWUsCit9OworCitzdGF0aWMgaW50IHBoeV9nMTJhX3VzYjNf aW5pdChzdHJ1Y3QgcGh5ICpwaHkpCit7CisJc3RydWN0IHBoeV9nMTJhX3VzYjNfcGNpZV9wcml2 ICpwcml2ID0gcGh5X2dldF9kcnZkYXRhKHBoeSk7CisJaW50IGRhdGEsIHJldDsKKworCS8qIFN3 aXRjaCBQSFkgdG8gVVNCMyAqLworCS8qIFRPRE8gZmlndXJlIG91dCBob3cgdG8gaGFuZGxlIHdo ZW4gUENJZSB3YXMgc2V0IGluIHRoZSBib290bG9hZGVyICovCisJcmVnbWFwX3VwZGF0ZV9iaXRz KHByaXYtPnJlZ21hcCwgUEhZX1IwLAorCQkJICAgUEhZX1IwX1BDSUVfVVNCM19TV0lUQ0gsCisJ CQkgICBQSFlfUjBfUENJRV9VU0IzX1NXSVRDSCk7CisKKwkvKgorCSAqIFdPUktBUk9VTkQ6IFRo ZXJlIGlzIFNTUEhZIHN1c3BlbmQgYnVnIGR1ZSB0bworCSAqIHdoaWNoIFVTQiBlbnVtZXJhdGVz CisJICogaW4gSFMgbW9kZSBpbnN0ZWFkIG9mIFNTIG1vZGUuIFdvcmthcm91bmQgaXQgYnkgYXNz ZXJ0aW5nCisJICogTEFORTAuVFhfQUxUX0JMT0NLLkVOX0FMVF9CVVMgdG8gZW5hYmxlIFRYIHRv IHVzZSBhbHQgYnVzCisJICogbW9kZQorCSAqLworCXJldCA9IHJlZ21hcF91cGRhdGVfYml0cyhw cml2LT5yZWdtYXBfY3IsIDB4MTAyZCwgQklUKDcpLCBCSVQoNykpOworCWlmIChyZXQpCisJCXJl dHVybiByZXQ7CisKKwlyZXQgPSByZWdtYXBfdXBkYXRlX2JpdHMocHJpdi0+cmVnbWFwX2NyLCAw eDEwMTAsIDB4ZmYwLCAyMCk7CisJaWYgKHJldCkKKwkJcmV0dXJuIHJldDsKKworCS8qCisJICog Rml4IFJYIEVxdWFsaXphdGlvbiBzZXR0aW5nIGFzIGZvbGxvd3MKKwkgKiBMQU5FMC5SWF9PVlJE X0lOX0hJLiBSWF9FUV9FTiBzZXQgdG8gMAorCSAqIExBTkUwLlJYX09WUkRfSU5fSEkuUlhfRVFf RU5fT1ZSRCBzZXQgdG8gMQorCSAqIExBTkUwLlJYX09WUkRfSU5fSEkuUlhfRVEgc2V0IHRvIDMK KwkgKiBMQU5FMC5SWF9PVlJEX0lOX0hJLlJYX0VRX09WUkQgc2V0IHRvIDEKKwkgKi8KKwlyZXQg PSByZWdtYXBfcmVhZChwcml2LT5yZWdtYXBfY3IsIDB4MTAwNiwgJmRhdGEpOworCWlmIChyZXQp CisJCXJldHVybiByZXQ7CisKKwlkYXRhICY9IH5CSVQoNik7CisJZGF0YSB8PSBCSVQoNyk7CisJ ZGF0YSAmPSB+KDB4NyA8PCA4KTsKKwlkYXRhIHw9ICgweDMgPDwgOCk7CisJZGF0YSB8PSAoMSA8 PCAxMSk7CisJcmV0ID0gcmVnbWFwX3dyaXRlKHByaXYtPnJlZ21hcF9jciwgMHgxMDA2LCBkYXRh KTsKKwlpZiAocmV0KQorCQlyZXR1cm4gcmV0OworCisJLyoKKwkgKiBTZXQgRVEgYW5kIFRYIGxh dW5jaCBhbXBsaXR1ZGVzIGFzIGZvbGxvd3MKKwkgKiBMQU5FMC5UWF9PVlJEX0RSVl9MTy5QUkVF TVBIIHNldCB0byAyMgorCSAqIExBTkUwLlRYX09WUkRfRFJWX0xPLkFNUExJVFVERSBzZXQgdG8g MTI3CisJICogTEFORTAuVFhfT1ZSRF9EUlZfTE8uRU4gc2V0IHRvIDEuCisJICovCisJcmV0ID0g cmVnbWFwX3JlYWQocHJpdi0+cmVnbWFwX2NyLCAweDEwMDIsICZkYXRhKTsKKwlpZiAocmV0KQor CQlyZXR1cm4gcmV0OworCisJZGF0YSAmPSB+MHgzZjgwOworCWRhdGEgfD0gKDB4MTYgPDwgNyk7 CisJZGF0YSAmPSB+MHg3ZjsKKwlkYXRhIHw9ICgweDdmIHwgQklUKDE0KSk7CisJcmV0ID0gcmVn bWFwX3dyaXRlKHByaXYtPnJlZ21hcF9jciwgMHgxMDAyLCBkYXRhKTsKKwlpZiAocmV0KQorCQly ZXR1cm4gcmV0OworCisJLyogTVBMTF9MT09QX0NUTC5QUk9QX0NOVFJMID0gOCAqLworCXJldCA9 IHJlZ21hcF91cGRhdGVfYml0cyhwcml2LT5yZWdtYXBfY3IsIDB4MzAsIDB4ZiA8PCA0LCA4IDw8 IDQpOworCWlmIChyZXQpCisJCXJldHVybiByZXQ7CisKKwlyZWdtYXBfdXBkYXRlX2JpdHMocHJp di0+cmVnbWFwLCBQSFlfUjIsCisJCQlQSFlfUjJfUEhZX1RYX1ZCT09TVF9MVkwsCisJCQlGSUVM RF9QUkVQKFBIWV9SMl9QSFlfVFhfVkJPT1NUX0xWTCwgMHg0KSk7CisKKwlyZWdtYXBfdXBkYXRl X2JpdHMocHJpdi0+cmVnbWFwLCBQSFlfUjEsCisJCQlQSFlfUjFfUEhZX0xPU19CSUFTIHwgUEhZ X1IxX1BIWV9MT1NfTEVWRUwsCisJCQlGSUVMRF9QUkVQKFBIWV9SMV9QSFlfTE9TX0JJQVMsIDQp IHwKKwkJCUZJRUxEX1BSRVAoUEhZX1IxX1BIWV9MT1NfTEVWRUwsIDkpKTsKKworCXJldHVybiAw OworfQorCitzdGF0aWMgaW50IHBoeV9nMTJhX3VzYjNfcGNpZV9pbml0KHN0cnVjdCBwaHkgKnBo eSkKK3sKKwlzdHJ1Y3QgcGh5X2cxMmFfdXNiM19wY2llX3ByaXYgKnByaXYgPSBwaHlfZ2V0X2Ry dmRhdGEocGh5KTsKKwlpbnQgcmV0OworCisJcmV0ID0gcmVzZXRfY29udHJvbF9yZXNldChwcml2 LT5yZXNldCk7CisJaWYgKHJldCkKKwkJcmV0dXJuIHJldDsKKworCWlmIChwcml2LT5tb2RlID09 IFBIWV9UWVBFX1VTQjMpCisJCXJldHVybiBwaHlfZzEyYV91c2IzX2luaXQocGh5KTsKKworCS8q IFBvd2VyIFVQIFBDSUUgKi8KKwkvKiBUT0RPIGZpZ3VyZSBvdXQgd2hlbiB0aGUgYm9vdGxvYWRl ciBoYXMgc2V0IFVTQjMgbW9kZSBiZWZvcmUgKi8KKwlyZWdtYXBfdXBkYXRlX2JpdHMocHJpdi0+ cmVnbWFwLCBQSFlfUjAsCisJCQkgICBQSFlfUjBfUENJRV9QT1dFUl9TVEFURSwKKwkJCSAgIEZJ RUxEX1BSRVAoUEhZX1IwX1BDSUVfUE9XRVJfU1RBVEUsIDB4MWMpKTsKKworCXJldHVybiAwOwor fQorCitzdGF0aWMgaW50IHBoeV9nMTJhX3VzYjNfcGNpZV9leGl0KHN0cnVjdCBwaHkgKnBoeSkK K3sKKwlzdHJ1Y3QgcGh5X2cxMmFfdXNiM19wY2llX3ByaXYgKnByaXYgPSBwaHlfZ2V0X2RydmRh dGEocGh5KTsKKworCXJldHVybiByZXNldF9jb250cm9sX3Jlc2V0KHByaXYtPnJlc2V0KTsKK30K Kworc3RhdGljIHN0cnVjdCBwaHkgKnBoeV9nMTJhX3VzYjNfcGNpZV94bGF0ZShzdHJ1Y3QgZGV2 aWNlICpkZXYsCisJCQkJCSAgICBzdHJ1Y3Qgb2ZfcGhhbmRsZV9hcmdzICphcmdzKQoreworCXN0 cnVjdCBwaHlfZzEyYV91c2IzX3BjaWVfcHJpdiAqcHJpdiA9IGRldl9nZXRfZHJ2ZGF0YShkZXYp OworCXVuc2lnbmVkIGludCBtb2RlOworCisJaWYgKGFyZ3MtPmFyZ3NfY291bnQgPCAxKSB7CisJ CWRldl9lcnIoZGV2LCAiaW52YWxpZCBudW1iZXIgb2YgYXJndW1lbnRzXG4iKTsKKwkJcmV0dXJu IEVSUl9QVFIoLUVJTlZBTCk7CisJfQorCisJbW9kZSA9IGFyZ3MtPmFyZ3NbMF07CisKKwlpZiAo bW9kZSAhPSBQSFlfVFlQRV9VU0IzICYmIG1vZGUgIT0gUEhZX1RZUEVfUENJRSkgeworCQlkZXZf ZXJyKGRldiwgImludmFsaWQgcGh5IG1vZGUgc2VsZWN0IGFyZ3VtZW50XG4iKTsKKwkJcmV0dXJu IEVSUl9QVFIoLUVJTlZBTCk7CisJfQorCisJcHJpdi0+bW9kZSA9IG1vZGU7CisKKwlyZXR1cm4g cHJpdi0+cGh5OworfQorCitzdGF0aWMgY29uc3Qgc3RydWN0IHBoeV9vcHMgcGh5X2cxMmFfdXNi M19wY2llX29wcyA9IHsKKwkuaW5pdAkJPSBwaHlfZzEyYV91c2IzX3BjaWVfaW5pdCwKKwkuZXhp dAkJPSBwaHlfZzEyYV91c2IzX3BjaWVfZXhpdCwKKwkub3duZXIJCT0gVEhJU19NT0RVTEUsCit9 OworCitzdGF0aWMgaW50IHBoeV9nMTJhX3VzYjNfcGNpZV9wcm9iZShzdHJ1Y3QgcGxhdGZvcm1f ZGV2aWNlICpwZGV2KQoreworCXN0cnVjdCBkZXZpY2UgKmRldiA9ICZwZGV2LT5kZXY7CisJc3Ry dWN0IGRldmljZV9ub2RlICpucCA9IGRldi0+b2Zfbm9kZTsKKwlzdHJ1Y3QgcGh5X2cxMmFfdXNi M19wY2llX3ByaXYgKnByaXY7CisJc3RydWN0IHJlc291cmNlICpyZXM7CisJc3RydWN0IHBoeV9w cm92aWRlciAqcGh5X3Byb3ZpZGVyOworCXZvaWQgX19pb21lbSAqYmFzZTsKKwlpbnQgcmV0Owor CisJcHJpdiA9IGRldm1fa3phbGxvYyhkZXYsIHNpemVvZigqcHJpdiksIEdGUF9LRVJORUwpOwor CWlmICghcHJpdikKKwkJcmV0dXJuIC1FTk9NRU07CisKKwlyZXMgPSBwbGF0Zm9ybV9nZXRfcmVz b3VyY2UocGRldiwgSU9SRVNPVVJDRV9NRU0sIDApOworCWJhc2UgPSBkZXZtX2lvcmVtYXBfcmVz b3VyY2UoZGV2LCByZXMpOworCWlmIChJU19FUlIoYmFzZSkpCisJCXJldHVybiBQVFJfRVJSKGJh c2UpOworCisJcHJpdi0+cmVnbWFwID0gZGV2bV9yZWdtYXBfaW5pdF9tbWlvKGRldiwgYmFzZSwK KwkJCQkJICAgICAmcGh5X2cxMmFfdXNiM19wY2llX3JlZ21hcF9jb25mKTsKKwlpZiAoSVNfRVJS KHByaXYtPnJlZ21hcCkpCisJCXJldHVybiBQVFJfRVJSKHByaXYtPnJlZ21hcCk7CisKKwlwcml2 LT5yZWdtYXBfY3IgPSBkZXZtX3JlZ21hcF9pbml0KGRldiwgTlVMTCwgcHJpdiwKKwkJCQkJICAg JnBoeV9nMTJhX3VzYjNfcGNpZV9jcl9yZWdtYXBfY29uZik7CisJaWYgKElTX0VSUihwcml2LT5y ZWdtYXBfY3IpKQorCQlyZXR1cm4gUFRSX0VSUihwcml2LT5yZWdtYXBfY3IpOworCisJcHJpdi0+ Y2xrX3JlZiA9IGRldm1fY2xrX2dldChkZXYsICJyZWZfY2xrIik7CisJaWYgKElTX0VSUihwcml2 LT5jbGtfcmVmKSkKKwkJcmV0dXJuIFBUUl9FUlIocHJpdi0+Y2xrX3JlZik7CisKKwlyZXQgPSBj bGtfcHJlcGFyZV9lbmFibGUocHJpdi0+Y2xrX3JlZik7CisJaWYgKHJldCkKKwkJZ290byBlcnJf ZGlzYWJsZV9jbGtfcmVmOworCisJcHJpdi0+cmVzZXQgPSBkZXZtX3Jlc2V0X2NvbnRyb2xfYXJy YXlfZ2V0KGRldiwgZmFsc2UsIGZhbHNlKTsKKwlpZiAoSVNfRVJSKHByaXYtPnJlc2V0KSkKKwkJ cmV0dXJuIFBUUl9FUlIocHJpdi0+cmVzZXQpOworCisJcHJpdi0+cGh5ID0gZGV2bV9waHlfY3Jl YXRlKGRldiwgbnAsICZwaHlfZzEyYV91c2IzX3BjaWVfb3BzKTsKKwlpZiAoSVNfRVJSKHByaXYt PnBoeSkpIHsKKwkJcmV0ID0gUFRSX0VSUihwcml2LT5waHkpOworCQlpZiAocmV0ICE9IC1FUFJP QkVfREVGRVIpCisJCQlkZXZfZXJyKGRldiwgImZhaWxlZCB0byBjcmVhdGUgUEhZXG4iKTsKKwor CQlyZXR1cm4gcmV0OworCX0KKworCXBoeV9zZXRfZHJ2ZGF0YShwcml2LT5waHksIHByaXYpOwor CWRldl9zZXRfZHJ2ZGF0YShkZXYsIHByaXYpOworCisJcGh5X3Byb3ZpZGVyID0gZGV2bV9vZl9w aHlfcHJvdmlkZXJfcmVnaXN0ZXIoZGV2LAorCQkJCQkJICAgICBwaHlfZzEyYV91c2IzX3BjaWVf eGxhdGUpOworCisJcmV0dXJuIFBUUl9FUlJfT1JfWkVSTyhwaHlfcHJvdmlkZXIpOworCitlcnJf ZGlzYWJsZV9jbGtfcmVmOgorCWNsa19kaXNhYmxlX3VucHJlcGFyZShwcml2LT5jbGtfcmVmKTsK KworCXJldHVybiByZXQ7Cit9CisKK3N0YXRpYyBjb25zdCBzdHJ1Y3Qgb2ZfZGV2aWNlX2lkIHBo eV9nMTJhX3VzYjNfcGNpZV9vZl9tYXRjaFtdID0geworCXsgLmNvbXBhdGlibGUgPSAiYW1sb2dp YyxnMTJhLXVzYjMtcGNpZS1waHkiLCB9LAorCXsgfSwKK307CitNT0RVTEVfREVWSUNFX1RBQkxF KG9mLCBwaHlfZzEyYV91c2IzX3BjaWVfb2ZfbWF0Y2gpOworCitzdGF0aWMgc3RydWN0IHBsYXRm b3JtX2RyaXZlciBwaHlfZzEyYV91c2IzX3BjaWVfZHJpdmVyID0geworCS5wcm9iZQk9IHBoeV9n MTJhX3VzYjNfcGNpZV9wcm9iZSwKKwkuZHJpdmVyCT0geworCQkubmFtZQkJPSAicGh5LWcxMmEt dXNiMy1wY2llIiwKKwkJLm9mX21hdGNoX3RhYmxlCT0gcGh5X2cxMmFfdXNiM19wY2llX29mX21h dGNoLAorCX0sCit9OworbW9kdWxlX3BsYXRmb3JtX2RyaXZlcihwaHlfZzEyYV91c2IzX3BjaWVf ZHJpdmVyKTsKKworTU9EVUxFX0FVVEhPUigiTmVpbCBBcm1zdHJvbmcgPG5hcm1zdHJvbmdAYmF5 bGlicmUuY29tPiIpOworTU9EVUxFX0RFU0NSSVBUSU9OKCJBbWxvZ2ljIEcxMkEgVVNCMyArIFBD SUUgQ29tYm8gUEhZIGRyaXZlciIpOworTU9EVUxFX0xJQ0VOU0UoIkdQTCB2MiIpOwo=