Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: base64 Subject: [v2,6/8] phy: amlogic: Add Amlogic G12A USB3 + PCIE Combo PHY Driver From: Neil Armstrong Message-Id: <20190304103846.2060-7-narmstrong@baylibre.com> Date: Mon, 4 Mar 2019 11:38:44 +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 List-ID: VGhpcyBhZGRzIHN1cHBvcnQgZm9yIHRoZSBzaGFyZWQgVVNCMyArIFBDSUUgUEhZIGZvdW5kIGlu IHRoZQpBbWxvZ2ljIEcxMkEgU29DIEZhbWlseS4KCkl0IHN1cHBvcnRzIFVTQjMgSG9zdCBtb2Rl IG9yIFBDSUUgMi4wIG1vZGUsIGRlcGVuZGluZyBvbiB0aGUgbGF5b3V0IG9mCnRoZSBib2FyZC4K ClNlbGVjdGlvbiBpcyBkb25lIGJ5IHRoZSAjcGh5LWNlbGxzLCBtYWtpbmcgdGhlIG1vZGUgc3Rh dGljIGFuZCBleGNsdXNpdmUuCgpTaWduZWQtb2ZmLWJ5OiBOZWlsIEFybXN0cm9uZyA8bmFybXN0 cm9uZ0BiYXlsaWJyZS5jb20+Ci0tLQogZHJpdmVycy9waHkvYW1sb2dpYy9LY29uZmlnICAgICAg ICAgICAgICAgICAgIHwgIDExICsKIGRyaXZlcnMvcGh5L2FtbG9naWMvTWFrZWZpbGUgICAgICAg ICAgICAgICAgICB8ICAgMSArCiAuLi4vcGh5L2FtbG9naWMvcGh5LW1lc29uLWcxMmEtdXNiMy1w Y2llLmMgICAgfCA0MTEgKysrKysrKysrKysrKysrKysrCiAzIGZpbGVzIGNoYW5nZWQsIDQyMyBp bnNlcnRpb25zKCspCiBjcmVhdGUgbW9kZSAxMDA2NDQgZHJpdmVycy9waHkvYW1sb2dpYy9waHkt bWVzb24tZzEyYS11c2IzLXBjaWUuYwoKZGlmZiAtLWdpdCBhL2RyaXZlcnMvcGh5L2FtbG9naWMv S2NvbmZpZyBiL2RyaXZlcnMvcGh5L2FtbG9naWMvS2NvbmZpZwppbmRleCA1NjBmZjBmMWVkNGMu LjRjMDhjMWNjZGQwNCAxMDA2NDQKLS0tIGEvZHJpdmVycy9waHkvYW1sb2dpYy9LY29uZmlnCisr KyBiL2RyaXZlcnMvcGh5L2FtbG9naWMvS2NvbmZpZwpAQCAtNDcsMyArNDcsMTQgQEAgY29uZmln IFBIWV9NRVNPTl9HMTJBX1VTQjIKIAkgIEVuYWJsZSB0aGlzIHRvIHN1cHBvcnQgdGhlIE1lc29u IFVTQjIgUEhZcyBmb3VuZCBpbiBNZXNvbgogCSAgRzEyQSBTb0NzLgogCSAgSWYgdW5zdXJlLCBz YXkgTi4KKworY29uZmlnIFBIWV9NRVNPTl9HMTJBX1VTQjNfUENJRQorCXRyaXN0YXRlICJNZXNv biBHMTJBIFVTQjMrUENJRSBDb21ibyBQSFkgZHJpdmVyIgorCWRlZmF1bHQgQVJDSF9NRVNPTgor CWRlcGVuZHMgb24gT0YgJiYgKEFSQ0hfTUVTT04gfHwgQ09NUElMRV9URVNUKQorCXNlbGVjdCBH RU5FUklDX1BIWQorCXNlbGVjdCBSRUdNQVBfTU1JTworCWhlbHAKKwkgIEVuYWJsZSB0aGlzIHRv IHN1cHBvcnQgdGhlIE1lc29uIFVTQjMgKyBQQ0lFIENvbWJvIFBIWSBmb3VuZAorCSAgaW4gTWVz b24gRzEyQSBTb0NzLgorCSAgSWYgdW5zdXJlLCBzYXkgTi4KZGlmZiAtLWdpdCBhL2RyaXZlcnMv cGh5L2FtbG9naWMvTWFrZWZpbGUgYi9kcml2ZXJzL3BoeS9hbWxvZ2ljL01ha2VmaWxlCmluZGV4 IDdkNGQxMGY1YTZiMy4uZmRkMDA4ZTFiMTliIDEwMDY0NAotLS0gYS9kcml2ZXJzL3BoeS9hbWxv Z2ljL01ha2VmaWxlCisrKyBiL2RyaXZlcnMvcGh5L2FtbG9naWMvTWFrZWZpbGUKQEAgLTIsMyAr Miw0IEBAIG9iai0kKENPTkZJR19QSFlfTUVTT044Ql9VU0IyKQkJKz0gcGh5LW1lc29uOGItdXNi Mi5vCiBvYmotJChDT05GSUdfUEhZX01FU09OX0dYTF9VU0IyKQkrPSBwaHktbWVzb24tZ3hsLXVz YjIubwogb2JqLSQoQ09ORklHX1BIWV9NRVNPTl9HMTJBX1VTQjIpCSs9IHBoeS1tZXNvbi1nMTJh LXVzYjIubwogb2JqLSQoQ09ORklHX1BIWV9NRVNPTl9HWExfVVNCMykJKz0gcGh5LW1lc29uLWd4 bC11c2IzLm8KK29iai0kKENPTkZJR19QSFlfTUVTT05fRzEyQV9VU0IzX1BDSUUpCSs9IHBoeS1t ZXNvbi1nMTJhLXVzYjMtcGNpZS5vCmRpZmYgLS1naXQgYS9kcml2ZXJzL3BoeS9hbWxvZ2ljL3Bo eS1tZXNvbi1nMTJhLXVzYjMtcGNpZS5jIGIvZHJpdmVycy9waHkvYW1sb2dpYy9waHktbWVzb24t ZzEyYS11c2IzLXBjaWUuYwpuZXcgZmlsZSBtb2RlIDEwMDY0NAppbmRleCAwMDAwMDAwMDAwMDAu LmM5NTUxOGQ1MWYxNwotLS0gL2Rldi9udWxsCisrKyBiL2RyaXZlcnMvcGh5L2FtbG9naWMvcGh5 LW1lc29uLWcxMmEtdXNiMy1wY2llLmMKQEAgLTAsMCArMSw0MTEgQEAKKy8vIFNQRFgtTGljZW5z ZS1JZGVudGlmaWVyOiBHUEwtMi4wCisvKgorICogQW1sb2dpYyBHMTJBIFVTQjMgKyBQQ0lFIENv bWJvIFBIWSBkcml2ZXIKKyAqCisgKiBDb3B5cmlnaHQgKEMpIDIwMTcgQW1sb2dpYywgSW5jLiBB bGwgcmlnaHRzIHJlc2VydmVkCisgKiBDb3B5cmlnaHQgKEMpIDIwMTkgQmF5TGlicmUsIFNBUwor ICogQXV0aG9yOiBOZWlsIEFybXN0cm9uZyA8bmFybXN0cm9uZ0BiYXlsaWJyZS5jb20+CisgKi8K KworI2luY2x1ZGUgPGxpbnV4L2JpdGZpZWxkLmg+CisjaW5jbHVkZSA8bGludXgvYml0b3BzLmg+ CisjaW5jbHVkZSA8bGludXgvY2xrLmg+CisjaW5jbHVkZSA8bGludXgvbW9kdWxlLmg+CisjaW5j bHVkZSA8bGludXgvb2ZfZGV2aWNlLmg+CisjaW5jbHVkZSA8bGludXgvcGh5L3BoeS5oPgorI2lu Y2x1ZGUgPGxpbnV4L3JlZ21hcC5oPgorI2luY2x1ZGUgPGxpbnV4L3Jlc2V0Lmg+CisjaW5jbHVk ZSA8bGludXgvcGxhdGZvcm1fZGV2aWNlLmg+CisjaW5jbHVkZSA8ZHQtYmluZGluZ3MvcGh5L3Bo eS5oPgorCisjZGVmaW5lIFBIWV9SMAkJCQkJCQkweDAwCisJI2RlZmluZSBQSFlfUjBfUENJRV9Q T1dFUl9TVEFURQkJCQlHRU5NQVNLKDQsIDApCisJI2RlZmluZSBQSFlfUjBfUENJRV9VU0IzX1NX SVRDSAkJCQlHRU5NQVNLKDYsIDUpCisKKyNkZWZpbmUgUEhZX1IxCQkJCQkJCTB4MDQKKwkjZGVm aW5lIFBIWV9SMV9QSFlfVFgxX1RFUk1fT0ZGU0VUCQkJR0VOTUFTSyg0LCAwKQorCSNkZWZpbmUg UEhZX1IxX1BIWV9UWDBfVEVSTV9PRkZTRVQJCQlHRU5NQVNLKDksIDUpCisJI2RlZmluZSBQSFlf UjFfUEhZX1JYMV9FUQkJCQlHRU5NQVNLKDEyLCAxMCkKKwkjZGVmaW5lIFBIWV9SMV9QSFlfUlgw X0VRCQkJCUdFTk1BU0soMTUsIDEzKQorCSNkZWZpbmUgUEhZX1IxX1BIWV9MT1NfTEVWRUwJCQkJ R0VOTUFTSygyMCwgMTYpCisJI2RlZmluZSBQSFlfUjFfUEhZX0xPU19CSUFTCQkJCUdFTk1BU0so MjMsIDIxKQorCSNkZWZpbmUgUEhZX1IxX1BIWV9SRUZfQ0xLRElWMgkJCQlCSVQoMjQpCisJI2Rl ZmluZSBQSFlfUjFfUEhZX01QTExfTVVMVElQTElFUgkJCUdFTk1BU0soMzEsIDI1KQorCisjZGVm aW5lIFBIWV9SMgkJCQkJCQkweDA4CisJI2RlZmluZSBQSFlfUjJfUENTX1RYX0RFRU1QSF9HRU4y XzZEQgkJCUdFTk1BU0soNSwgMCkKKwkjZGVmaW5lIFBIWV9SMl9QQ1NfVFhfREVFTVBIX0dFTjJf M1A1REIJCQlHRU5NQVNLKDExLCA2KQorCSNkZWZpbmUgUEhZX1IyX1BDU19UWF9ERUVNUEhfR0VO MQkJCUdFTk1BU0soMTcsIDEyKQorCSNkZWZpbmUgUEhZX1IyX1BIWV9UWF9WQk9PU1RfTFZMCQkJ R0VOTUFTSygyMCwgMTgpCisKKyNkZWZpbmUgUEhZX1I0CQkJCQkJCTB4MTAKKwkjZGVmaW5lIFBI WV9SNF9QSFlfQ1JfV1JJVEUJCQkJQklUKDApCisJI2RlZmluZSBQSFlfUjRfUEhZX0NSX1JFQUQJ CQkJQklUKDEpCisJI2RlZmluZSBQSFlfUjRfUEhZX0NSX0RBVEFfSU4JCQkJR0VOTUFTSygxNywg MikKKwkjZGVmaW5lIFBIWV9SNF9QSFlfQ1JfQ0FQX0RBVEEJCQkJQklUKDE4KQorCSNkZWZpbmUg UEhZX1I0X1BIWV9DUl9DQVBfQUREUgkJCQlCSVQoMTkpCisKKyNkZWZpbmUgUEhZX1I1CQkJCQkJ CTB4MTQKKwkjZGVmaW5lIFBIWV9SNV9QSFlfQ1JfREFUQV9PVVQJCQkJR0VOTUFTSygxNSwgMCkK KwkjZGVmaW5lIFBIWV9SNV9QSFlfQ1JfQUNLCQkJCUJJVCgxNikKKwkjZGVmaW5lIFBIWV9SNV9Q SFlfQlNfT1VUCQkJCUJJVCgxNykKKworc3RydWN0IHBoeV9nMTJhX3VzYjNfcGNpZV9wcml2IHsK KwlzdHJ1Y3QgcmVnbWFwCQkqcmVnbWFwOworCXN0cnVjdCByZWdtYXAJCSpyZWdtYXBfY3I7CisJ c3RydWN0IGNsawkJKmNsa19yZWY7CisJc3RydWN0IHJlc2V0X2NvbnRyb2wJKnJlc2V0OworCXN0 cnVjdCBwaHkJCSpwaHk7CisJdW5zaWduZWQgaW50CQltb2RlOworfTsKKworc3RhdGljIGNvbnN0 IHN0cnVjdCByZWdtYXBfY29uZmlnIHBoeV9nMTJhX3VzYjNfcGNpZV9yZWdtYXBfY29uZiA9IHsK KwkucmVnX2JpdHMgPSA4LAorCS52YWxfYml0cyA9IDMyLAorCS5yZWdfc3RyaWRlID0gNCwKKwku bWF4X3JlZ2lzdGVyID0gUEhZX1I1LAorfTsKKworc3RhdGljIGludCBwaHlfZzEyYV91c2IzX3Bj aWVfY3JfYnVzX2FkZHIoc3RydWN0IHBoeV9nMTJhX3VzYjNfcGNpZV9wcml2ICpwcml2LAorCQkJ CQkgIHVuc2lnbmVkIGludCBhZGRyKQoreworCXVuc2lnbmVkIGludCB2YWwsIHJlZzsKKwlpbnQg cmV0OworCisJcmVnID0gRklFTERfUFJFUChQSFlfUjRfUEhZX0NSX0RBVEFfSU4sIGFkZHIpOwor CisJcmVnbWFwX3dyaXRlKHByaXYtPnJlZ21hcCwgUEhZX1I0LCByZWcpOworCXJlZ21hcF93cml0 ZShwcml2LT5yZWdtYXAsIFBIWV9SNCwgcmVnKTsKKworCXJlZ21hcF93cml0ZShwcml2LT5yZWdt YXAsIFBIWV9SNCwgcmVnIHwgUEhZX1I0X1BIWV9DUl9DQVBfQUREUik7CisKKwlyZXQgPSByZWdt YXBfcmVhZF9wb2xsX3RpbWVvdXQocHJpdi0+cmVnbWFwLCBQSFlfUjUsIHZhbCwKKwkJCQkgICAg ICAgKHZhbCAmIFBIWV9SNV9QSFlfQ1JfQUNLKSwKKwkJCQkgICAgICAgNSwgMTAwMCk7CisJaWYg KHJldCkKKwkJcmV0dXJuIHJldDsKKworCXJlZ21hcF93cml0ZShwcml2LT5yZWdtYXAsIFBIWV9S NCwgcmVnKTsKKworCXJldCA9IHJlZ21hcF9yZWFkX3BvbGxfdGltZW91dChwcml2LT5yZWdtYXAs IFBIWV9SNSwgdmFsLAorCQkJCSAgICAgICAhKHZhbCAmIFBIWV9SNV9QSFlfQ1JfQUNLKSwKKwkJ CQkgICAgICAgNSwgMTAwMCk7CisJaWYgKHJldCkKKwkJcmV0dXJuIHJldDsKKworCXJldHVybiAw OworfQorCitzdGF0aWMgaW50IHBoeV9nMTJhX3VzYjNfcGNpZV9jcl9idXNfcmVhZCh2b2lkICpj b250ZXh0LCB1bnNpZ25lZCBpbnQgYWRkciwKKwkJCQkJICB1bnNpZ25lZCBpbnQgKmRhdGEpCit7 CisJc3RydWN0IHBoeV9nMTJhX3VzYjNfcGNpZV9wcml2ICpwcml2ID0gY29udGV4dDsKKwl1bnNp Z25lZCBpbnQgdmFsOworCWludCByZXQ7CisKKwlyZXQgPSBwaHlfZzEyYV91c2IzX3BjaWVfY3Jf YnVzX2FkZHIocHJpdiwgYWRkcik7CisJaWYgKHJldCkKKwkJcmV0dXJuIHJldDsKKworCXJlZ21h cF93cml0ZShwcml2LT5yZWdtYXAsIFBIWV9SNCwgMCk7CisJcmVnbWFwX3dyaXRlKHByaXYtPnJl Z21hcCwgUEhZX1I0LCBQSFlfUjRfUEhZX0NSX1JFQUQpOworCisJcmV0ID0gcmVnbWFwX3JlYWRf cG9sbF90aW1lb3V0KHByaXYtPnJlZ21hcCwgUEhZX1I1LCB2YWwsCisJCQkJICAgICAgICh2YWwg JiBQSFlfUjVfUEhZX0NSX0FDSyksCisJCQkJICAgICAgIDUsIDEwMDApOworCWlmIChyZXQpCisJ CXJldHVybiByZXQ7CisKKwkqZGF0YSA9IEZJRUxEX0dFVChQSFlfUjVfUEhZX0NSX0RBVEFfT1VU LCB2YWwpOworCisJcmVnbWFwX3dyaXRlKHByaXYtPnJlZ21hcCwgUEhZX1I0LCAwKTsKKworCXJl dCA9IHJlZ21hcF9yZWFkX3BvbGxfdGltZW91dChwcml2LT5yZWdtYXAsIFBIWV9SNSwgdmFsLAor CQkJCSAgICAgICAhKHZhbCAmIFBIWV9SNV9QSFlfQ1JfQUNLKSwKKwkJCQkgICAgICAgNSwgMTAw MCk7CisJaWYgKHJldCkKKwkJcmV0dXJuIHJldDsKKworCXJldHVybiAwOworfQorCitzdGF0aWMg aW50IHBoeV9nMTJhX3VzYjNfcGNpZV9jcl9idXNfd3JpdGUodm9pZCAqY29udGV4dCwgdW5zaWdu ZWQgaW50IGFkZHIsCisJCQkJCSAgIHVuc2lnbmVkIGludCBkYXRhKQoreworCXN0cnVjdCBwaHlf ZzEyYV91c2IzX3BjaWVfcHJpdiAqcHJpdiA9IGNvbnRleHQ7CisJdW5zaWduZWQgaW50IHZhbCwg cmVnOworCWludCByZXQ7CisKKwlyZXQgPSBwaHlfZzEyYV91c2IzX3BjaWVfY3JfYnVzX2FkZHIo cHJpdiwgYWRkcik7CisJaWYgKHJldCkKKwkJcmV0dXJuIHJldDsKKworCXJlZyA9IEZJRUxEX1BS RVAoUEhZX1I0X1BIWV9DUl9EQVRBX0lOLCBkYXRhKTsKKworCXJlZ21hcF93cml0ZShwcml2LT5y ZWdtYXAsIFBIWV9SNCwgcmVnKTsKKwlyZWdtYXBfd3JpdGUocHJpdi0+cmVnbWFwLCBQSFlfUjQs IHJlZyk7CisKKwlyZWdtYXBfd3JpdGUocHJpdi0+cmVnbWFwLCBQSFlfUjQsIHJlZyB8IFBIWV9S NF9QSFlfQ1JfQ0FQX0RBVEEpOworCisJcmV0ID0gcmVnbWFwX3JlYWRfcG9sbF90aW1lb3V0KHBy aXYtPnJlZ21hcCwgUEhZX1I1LCB2YWwsCisJCQkJICAgICAgICh2YWwgJiBQSFlfUjVfUEhZX0NS X0FDSyksCisJCQkJICAgICAgIDUsIDEwMDApOworCWlmIChyZXQpCisJCXJldHVybiByZXQ7CisK KwlyZWdtYXBfd3JpdGUocHJpdi0+cmVnbWFwLCBQSFlfUjQsIHJlZyk7CisKKwlyZXQgPSByZWdt YXBfcmVhZF9wb2xsX3RpbWVvdXQocHJpdi0+cmVnbWFwLCBQSFlfUjUsIHZhbCwKKwkJCQkgICAg ICAgKHZhbCAmIFBIWV9SNV9QSFlfQ1JfQUNLKSA9PSAwLAorCQkJCSAgICAgICA1LCAxMDAwKTsK KwlpZiAocmV0KQorCQlyZXR1cm4gcmV0OworCisJcmVnbWFwX3dyaXRlKHByaXYtPnJlZ21hcCwg UEhZX1I0LCByZWcpOworCisJcmVnbWFwX3dyaXRlKHByaXYtPnJlZ21hcCwgUEhZX1I0LCByZWcg fCBQSFlfUjRfUEhZX0NSX1dSSVRFKTsKKworCXJldCA9IHJlZ21hcF9yZWFkX3BvbGxfdGltZW91 dChwcml2LT5yZWdtYXAsIFBIWV9SNSwgdmFsLAorCQkJCSAgICAgICAodmFsICYgUEhZX1I1X1BI WV9DUl9BQ0spLAorCQkJCSAgICAgICA1LCAxMDAwKTsKKwlpZiAocmV0KQorCQlyZXR1cm4gcmV0 OworCisJcmVnbWFwX3dyaXRlKHByaXYtPnJlZ21hcCwgUEhZX1I0LCByZWcpOworCisJcmV0ID0g cmVnbWFwX3JlYWRfcG9sbF90aW1lb3V0KHByaXYtPnJlZ21hcCwgUEhZX1I1LCB2YWwsCisJCQkJ ICAgICAgICh2YWwgJiBQSFlfUjVfUEhZX0NSX0FDSykgPT0gMCwKKwkJCQkgICAgICAgNSwgMTAw MCk7CisJaWYgKHJldCkKKwkJcmV0dXJuIHJldDsKKworCXJldHVybiAwOworfQorCitzdGF0aWMg Y29uc3Qgc3RydWN0IHJlZ21hcF9jb25maWcgcGh5X2cxMmFfdXNiM19wY2llX2NyX3JlZ21hcF9j b25mID0geworCS5yZWdfYml0cyA9IDE2LAorCS52YWxfYml0cyA9IDE2LAorCS5yZWdfcmVhZCA9 IHBoeV9nMTJhX3VzYjNfcGNpZV9jcl9idXNfcmVhZCwKKwkucmVnX3dyaXRlID0gcGh5X2cxMmFf dXNiM19wY2llX2NyX2J1c193cml0ZSwKKwkubWF4X3JlZ2lzdGVyID0gMHhmZmZmLAorCS5mYXN0 X2lvID0gdHJ1ZSwKK307CisKK3N0YXRpYyBpbnQgcGh5X2cxMmFfdXNiM19pbml0KHN0cnVjdCBw aHkgKnBoeSkKK3sKKwlzdHJ1Y3QgcGh5X2cxMmFfdXNiM19wY2llX3ByaXYgKnByaXYgPSBwaHlf Z2V0X2RydmRhdGEocGh5KTsKKwlpbnQgZGF0YSwgcmV0OworCisJLyogU3dpdGNoIFBIWSB0byBV U0IzICovCisJcmVnbWFwX3VwZGF0ZV9iaXRzKHByaXYtPnJlZ21hcCwgUEhZX1IwLAorCQkJICAg UEhZX1IwX1BDSUVfVVNCM19TV0lUQ0gsCisJCQkgICBQSFlfUjBfUENJRV9VU0IzX1NXSVRDSCk7 CisKKwkvKgorCSAqIFdPUktBUk9VTkQ6IFRoZXJlIGlzIFNTUEhZIHN1c3BlbmQgYnVnIGR1ZSB0 bworCSAqIHdoaWNoIFVTQiBlbnVtZXJhdGVzCisJICogaW4gSFMgbW9kZSBpbnN0ZWFkIG9mIFNT IG1vZGUuIFdvcmthcm91bmQgaXQgYnkgYXNzZXJ0aW5nCisJICogTEFORTAuVFhfQUxUX0JMT0NL LkVOX0FMVF9CVVMgdG8gZW5hYmxlIFRYIHRvIHVzZSBhbHQgYnVzCisJICogbW9kZQorCSAqLwor CXJldCA9IHJlZ21hcF91cGRhdGVfYml0cyhwcml2LT5yZWdtYXBfY3IsIDB4MTAyZCwgQklUKDcp LCBCSVQoNykpOworCWlmIChyZXQpCisJCXJldHVybiByZXQ7CisKKwlyZXQgPSByZWdtYXBfdXBk YXRlX2JpdHMocHJpdi0+cmVnbWFwX2NyLCAweDEwMTAsIDB4ZmYwLCAyMCk7CisJaWYgKHJldCkK KwkJcmV0dXJuIHJldDsKKworCS8qCisJICogRml4IFJYIEVxdWFsaXphdGlvbiBzZXR0aW5nIGFz IGZvbGxvd3MKKwkgKiBMQU5FMC5SWF9PVlJEX0lOX0hJLiBSWF9FUV9FTiBzZXQgdG8gMAorCSAq IExBTkUwLlJYX09WUkRfSU5fSEkuUlhfRVFfRU5fT1ZSRCBzZXQgdG8gMQorCSAqIExBTkUwLlJY X09WUkRfSU5fSEkuUlhfRVEgc2V0IHRvIDMKKwkgKiBMQU5FMC5SWF9PVlJEX0lOX0hJLlJYX0VR X09WUkQgc2V0IHRvIDEKKwkgKi8KKwlyZXQgPSByZWdtYXBfcmVhZChwcml2LT5yZWdtYXBfY3Is IDB4MTAwNiwgJmRhdGEpOworCWlmIChyZXQpCisJCXJldHVybiByZXQ7CisKKwlkYXRhICY9IH5C SVQoNik7CisJZGF0YSB8PSBCSVQoNyk7CisJZGF0YSAmPSB+KDB4NyA8PCA4KTsKKwlkYXRhIHw9 ICgweDMgPDwgOCk7CisJZGF0YSB8PSAoMSA8PCAxMSk7CisJcmV0ID0gcmVnbWFwX3dyaXRlKHBy aXYtPnJlZ21hcF9jciwgMHgxMDA2LCBkYXRhKTsKKwlpZiAocmV0KQorCQlyZXR1cm4gcmV0Owor CisJLyoKKwkgKiBTZXQgRVEgYW5kIFRYIGxhdW5jaCBhbXBsaXR1ZGVzIGFzIGZvbGxvd3MKKwkg KiBMQU5FMC5UWF9PVlJEX0RSVl9MTy5QUkVFTVBIIHNldCB0byAyMgorCSAqIExBTkUwLlRYX09W UkRfRFJWX0xPLkFNUExJVFVERSBzZXQgdG8gMTI3CisJICogTEFORTAuVFhfT1ZSRF9EUlZfTE8u RU4gc2V0IHRvIDEuCisJICovCisJcmV0ID0gcmVnbWFwX3JlYWQocHJpdi0+cmVnbWFwX2NyLCAw eDEwMDIsICZkYXRhKTsKKwlpZiAocmV0KQorCQlyZXR1cm4gcmV0OworCisJZGF0YSAmPSB+MHgz ZjgwOworCWRhdGEgfD0gKDB4MTYgPDwgNyk7CisJZGF0YSAmPSB+MHg3ZjsKKwlkYXRhIHw9ICgw eDdmIHwgQklUKDE0KSk7CisJcmV0ID0gcmVnbWFwX3dyaXRlKHByaXYtPnJlZ21hcF9jciwgMHgx MDAyLCBkYXRhKTsKKwlpZiAocmV0KQorCQlyZXR1cm4gcmV0OworCisJLyogTVBMTF9MT09QX0NU TC5QUk9QX0NOVFJMID0gOCAqLworCXJldCA9IHJlZ21hcF91cGRhdGVfYml0cyhwcml2LT5yZWdt YXBfY3IsIDB4MzAsIDB4ZiA8PCA0LCA4IDw8IDQpOworCWlmIChyZXQpCisJCXJldHVybiByZXQ7 CisKKwlyZWdtYXBfdXBkYXRlX2JpdHMocHJpdi0+cmVnbWFwLCBQSFlfUjIsCisJCQlQSFlfUjJf UEhZX1RYX1ZCT09TVF9MVkwsCisJCQlGSUVMRF9QUkVQKFBIWV9SMl9QSFlfVFhfVkJPT1NUX0xW TCwgMHg0KSk7CisKKwlyZWdtYXBfdXBkYXRlX2JpdHMocHJpdi0+cmVnbWFwLCBQSFlfUjEsCisJ CQlQSFlfUjFfUEhZX0xPU19CSUFTIHwgUEhZX1IxX1BIWV9MT1NfTEVWRUwsCisJCQlGSUVMRF9Q UkVQKFBIWV9SMV9QSFlfTE9TX0JJQVMsIDQpIHwKKwkJCUZJRUxEX1BSRVAoUEhZX1IxX1BIWV9M T1NfTEVWRUwsIDkpKTsKKworCXJldHVybiAwOworfQorCitzdGF0aWMgaW50IHBoeV9nMTJhX3Vz YjNfcGNpZV9pbml0KHN0cnVjdCBwaHkgKnBoeSkKK3sKKwlzdHJ1Y3QgcGh5X2cxMmFfdXNiM19w Y2llX3ByaXYgKnByaXYgPSBwaHlfZ2V0X2RydmRhdGEocGh5KTsKKwlpbnQgcmV0OworCisJcmV0 ID0gcmVzZXRfY29udHJvbF9yZXNldChwcml2LT5yZXNldCk7CisJaWYgKHJldCkKKwkJcmV0dXJu IHJldDsKKworCWlmIChwcml2LT5tb2RlID09IFBIWV9UWVBFX1VTQjMpCisJCXJldHVybiBwaHlf ZzEyYV91c2IzX2luaXQocGh5KTsKKworCS8qIFBvd2VyIFVQIFBDSUUgKi8KKwlyZWdtYXBfdXBk YXRlX2JpdHMocHJpdi0+cmVnbWFwLCBQSFlfUjAsCisJCQkgICBQSFlfUjBfUENJRV9QT1dFUl9T VEFURSwKKwkJCSAgIEZJRUxEX1BSRVAoUEhZX1IwX1BDSUVfUE9XRVJfU1RBVEUsIDB4MWMpKTsK KworCXJldHVybiAwOworfQorCitzdGF0aWMgaW50IHBoeV9nMTJhX3VzYjNfcGNpZV9leGl0KHN0 cnVjdCBwaHkgKnBoeSkKK3sKKwlzdHJ1Y3QgcGh5X2cxMmFfdXNiM19wY2llX3ByaXYgKnByaXYg PSBwaHlfZ2V0X2RydmRhdGEocGh5KTsKKworCXJldHVybiByZXNldF9jb250cm9sX3Jlc2V0KHBy aXYtPnJlc2V0KTsKK30KKworc3RhdGljIHN0cnVjdCBwaHkgKnBoeV9nMTJhX3VzYjNfcGNpZV94 bGF0ZShzdHJ1Y3QgZGV2aWNlICpkZXYsCisJCQkJCSAgICBzdHJ1Y3Qgb2ZfcGhhbmRsZV9hcmdz ICphcmdzKQoreworCXN0cnVjdCBwaHlfZzEyYV91c2IzX3BjaWVfcHJpdiAqcHJpdiA9IGRldl9n ZXRfZHJ2ZGF0YShkZXYpOworCXVuc2lnbmVkIGludCBtb2RlOworCisJaWYgKGFyZ3MtPmFyZ3Nf Y291bnQgPCAxKSB7CisJCWRldl9lcnIoZGV2LCAiaW52YWxpZCBudW1iZXIgb2YgYXJndW1lbnRz XG4iKTsKKwkJcmV0dXJuIEVSUl9QVFIoLUVJTlZBTCk7CisJfQorCisJbW9kZSA9IGFyZ3MtPmFy Z3NbMF07CisKKwlpZiAobW9kZSAhPSBQSFlfVFlQRV9VU0IzICYmIG1vZGUgIT0gUEhZX1RZUEVf UENJRSkgeworCQlkZXZfZXJyKGRldiwgImludmFsaWQgcGh5IG1vZGUgc2VsZWN0IGFyZ3VtZW50 XG4iKTsKKwkJcmV0dXJuIEVSUl9QVFIoLUVJTlZBTCk7CisJfQorCisJcHJpdi0+bW9kZSA9IG1v ZGU7CisKKwlyZXR1cm4gcHJpdi0+cGh5OworfQorCitzdGF0aWMgY29uc3Qgc3RydWN0IHBoeV9v cHMgcGh5X2cxMmFfdXNiM19wY2llX29wcyA9IHsKKwkuaW5pdAkJPSBwaHlfZzEyYV91c2IzX3Bj aWVfaW5pdCwKKwkuZXhpdAkJPSBwaHlfZzEyYV91c2IzX3BjaWVfZXhpdCwKKwkub3duZXIJCT0g VEhJU19NT0RVTEUsCit9OworCitzdGF0aWMgaW50IHBoeV9nMTJhX3VzYjNfcGNpZV9wcm9iZShz dHJ1Y3QgcGxhdGZvcm1fZGV2aWNlICpwZGV2KQoreworCXN0cnVjdCBkZXZpY2UgKmRldiA9ICZw ZGV2LT5kZXY7CisJc3RydWN0IGRldmljZV9ub2RlICpucCA9IGRldi0+b2Zfbm9kZTsKKwlzdHJ1 Y3QgcGh5X2cxMmFfdXNiM19wY2llX3ByaXYgKnByaXY7CisJc3RydWN0IHJlc291cmNlICpyZXM7 CisJc3RydWN0IHBoeV9wcm92aWRlciAqcGh5X3Byb3ZpZGVyOworCXZvaWQgX19pb21lbSAqYmFz ZTsKKwlpbnQgcmV0OworCisJcHJpdiA9IGRldm1fa3phbGxvYyhkZXYsIHNpemVvZigqcHJpdiks IEdGUF9LRVJORUwpOworCWlmICghcHJpdikKKwkJcmV0dXJuIC1FTk9NRU07CisKKwlyZXMgPSBw bGF0Zm9ybV9nZXRfcmVzb3VyY2UocGRldiwgSU9SRVNPVVJDRV9NRU0sIDApOworCWJhc2UgPSBk ZXZtX2lvcmVtYXBfcmVzb3VyY2UoZGV2LCByZXMpOworCWlmIChJU19FUlIoYmFzZSkpCisJCXJl dHVybiBQVFJfRVJSKGJhc2UpOworCisJcHJpdi0+cmVnbWFwID0gZGV2bV9yZWdtYXBfaW5pdF9t bWlvKGRldiwgYmFzZSwKKwkJCQkJICAgICAmcGh5X2cxMmFfdXNiM19wY2llX3JlZ21hcF9jb25m KTsKKwlpZiAoSVNfRVJSKHByaXYtPnJlZ21hcCkpCisJCXJldHVybiBQVFJfRVJSKHByaXYtPnJl Z21hcCk7CisKKwlwcml2LT5yZWdtYXBfY3IgPSBkZXZtX3JlZ21hcF9pbml0KGRldiwgTlVMTCwg cHJpdiwKKwkJCQkJICAgJnBoeV9nMTJhX3VzYjNfcGNpZV9jcl9yZWdtYXBfY29uZik7CisJaWYg KElTX0VSUihwcml2LT5yZWdtYXBfY3IpKQorCQlyZXR1cm4gUFRSX0VSUihwcml2LT5yZWdtYXBf Y3IpOworCisJcHJpdi0+Y2xrX3JlZiA9IGRldm1fY2xrX2dldChkZXYsICJyZWZfY2xrIik7CisJ aWYgKElTX0VSUihwcml2LT5jbGtfcmVmKSkKKwkJcmV0dXJuIFBUUl9FUlIocHJpdi0+Y2xrX3Jl Zik7CisKKwlyZXQgPSBjbGtfcHJlcGFyZV9lbmFibGUocHJpdi0+Y2xrX3JlZik7CisJaWYgKHJl dCkKKwkJZ290byBlcnJfZGlzYWJsZV9jbGtfcmVmOworCisJcHJpdi0+cmVzZXQgPSBkZXZtX3Jl c2V0X2NvbnRyb2xfYXJyYXlfZ2V0KGRldiwgZmFsc2UsIGZhbHNlKTsKKwlpZiAoSVNfRVJSKHBy aXYtPnJlc2V0KSkKKwkJcmV0dXJuIFBUUl9FUlIocHJpdi0+cmVzZXQpOworCisJcHJpdi0+cGh5 ID0gZGV2bV9waHlfY3JlYXRlKGRldiwgbnAsICZwaHlfZzEyYV91c2IzX3BjaWVfb3BzKTsKKwlp ZiAoSVNfRVJSKHByaXYtPnBoeSkpIHsKKwkJcmV0ID0gUFRSX0VSUihwcml2LT5waHkpOworCQlp ZiAocmV0ICE9IC1FUFJPQkVfREVGRVIpCisJCQlkZXZfZXJyKGRldiwgImZhaWxlZCB0byBjcmVh dGUgUEhZXG4iKTsKKworCQlyZXR1cm4gcmV0OworCX0KKworCXBoeV9zZXRfZHJ2ZGF0YShwcml2 LT5waHksIHByaXYpOworCWRldl9zZXRfZHJ2ZGF0YShkZXYsIHByaXYpOworCisJcGh5X3Byb3Zp ZGVyID0gZGV2bV9vZl9waHlfcHJvdmlkZXJfcmVnaXN0ZXIoZGV2LAorCQkJCQkJICAgICBwaHlf ZzEyYV91c2IzX3BjaWVfeGxhdGUpOworCisJcmV0dXJuIFBUUl9FUlJfT1JfWkVSTyhwaHlfcHJv dmlkZXIpOworCitlcnJfZGlzYWJsZV9jbGtfcmVmOgorCWNsa19kaXNhYmxlX3VucHJlcGFyZShw cml2LT5jbGtfcmVmKTsKKworCXJldHVybiByZXQ7Cit9CisKK3N0YXRpYyBjb25zdCBzdHJ1Y3Qg b2ZfZGV2aWNlX2lkIHBoeV9nMTJhX3VzYjNfcGNpZV9vZl9tYXRjaFtdID0geworCXsgLmNvbXBh dGlibGUgPSAiYW1sb2dpYyxnMTJhLXVzYjMtcGNpZS1waHkiLCB9LAorCXsgfSwKK307CitNT0RV TEVfREVWSUNFX1RBQkxFKG9mLCBwaHlfZzEyYV91c2IzX3BjaWVfb2ZfbWF0Y2gpOworCitzdGF0 aWMgc3RydWN0IHBsYXRmb3JtX2RyaXZlciBwaHlfZzEyYV91c2IzX3BjaWVfZHJpdmVyID0gewor CS5wcm9iZQk9IHBoeV9nMTJhX3VzYjNfcGNpZV9wcm9iZSwKKwkuZHJpdmVyCT0geworCQkubmFt ZQkJPSAicGh5LWcxMmEtdXNiMy1wY2llIiwKKwkJLm9mX21hdGNoX3RhYmxlCT0gcGh5X2cxMmFf dXNiM19wY2llX29mX21hdGNoLAorCX0sCit9OworbW9kdWxlX3BsYXRmb3JtX2RyaXZlcihwaHlf ZzEyYV91c2IzX3BjaWVfZHJpdmVyKTsKKworTU9EVUxFX0FVVEhPUigiTmVpbCBBcm1zdHJvbmcg PG5hcm1zdHJvbmdAYmF5bGlicmUuY29tPiIpOworTU9EVUxFX0RFU0NSSVBUSU9OKCJBbWxvZ2lj IEcxMkEgVVNCMyArIFBDSUUgQ29tYm8gUEhZIGRyaXZlciIpOworTU9EVUxFX0xJQ0VOU0UoIkdQ TCB2MiIpOwo=