Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: base64 Subject: [v8,3/3] usb: typec: ucsi: ccg: add firmware flashing support From: Ajay Gupta Message-Id: <20190416172747.22139-4-ajayg@nvidia.com> Date: Tue, 16 Apr 2019 10:27:47 -0700 To: heikki.krogerus@linux.intel.com Cc: linux-usb@vger.kernel.org, Ajay Gupta List-ID: RnJvbTogQWpheSBHdXB0YSA8YWpheWdAbnZpZGlhLmNvbT4KCkNDR3ggaGFzIHR3byBjb3BpZXMg b2YgdGhlIGZpcm13YXJlIGluIGFkZGl0aW9uIHRvIHRoZSBib290bG9hZGVyLgpJZiB0aGUgZGV2 aWNlIGlzIHJ1bm5pbmcgRlcxLCBGVzIgY2FuIGJlIHVwZGF0ZWQgd2l0aCB0aGUgbmV3IHZlcnNp b24uCkR1YWwgZmlybXdhcmUgbW9kZSBhbGxvd3MgdGhlIENDRyBkZXZpY2UgdG8gc3RheSBpbiBh IFBEIGNvbnRyYWN0IGFuZApzdXBwb3J0IFVTQiBQRCBhbmQgVHlwZS1DIGZ1bmN0aW9uYWxpdHkg d2hpbGUgYSBmaXJtd2FyZSB1cGRhdGUgaXMgaW4KcHJvZ3Jlc3MuCgpGaXJzdCB3ZSByZWFkIHRo ZSBjdXJyZW50bHkgZmxhc2hlZCBmaXJtd2FyZSB2ZXJzaW9uIG9mIGJvdGgKcHJpbWFyeSBhbmQg c2Vjb25kYXJ5IGZpcm13YXJlIGFuZCB0aGVuIGNvbXBhcmUgaXQgd2l0aAp2ZXJzaW9uIG9mIGZp cm13YXJlIGZpbGUgdG8gZGV0ZXJtaW5lIGlmIGZsYXNoaW5nIGlzIHJlcXVpcmVkLgoKQ29tbWFu ZCBmcmFtZXdvcmsgaXMgYWRkZWQgdG8gc3VwcG9ydCBzZW5kaW5nIGNvbW1hbmRzIHRvIENDR3gK Y29udHJvbGxlci4gV2Ugd2FpdCBmb3IgcmVzcG9uc2UgYWZ0ZXIgc2VuZGluZyB0aGUgY29tbWFu ZCBhbmQgdGhlbgpyZWFkIHRoZSByZXNwb25zZSBmcm9tIFJBQl9SRVNQT05TRSByZWdpc3Rlci4K CkJlbG93IGNvbW1hbmRzIGFyZSBzdXBwb3J0ZWQsCgktIEVOVEVSX0ZMQVNISU5HCgktIFJFU0VU CgktIFBEUE9SVF9FTkFCTEUKCS0gSlVNUF9UT19CT09UCgktIEZMQVNIX1JPV19SVwoJLSBWQUxJ REFURV9GVwoKQ29tbWFuZCBzcGVjaWZpYyBtdXRleCBsb2NrIGlzIGFsc28gYWRkZWQgdG8gc3lu YyBiZXR3ZWVuIGRyaXZlcgphbmQgdXNlciB0aHJlYWRzLgoKUEQgcG9ydCBudW1iZXIgaW5mb3Jt YXRpb24gaXMgYWRkZWQgd2hpY2ggaXMgcmVxdWlyZWQgd2hpbGUgc2VuZGluZwpQRF9QT1JUX0VO QUJMRSBjb21tYW5kCgpTaWduZWQtb2ZmLWJ5OiBBamF5IEd1cHRhIDxhamF5Z0BudmlkaWEuY29t PgpTaWduZWQtb2ZmLWJ5OiBIZWlra2kgS3JvZ2VydXMgPGhlaWtraS5rcm9nZXJ1c0BsaW51eC5p bnRlbC5jb20+Ci0tLQpDaGFuZ2VzIGZyb20gdjctPnY4CgktIEZpeGVkIGNvbW1lbnRzIGZyb20g R3JlZyBieSBkcm9wcGluZyBkb19mbGFzaF9zaG93KCkKCiBkcml2ZXJzL3VzYi90eXBlYy91Y3Np L3Vjc2lfY2NnLmMgfCA4MjkgKysrKysrKysrKysrKysrKysrKysrKysrKysrKystCiAxIGZpbGUg Y2hhbmdlZCwgODE2IGluc2VydGlvbnMoKyksIDEzIGRlbGV0aW9ucygtKQoKZGlmZiAtLWdpdCBh L2RyaXZlcnMvdXNiL3R5cGVjL3Vjc2kvdWNzaV9jY2cuYyBiL2RyaXZlcnMvdXNiL3R5cGVjL3Vj c2kvdWNzaV9jY2cuYwppbmRleCAzODg0ZmI0MWM3MmUuLjIyYWUwNTAxZWViNSAxMDA2NDQKLS0t IGEvZHJpdmVycy91c2IvdHlwZWMvdWNzaS91Y3NpX2NjZy5jCisrKyBiL2RyaXZlcnMvdXNiL3R5 cGVjL3Vjc2kvdWNzaV9jY2cuYwpAQCAtOSw2ICs5LDcgQEAKICAqLwogI2luY2x1ZGUgPGxpbnV4 L2FjcGkuaD4KICNpbmNsdWRlIDxsaW51eC9kZWxheS5oPgorI2luY2x1ZGUgPGxpbnV4L2Zpcm13 YXJlLmg+CiAjaW5jbHVkZSA8bGludXgvaTJjLmg+CiAjaW5jbHVkZSA8bGludXgvbW9kdWxlLmg+ CiAjaW5jbHVkZSA8bGludXgvcGNpLmg+CkBAIC0yNCw2ICsyNSw3MyBAQCBlbnVtIGVudW1fZndf bW9kZSB7CiAJRldfSU5WQUxJRCwKIH07CiAKKyNkZWZpbmUgQ0NHWF9SQUJfREVWSUNFX01PREUJ CQkweDAwMDAKKyNkZWZpbmUgQ0NHWF9SQUJfSU5UUl9SRUcJCQkweDAwMDYKKyNkZWZpbmUgIERF Vl9JTlQJCQkJQklUKDApCisjZGVmaW5lICBQT1JUMF9JTlQJCQkJQklUKDEpCisjZGVmaW5lICBQ T1JUMV9JTlQJCQkJQklUKDIpCisjZGVmaW5lICBVQ1NJX1JFQURfSU5UCQkJCUJJVCg3KQorI2Rl ZmluZSBDQ0dYX1JBQl9KVU1QX1RPX0JPT1QJCQkweDAwMDcKKyNkZWZpbmUgIFRPX0JPT1QJCQkJ J0onCisjZGVmaW5lICBUT19BTFRfRlcJCQkJJ0EnCisjZGVmaW5lIENDR1hfUkFCX1JFU0VUX1JF UQkJCTB4MDAwOAorI2RlZmluZSAgUkVTRVRfU0lHCQkJCSdSJworI2RlZmluZSAgQ01EX1JFU0VU X0kyQwkJCQkweDAKKyNkZWZpbmUgIENNRF9SRVNFVF9ERVYJCQkJMHgxCisjZGVmaW5lIENDR1hf UkFCX0VOVEVSX0ZMQVNISU5HCQkJMHgwMDBBCisjZGVmaW5lICBGTEFTSF9FTlRFUl9TSUcJCQkn UCcKKyNkZWZpbmUgQ0NHWF9SQUJfVkFMSURBVEVfRlcJCQkweDAwMEIKKyNkZWZpbmUgQ0NHWF9S QUJfRkxBU0hfUk9XX1JXCQkJMHgwMDBDCisjZGVmaW5lICBGTEFTSF9TSUcJCQkJJ0YnCisjZGVm aW5lICBGTEFTSF9SRF9DTUQJCQkJMHgwCisjZGVmaW5lICBGTEFTSF9XUl9DTUQJCQkJMHgxCisj ZGVmaW5lICBGTEFTSF9GV0NUMV9XUl9DTUQJCQkweDIKKyNkZWZpbmUgIEZMQVNIX0ZXQ1QyX1dS X0NNRAkJCTB4MworI2RlZmluZSAgRkxBU0hfRldDVF9TSUdfV1JfQ01ECQkJMHg0CisjZGVmaW5l IENDR1hfUkFCX1JFQURfQUxMX1ZFUgkJCTB4MDAxMAorI2RlZmluZSBDQ0dYX1JBQl9SRUFEX0ZX Ml9WRVIJCQkweDAwMjAKKyNkZWZpbmUgQ0NHWF9SQUJfVUNTSV9DT05UUk9MCQkJMHgwMDM5Cisj ZGVmaW5lIENDR1hfUkFCX1VDU0lfQ09OVFJPTF9TVEFSVAkJQklUKDApCisjZGVmaW5lIENDR1hf UkFCX1VDU0lfQ09OVFJPTF9TVE9QCQlCSVQoMSkKKyNkZWZpbmUgQ0NHWF9SQUJfVUNTSV9EQVRB X0JMT0NLKG9mZnNldCkJKDB4ZjAwMCB8ICgob2Zmc2V0KSAmIDB4ZmYpKQorI2RlZmluZSBSRUdf RkxBU0hfUldfTUVNICAgICAgICAweDAyMDAKKyNkZWZpbmUgREVWX1JFR19JRFgJCQkJQ0NHWF9S QUJfREVWSUNFX01PREUKKyNkZWZpbmUgQ0NHWF9SQUJfUERQT1JUX0VOQUJMRQkJCTB4MDAyQwor I2RlZmluZSAgUERQT1JUXzEJCUJJVCgwKQorI2RlZmluZSAgUERQT1JUXzIJCUJJVCgxKQorI2Rl ZmluZSBDQ0dYX1JBQl9SRVNQT05TRQkJCTB4MDA3RQorI2RlZmluZSAgQVNZTkNfRVZFTlQJCQkJ QklUKDcpCisKKy8qIENDR3ggZXZlbnRzICYgYXN5bmMgbXNnIGNvZGVzICovCisjZGVmaW5lIFJF U0VUX0NPTVBMRVRFCQkweDgwCisjZGVmaW5lIEVWRU5UX0lOREVYCQlSRVNFVF9DT01QTEVURQor I2RlZmluZSBQT1JUX0NPTk5FQ1RfREVUCTB4ODQKKyNkZWZpbmUgUE9SVF9ESVNDT05ORUNUX0RF VAkweDg1CisjZGVmaW5lIFJPTEVfU1dBUF9DT01QRUxFVEUJMHg4NworCisvKiBjY2cgZmlybXdh cmUgKi8KKyNkZWZpbmUgQ1lBQ0RfTElORV9TSVpFICAgICAgICAgNTI3CisjZGVmaW5lIENDRzRf Uk9XX1NJWkUgICAgICAgICAgIDI1NgorI2RlZmluZSBGVzFfTUVUQURBVEFfUk9XICAgICAgICAw eDFGRgorI2RlZmluZSBGVzJfTUVUQURBVEFfUk9XICAgICAgICAweDFGRQorI2RlZmluZSBGV19D RkdfVEFCTEVfU0lHX1NJWkUJMjU2CisKK3N0YXRpYyBpbnQgc2Vjb25kYXJ5X2Z3X21pbl92ZXIg PSA0MTsKKworZW51bSBlbnVtX2ZsYXNoX21vZGUgeworCVNFQ09OREFSWV9CTCwJLyogdXBkYXRl IHNlY29uZGFyeSB1c2luZyBib290bG9hZGVyICovCisJUFJJTUFSWSwJLyogdXBkYXRlIHByaW1h cnkgdXNpbmcgc2Vjb25kYXJ5ICovCisJU0VDT05EQVJZLAkvKiB1cGRhdGUgc2Vjb25kYXJ5IHVz aW5nIHByaW1hcnkgKi8KKwlGTEFTSF9OT1RfTkVFREVELAkvKiB1cGRhdGUgbm90IHJlcXVpcmVk ICovCisJRkxBU0hfSU5WQUxJRCwKK307CisKK3N0YXRpYyBjb25zdCBjaGFyICogY29uc3QgY2Nn X2Z3X25hbWVzW10gPSB7CisJImNjZ19ib290LmN5YWNkIiwKKwkiY2NnX3ByaW1hcnkuY3lhY2Qi LAorCSJjY2dfc2Vjb25kYXJ5LmN5YWNkIgorfTsKKwogc3RydWN0IGNjZ19kZXZfaW5mbyB7CiAj ZGVmaW5lIENDR19ERVZJTkZPX0ZXTU9ERV9TSElGVCAoMCkKICNkZWZpbmUgQ0NHX0RFVklORk9f RldNT0RFX01BU0sgKDB4MyA8PCBDQ0dfREVWSU5GT19GV01PREVfU0hJRlQpCkBAIC01MCw2ICsx MTgsNTAgQEAgc3RydWN0IHZlcnNpb25faW5mbyB7CiAJc3RydWN0IHZlcnNpb25fZm9ybWF0IGFw cDsKIH07CiAKK3N0cnVjdCBmd19jb25maWdfdGFibGUgeworCXUzMiBpZGVudGl0eTsKKwl1MTYg dGFibGVfc2l6ZTsKKwl1OCBmd2N0X3ZlcnNpb247CisJdTggaXNfa2V5X2NoYW5nZTsKKwl1OCBn dWlkWzE2XTsKKwlzdHJ1Y3QgdmVyc2lvbl9mb3JtYXQgYmFzZTsKKwlzdHJ1Y3QgdmVyc2lvbl9m b3JtYXQgYXBwOworCXU4IHByaW1hcnlfZndfZGlnZXN0WzMyXTsKKwl1MzIga2V5X2V4cF9sZW5n dGg7CisJdTgga2V5X21vZHVsdXNbMjU2XTsKKwl1OCBrZXlfZXhwWzRdOworfTsKKworLyogQ0NH eCByZXNwb25zZSBjb2RlcyAqLworZW51bSBjY2dfcmVzcF9jb2RlIHsKKwlDTURfTk9fUkVTUCAg ICAgICAgICAgICA9IDB4MDAsCisJQ01EX1NVQ0NFU1MgICAgICAgICAgICAgPSAweDAyLAorCUZM QVNIX0RBVEFfQVZBSUxBQkxFICAgID0gMHgwMywKKwlDTURfSU5WQUxJRCAgICAgICAgICAgICA9 IDB4MDUsCisJRkxBU0hfVVBEQVRFX0ZBSUwgICAgICAgPSAweDA3LAorCUlOVkFMSURfRlcgICAg ICAgICAgICAgID0gMHgwOCwKKwlJTlZBTElEX0FSRyAgICAgICAgICAgICA9IDB4MDksCisJQ01E X05PVF9TVVBQT1JUICAgICAgICAgPSAweDBBLAorCVRSQU5TQUNUSU9OX0ZBSUwgICAgICAgID0g MHgwQywKKwlQRF9DTURfRkFJTCAgICAgICAgICAgICA9IDB4MEQsCisJVU5ERUZfRVJST1IgICAg ICAgICAgICAgPSAweDBGLAorCUlOVkFMSURfUkVTUAkJPSAweDEwLAorfTsKKworI2RlZmluZSBD Q0dfRVZFTlRfTUFYCShFVkVOVF9JTkRFWCArIDQzKQorCitzdHJ1Y3QgY2NnX2NtZCB7CisJdTE2 IHJlZzsKKwl1MzIgZGF0YTsKKwlpbnQgbGVuOworCXUzMiBkZWxheTsgLyogbXMgZGVsYXkgZm9y IGNtZCB0aW1lb3V0ICAqLworfTsKKworc3RydWN0IGNjZ19yZXNwIHsKKwl1OCBjb2RlOworCXU4 IGxlbmd0aDsKK307CisKIHN0cnVjdCB1Y3NpX2NjZyB7CiAJc3RydWN0IGRldmljZSAqZGV2Owog CXN0cnVjdCB1Y3NpICp1Y3NpOwpAQCAtNTgsMTYgKzE3MCwyMCBAQCBzdHJ1Y3QgdWNzaV9jY2cg ewogCXN0cnVjdCBjY2dfZGV2X2luZm8gaW5mbzsKIAkvKiB2ZXJzaW9uIGluZm8gZm9yIGJvb3Qs IHByaW1hcnkgYW5kIHNlY29uZGFyeSAqLwogCXN0cnVjdCB2ZXJzaW9uX2luZm8gdmVyc2lvbltG VzIgKyAxXTsKLX07CisJLyogQ0NHIEhQSSBjb21tdW5pY2F0aW9uIGZsYWdzICovCisJdW5zaWdu ZWQgbG9uZyBmbGFnczsKKyNkZWZpbmUgUkVTRVRfUEVORElORwkwCisjZGVmaW5lIERFVl9DTURf UEVORElORwkxCisJc3RydWN0IGNjZ19yZXNwIGRldl9yZXNwOworCXU4IGNtZF9yZXNwOworCWlu dCBwb3J0X251bTsKKwlpbnQgaXJxOworCXN0cnVjdCB3b3JrX3N0cnVjdCB3b3JrOworCXN0cnVj dCBtdXRleCBsb2NrOyAvKiB0byBzeW5jIGJldHdlZW4gdXNlciBhbmQgZHJpdmVyIHRocmVhZCAq LwogCi0jZGVmaW5lIENDR1hfUkFCX0RFVklDRV9NT0RFCQkJMHgwMDAwCi0jZGVmaW5lIENDR1hf UkFCX0lOVFJfUkVHCQkJMHgwMDA2Ci0jZGVmaW5lIENDR1hfUkFCX1JFQURfQUxMX1ZFUgkJCTB4 MDAxMAotI2RlZmluZSBDQ0dYX1JBQl9SRUFEX0ZXMl9WRVIJCQkweDAwMjAKLSNkZWZpbmUgQ0NH WF9SQUJfVUNTSV9DT05UUk9MCQkJMHgwMDM5Ci0jZGVmaW5lIENDR1hfUkFCX1VDU0lfQ09OVFJP TF9TVEFSVAkJQklUKDApCi0jZGVmaW5lIENDR1hfUkFCX1VDU0lfQ09OVFJPTF9TVE9QCQlCSVQo MSkKLSNkZWZpbmUgQ0NHWF9SQUJfVUNTSV9EQVRBX0JMT0NLKG9mZnNldCkJKDB4ZjAwMCB8ICgo b2Zmc2V0KSAmIDB4ZmYpKQorCS8qIGZ3IGJ1aWxkIHdpdGggdmVuZG9yIGluZm9ybWF0aW9uICov CisJdTE2IGZ3X2J1aWxkOworfTsKIAogc3RhdGljIGludCBjY2dfcmVhZChzdHJ1Y3QgdWNzaV9j Y2cgKnVjLCB1MTYgcmFiLCB1OCAqZGF0YSwgdTMyIGxlbikKIHsKQEAgLTI3Niw2ICszOTIsNjcx IEBAIHN0YXRpYyBpbnQgZ2V0X2Z3X2luZm8oc3RydWN0IHVjc2lfY2NnICp1YykKIAlyZXR1cm4g MDsKIH0KIAorc3RhdGljIGlubGluZSBib29sIGludmFsaWRfYXN5bmNfZXZ0KGludCBjb2RlKQor eworCXJldHVybiAoY29kZSA+PSBDQ0dfRVZFTlRfTUFYKSB8fCAoY29kZSA8IEVWRU5UX0lOREVY KTsKK30KKworc3RhdGljIHZvaWQgY2NnX3Byb2Nlc3NfcmVzcG9uc2Uoc3RydWN0IHVjc2lfY2Nn ICp1YykKK3sKKwlzdHJ1Y3QgZGV2aWNlICpkZXYgPSB1Yy0+ZGV2OworCisJaWYgKHVjLT5kZXZf cmVzcC5jb2RlICYgQVNZTkNfRVZFTlQpIHsKKwkJaWYgKHVjLT5kZXZfcmVzcC5jb2RlID09IFJF U0VUX0NPTVBMRVRFKSB7CisJCQlpZiAodGVzdF9iaXQoUkVTRVRfUEVORElORywgJnVjLT5mbGFn cykpCisJCQkJdWMtPmNtZF9yZXNwID0gdWMtPmRldl9yZXNwLmNvZGU7CisJCQlnZXRfZndfaW5m byh1Yyk7CisJCX0KKwkJaWYgKGludmFsaWRfYXN5bmNfZXZ0KHVjLT5kZXZfcmVzcC5jb2RlKSkK KwkJCWRldl9lcnIoZGV2LCAiaW52YWxpZCBhc3luYyBldnQgJWRcbiIsCisJCQkJdWMtPmRldl9y ZXNwLmNvZGUpOworCX0gZWxzZSB7CisJCWlmICh0ZXN0X2JpdChERVZfQ01EX1BFTkRJTkcsICZ1 Yy0+ZmxhZ3MpKSB7CisJCQl1Yy0+Y21kX3Jlc3AgPSB1Yy0+ZGV2X3Jlc3AuY29kZTsKKwkJCWNs ZWFyX2JpdChERVZfQ01EX1BFTkRJTkcsICZ1Yy0+ZmxhZ3MpOworCQl9IGVsc2UgeworCQkJZGV2 X2VycihkZXYsICJkZXYgcmVzcCAweCUwNHggYnV0IG5vIGNtZCBwZW5kaW5nXG4iLAorCQkJCXVj LT5kZXZfcmVzcC5jb2RlKTsKKwkJfQorCX0KK30KKworc3RhdGljIGludCBjY2dfcmVhZF9yZXNw b25zZShzdHJ1Y3QgdWNzaV9jY2cgKnVjKQoreworCXVuc2lnbmVkIGxvbmcgdGFyZ2V0ID0gamlm ZmllcyArIG1zZWNzX3RvX2ppZmZpZXMoMTAwMCk7CisJc3RydWN0IGRldmljZSAqZGV2ID0gdWMt PmRldjsKKwl1OCBpbnR2YWw7CisJaW50IHN0YXR1czsKKworCS8qIHdhaXQgZm9yIGludGVycnVw dCBzdGF0dXMgdG8gZ2V0IHVwZGF0ZWQgKi8KKwlkbyB7CisJCXN0YXR1cyA9IGNjZ19yZWFkKHVj LCBDQ0dYX1JBQl9JTlRSX1JFRywgJmludHZhbCwKKwkJCQkgIHNpemVvZihpbnR2YWwpKTsKKwkJ aWYgKHN0YXR1cyA8IDApCisJCQlyZXR1cm4gc3RhdHVzOworCisJCWlmIChpbnR2YWwgJiBERVZf SU5UKQorCQkJYnJlYWs7CisJCXVzbGVlcF9yYW5nZSg1MDAsIDYwMCk7CisJfSB3aGlsZSAodGlt ZV9pc19hZnRlcl9qaWZmaWVzKHRhcmdldCkpOworCisJaWYgKHRpbWVfaXNfYmVmb3JlX2ppZmZp ZXModGFyZ2V0KSkgeworCQlkZXZfZXJyKGRldiwgInJlc3BvbnNlIHRpbWVvdXQgZXJyb3JcbiIp OworCQlyZXR1cm4gLUVUSU1FOworCX0KKworCXN0YXR1cyA9IGNjZ19yZWFkKHVjLCBDQ0dYX1JB Ql9SRVNQT05TRSwgKHU4ICopJnVjLT5kZXZfcmVzcCwKKwkJCSAgc2l6ZW9mKHVjLT5kZXZfcmVz cCkpOworCWlmIChzdGF0dXMgPCAwKQorCQlyZXR1cm4gc3RhdHVzOworCisJc3RhdHVzID0gY2Nn X3dyaXRlKHVjLCBDQ0dYX1JBQl9JTlRSX1JFRywgJmludHZhbCwgc2l6ZW9mKGludHZhbCkpOwor CWlmIChzdGF0dXMgPCAwKQorCQlyZXR1cm4gc3RhdHVzOworCisJcmV0dXJuIDA7Cit9CisKKy8q IENhbGxlciBtdXN0IGhvbGQgdWMtPmxvY2sgKi8KK3N0YXRpYyBpbnQgY2NnX3NlbmRfY29tbWFu ZChzdHJ1Y3QgdWNzaV9jY2cgKnVjLCBzdHJ1Y3QgY2NnX2NtZCAqY21kKQoreworCXN0cnVjdCBk ZXZpY2UgKmRldiA9IHVjLT5kZXY7CisJaW50IHJldDsKKworCXN3aXRjaCAoY21kLT5yZWcgJiAw eEYwMDApIHsKKwljYXNlIERFVl9SRUdfSURYOgorCQlzZXRfYml0KERFVl9DTURfUEVORElORywg JnVjLT5mbGFncyk7CisJCWJyZWFrOworCWRlZmF1bHQ6CisJCWRldl9lcnIoZGV2LCAiaW52YWxp ZCBjbWQgcmVnaXN0ZXJcbiIpOworCQlicmVhazsKKwl9CisKKwlyZXQgPSBjY2dfd3JpdGUodWMs IGNtZC0+cmVnLCAodTggKikmY21kLT5kYXRhLCBjbWQtPmxlbik7CisJaWYgKHJldCA8IDApCisJ CXJldHVybiByZXQ7CisKKwltc2xlZXAoY21kLT5kZWxheSk7CisKKwlyZXQgPSBjY2dfcmVhZF9y ZXNwb25zZSh1Yyk7CisJaWYgKHJldCA8IDApIHsKKwkJZGV2X2VycihkZXYsICJyZXNwb25zZSBy ZWFkIGVycm9yXG4iKTsKKwkJc3dpdGNoIChjbWQtPnJlZyAmIDB4RjAwMCkgeworCQljYXNlIERF Vl9SRUdfSURYOgorCQkJY2xlYXJfYml0KERFVl9DTURfUEVORElORywgJnVjLT5mbGFncyk7CisJ CQlicmVhazsKKwkJZGVmYXVsdDoKKwkJCWRldl9lcnIoZGV2LCAiaW52YWxpZCBjbWQgcmVnaXN0 ZXJcbiIpOworCQkJYnJlYWs7CisJCX0KKwkJcmV0dXJuIC1FSU87CisJfQorCWNjZ19wcm9jZXNz X3Jlc3BvbnNlKHVjKTsKKworCXJldHVybiB1Yy0+Y21kX3Jlc3A7Cit9CisKK3N0YXRpYyBpbnQg Y2NnX2NtZF9lbnRlcl9mbGFzaGluZyhzdHJ1Y3QgdWNzaV9jY2cgKnVjKQoreworCXN0cnVjdCBj Y2dfY21kIGNtZDsKKwlpbnQgcmV0OworCisJY21kLnJlZyA9IENDR1hfUkFCX0VOVEVSX0ZMQVNI SU5HOworCWNtZC5kYXRhID0gRkxBU0hfRU5URVJfU0lHOworCWNtZC5sZW4gPSAxOworCWNtZC5k ZWxheSA9IDUwOworCisJbXV0ZXhfbG9jaygmdWMtPmxvY2spOworCisJcmV0ID0gY2NnX3NlbmRf Y29tbWFuZCh1YywgJmNtZCk7CisKKwltdXRleF91bmxvY2soJnVjLT5sb2NrKTsKKworCWlmIChy ZXQgIT0gQ01EX1NVQ0NFU1MpIHsKKwkJZGV2X2Vycih1Yy0+ZGV2LCAiZW50ZXIgZmxhc2hpbmcg ZmFpbGVkIHJldD0lZFxuIiwgcmV0KTsKKwkJcmV0dXJuIHJldDsKKwl9CisKKwlyZXR1cm4gMDsK K30KKworc3RhdGljIGludCBjY2dfY21kX3Jlc2V0KHN0cnVjdCB1Y3NpX2NjZyAqdWMpCit7CisJ c3RydWN0IGNjZ19jbWQgY21kOworCXU4ICpwOworCWludCByZXQ7CisKKwlwID0gKHU4ICopJmNt ZC5kYXRhOworCWNtZC5yZWcgPSBDQ0dYX1JBQl9SRVNFVF9SRVE7CisJcFswXSA9IFJFU0VUX1NJ RzsKKwlwWzFdID0gQ01EX1JFU0VUX0RFVjsKKwljbWQubGVuID0gMjsKKwljbWQuZGVsYXkgPSA1 MDAwOworCisJbXV0ZXhfbG9jaygmdWMtPmxvY2spOworCisJc2V0X2JpdChSRVNFVF9QRU5ESU5H LCAmdWMtPmZsYWdzKTsKKworCXJldCA9IGNjZ19zZW5kX2NvbW1hbmQodWMsICZjbWQpOworCWlm IChyZXQgIT0gUkVTRVRfQ09NUExFVEUpCisJCWdvdG8gZXJyX2NsZWFyX2ZsYWc7CisKKwlyZXQg PSAwOworCitlcnJfY2xlYXJfZmxhZzoKKwljbGVhcl9iaXQoUkVTRVRfUEVORElORywgJnVjLT5m bGFncyk7CisKKwltdXRleF91bmxvY2soJnVjLT5sb2NrKTsKKworCXJldHVybiByZXQ7Cit9CisK K3N0YXRpYyBpbnQgY2NnX2NtZF9wb3J0X2NvbnRyb2woc3RydWN0IHVjc2lfY2NnICp1YywgYm9v bCBlbmFibGUpCit7CisJc3RydWN0IGNjZ19jbWQgY21kOworCWludCByZXQ7CisKKwljbWQucmVn ID0gQ0NHWF9SQUJfUERQT1JUX0VOQUJMRTsKKwlpZiAoZW5hYmxlKQorCQljbWQuZGF0YSA9ICh1 Yy0+cG9ydF9udW0gPT0gMSkgPworCQkJICAgIFBEUE9SVF8xIDogKFBEUE9SVF8xIHwgUERQT1JU XzIpOworCWVsc2UKKwkJY21kLmRhdGEgPSAweDA7CisJY21kLmxlbiA9IDE7CisJY21kLmRlbGF5 ID0gMTA7CisKKwltdXRleF9sb2NrKCZ1Yy0+bG9jayk7CisKKwlyZXQgPSBjY2dfc2VuZF9jb21t YW5kKHVjLCAmY21kKTsKKworCW11dGV4X3VubG9jaygmdWMtPmxvY2spOworCisJaWYgKHJldCAh PSBDTURfU1VDQ0VTUykgeworCQlkZXZfZXJyKHVjLT5kZXYsICJwb3J0IGNvbnRyb2wgZmFpbGVk IHJldD0lZFxuIiwgcmV0KTsKKwkJcmV0dXJuIHJldDsKKwl9CisJcmV0dXJuIDA7Cit9CisKK3N0 YXRpYyBpbnQgY2NnX2NtZF9qdW1wX2Jvb3RfbW9kZShzdHJ1Y3QgdWNzaV9jY2cgKnVjLCBpbnQg YmxfbW9kZSkKK3sKKwlzdHJ1Y3QgY2NnX2NtZCBjbWQ7CisJaW50IHJldDsKKworCWNtZC5yZWcg PSBDQ0dYX1JBQl9KVU1QX1RPX0JPT1Q7CisKKwlpZiAoYmxfbW9kZSkKKwkJY21kLmRhdGEgPSBU T19CT09UOworCWVsc2UKKwkJY21kLmRhdGEgPSBUT19BTFRfRlc7CisKKwljbWQubGVuID0gMTsK KwljbWQuZGVsYXkgPSAxMDA7CisKKwltdXRleF9sb2NrKCZ1Yy0+bG9jayk7CisKKwlzZXRfYml0 KFJFU0VUX1BFTkRJTkcsICZ1Yy0+ZmxhZ3MpOworCisJcmV0ID0gY2NnX3NlbmRfY29tbWFuZCh1 YywgJmNtZCk7CisJaWYgKHJldCAhPSBSRVNFVF9DT01QTEVURSkKKwkJZ290byBlcnJfY2xlYXJf ZmxhZzsKKworCXJldCA9IDA7CisKK2Vycl9jbGVhcl9mbGFnOgorCWNsZWFyX2JpdChSRVNFVF9Q RU5ESU5HLCAmdWMtPmZsYWdzKTsKKworCW11dGV4X3VubG9jaygmdWMtPmxvY2spOworCisJcmV0 dXJuIHJldDsKK30KKworc3RhdGljIGludAorY2NnX2NtZF93cml0ZV9mbGFzaF9yb3coc3RydWN0 IHVjc2lfY2NnICp1YywgdTE2IHJvdywKKwkJCWNvbnN0IHZvaWQgKmRhdGEsIHU4IGZjbWQpCit7 CisJc3RydWN0IGkyY19jbGllbnQgKmNsaWVudCA9IHVjLT5jbGllbnQ7CisJc3RydWN0IGNjZ19j bWQgY21kOworCXU4IGJ1ZltDQ0c0X1JPV19TSVpFICsgMl07CisJdTggKnA7CisJaW50IHJldDsK KworCS8qIENvcHkgdGhlIGRhdGEgaW50byB0aGUgZmxhc2ggcmVhZC93cml0ZSBtZW1vcnkuICov CisJcHV0X3VuYWxpZ25lZF9sZTE2KFJFR19GTEFTSF9SV19NRU0sIGJ1Zik7CisKKwltZW1jcHko YnVmICsgMiwgZGF0YSwgQ0NHNF9ST1dfU0laRSk7CisKKwltdXRleF9sb2NrKCZ1Yy0+bG9jayk7 CisKKwlyZXQgPSBpMmNfbWFzdGVyX3NlbmQoY2xpZW50LCBidWYsIENDRzRfUk9XX1NJWkUgKyAy KTsKKwlpZiAocmV0ICE9IENDRzRfUk9XX1NJWkUgKyAyKSB7CisJCWRldl9lcnIodWMtPmRldiwg IlJFR19GTEFTSF9SV19NRU0gd3JpdGUgZmFpbCAlZFxuIiwgcmV0KTsKKwkJcmV0dXJuIHJldCA8 IDAgPyByZXQgOiAtRUlPOworCX0KKworCS8qIFVzZSB0aGUgRkxBU0hfUk9XX1JFQURfV1JJVEUg cmVnaXN0ZXIgdG8gdHJpZ2dlciAqLworCS8qIHdyaXRpbmcgb2YgZGF0YSB0byB0aGUgZGVzaXJl ZCBmbGFzaCByb3cgKi8KKwlwID0gKHU4ICopJmNtZC5kYXRhOworCWNtZC5yZWcgPSBDQ0dYX1JB Ql9GTEFTSF9ST1dfUlc7CisJcFswXSA9IEZMQVNIX1NJRzsKKwlwWzFdID0gZmNtZDsKKwlwdXRf dW5hbGlnbmVkX2xlMTYocm93LCAmcFsyXSk7CisJY21kLmxlbiA9IDQ7CisJY21kLmRlbGF5ID0g NTA7CisJaWYgKGZjbWQgPT0gRkxBU0hfRldDVF9TSUdfV1JfQ01EKQorCQljbWQuZGVsYXkgKz0g NDAwOworCWlmIChyb3cgPT0gNTEwKQorCQljbWQuZGVsYXkgKz0gMjIwOworCXJldCA9IGNjZ19z ZW5kX2NvbW1hbmQodWMsICZjbWQpOworCisJbXV0ZXhfdW5sb2NrKCZ1Yy0+bG9jayk7CisKKwlp ZiAocmV0ICE9IENNRF9TVUNDRVNTKSB7CisJCWRldl9lcnIodWMtPmRldiwgIndyaXRlIGZsYXNo IHJvdyBmYWlsZWQgcmV0PSVkXG4iLCByZXQpOworCQlyZXR1cm4gcmV0OworCX0KKworCXJldHVy biAwOworfQorCitzdGF0aWMgaW50IGNjZ19jbWRfdmFsaWRhdGVfZncoc3RydWN0IHVjc2lfY2Nn ICp1YywgdW5zaWduZWQgaW50IGZ3aWQpCit7CisJc3RydWN0IGNjZ19jbWQgY21kOworCWludCBy ZXQ7CisKKwljbWQucmVnID0gQ0NHWF9SQUJfVkFMSURBVEVfRlc7CisJY21kLmRhdGEgPSBmd2lk OworCWNtZC5sZW4gPSAxOworCWNtZC5kZWxheSA9IDUwMDsKKworCW11dGV4X2xvY2soJnVjLT5s b2NrKTsKKworCXJldCA9IGNjZ19zZW5kX2NvbW1hbmQodWMsICZjbWQpOworCisJbXV0ZXhfdW5s b2NrKCZ1Yy0+bG9jayk7CisKKwlpZiAocmV0ICE9IENNRF9TVUNDRVNTKQorCQlyZXR1cm4gcmV0 OworCisJcmV0dXJuIDA7Cit9CisKK3N0YXRpYyBib29sIGNjZ19jaGVja192ZW5kb3JfdmVyc2lv bihzdHJ1Y3QgdWNzaV9jY2cgKnVjLAorCQkJCSAgICAgc3RydWN0IHZlcnNpb25fZm9ybWF0ICph cHAsCisJCQkJICAgICBzdHJ1Y3QgZndfY29uZmlnX3RhYmxlICpmd19jZmcpCit7CisJc3RydWN0 IGRldmljZSAqZGV2ID0gdWMtPmRldjsKKworCS8qIENoZWNrIGlmIHRoZSBmdyBidWlsZCBpcyBm b3Igc3VwcG9ydGVkIHZlbmRvcnMgKi8KKwlpZiAobGUxNl90b19jcHUoYXBwLT5idWlsZCkgIT0g dWMtPmZ3X2J1aWxkKSB7CisJCWRldl9pbmZvKGRldiwgImN1cnJlbnQgZncgaXMgbm90IGZyb20g c3VwcG9ydGVkIHZlbmRvclxuIik7CisJCXJldHVybiBmYWxzZTsKKwl9CisKKwkvKiBDaGVjayBp ZiB0aGUgbmV3IGZ3IGJ1aWxkIGlzIGZvciBzdXBwb3J0ZWQgdmVuZG9ycyAqLworCWlmIChsZTE2 X3RvX2NwdShmd19jZmctPmFwcC5idWlsZCkgIT0gdWMtPmZ3X2J1aWxkKSB7CisJCWRldl9pbmZv KGRldiwgIm5ldyBmdyBpcyBub3QgZnJvbSBzdXBwb3J0ZWQgdmVuZG9yXG4iKTsKKwkJcmV0dXJu IGZhbHNlOworCX0KKwlyZXR1cm4gdHJ1ZTsKK30KKworc3RhdGljIGJvb2wgY2NnX2NoZWNrX2Z3 X3ZlcnNpb24oc3RydWN0IHVjc2lfY2NnICp1YywgY29uc3QgY2hhciAqZndfbmFtZSwKKwkJCQkg c3RydWN0IHZlcnNpb25fZm9ybWF0ICphcHApCit7CisJY29uc3Qgc3RydWN0IGZpcm13YXJlICpm dyA9IE5VTEw7CisJc3RydWN0IGRldmljZSAqZGV2ID0gdWMtPmRldjsKKwlzdHJ1Y3QgZndfY29u ZmlnX3RhYmxlIGZ3X2NmZzsKKwl1MzIgY3VyX3ZlcnNpb24sIG5ld192ZXJzaW9uOworCWJvb2wg aXNfbGF0ZXIgPSBmYWxzZTsKKworCWlmIChyZXF1ZXN0X2Zpcm13YXJlKCZmdywgZndfbmFtZSwg ZGV2KSAhPSAwKSB7CisJCWRldl9lcnIoZGV2LCAiZXJyb3I6IEZhaWxlZCB0byBvcGVuIGN5YWNk IGZpbGUgJXNcbiIsIGZ3X25hbWUpOworCQlyZXR1cm4gZmFsc2U7CisJfQorCisJLyoKKwkgKiBj aGVjayBpZiBzaWduZWQgZncKKwkgKiBsYXN0IHBhcnQgb2YgZncgaW1hZ2UgaXMgZncgY2ZnIHRh YmxlIGFuZCBzaWduYXR1cmUKKwkgKi8KKwlpZiAoZnctPnNpemUgPCBzaXplb2YoZndfY2ZnKSAr IEZXX0NGR19UQUJMRV9TSUdfU0laRSkKKwkJZ290byBvdXRfcmVsZWFzZV9maXJtd2FyZTsKKwor CW1lbWNweSgodWludDhfdCAqKSZmd19jZmcsIGZ3LT5kYXRhICsgZnctPnNpemUgLQorCSAgICAg ICBzaXplb2YoZndfY2ZnKSAtIEZXX0NGR19UQUJMRV9TSUdfU0laRSwgc2l6ZW9mKGZ3X2NmZykp OworCisJaWYgKGZ3X2NmZy5pZGVudGl0eSAhPSAoJ0YnIHwgJ1cnIDw8IDggfCAnQycgPDwgMTYg fCAnVCcgPDwgMjQpKSB7CisJCWRldl9pbmZvKGRldiwgIm5vdCBhIHNpZ25lZCBpbWFnZVxuIik7 CisJCWdvdG8gb3V0X3JlbGVhc2VfZmlybXdhcmU7CisJfQorCisJLyogY29tcGFyZSBpbnB1dCB2 ZXJzaW9uIHdpdGggRldDVCB2ZXJzaW9uICovCisJY3VyX3ZlcnNpb24gPSBsZTE2X3RvX2NwdShh cHAtPmJ1aWxkKSB8IGFwcC0+cGF0Y2ggPDwgMTYgfAorCQkJYXBwLT52ZXIgPDwgMjQ7CisKKwlu ZXdfdmVyc2lvbiA9IGxlMTZfdG9fY3B1KGZ3X2NmZy5hcHAuYnVpbGQpIHwgZndfY2ZnLmFwcC5w YXRjaCA8PCAxNiB8CisJCQlmd19jZmcuYXBwLnZlciA8PCAyNDsKKworCWlmICghY2NnX2NoZWNr X3ZlbmRvcl92ZXJzaW9uKHVjLCBhcHAsICZmd19jZmcpKQorCQlnb3RvIG91dF9yZWxlYXNlX2Zp cm13YXJlOworCisJaWYgKG5ld192ZXJzaW9uID4gY3VyX3ZlcnNpb24pCisJCWlzX2xhdGVyID0g dHJ1ZTsKKworb3V0X3JlbGVhc2VfZmlybXdhcmU6CisJcmVsZWFzZV9maXJtd2FyZShmdyk7CisJ cmV0dXJuIGlzX2xhdGVyOworfQorCitzdGF0aWMgaW50IGNjZ19md191cGRhdGVfbmVlZGVkKHN0 cnVjdCB1Y3NpX2NjZyAqdWMsCisJCQkJZW51bSBlbnVtX2ZsYXNoX21vZGUgKm1vZGUpCit7CisJ c3RydWN0IGRldmljZSAqZGV2ID0gdWMtPmRldjsKKwlpbnQgZXJyOworCXN0cnVjdCB2ZXJzaW9u X2luZm8gdmVyc2lvblszXTsKKworCWVyciA9IGNjZ19yZWFkKHVjLCBDQ0dYX1JBQl9ERVZJQ0Vf TU9ERSwgKHU4ICopKCZ1Yy0+aW5mbyksCisJCSAgICAgICBzaXplb2YodWMtPmluZm8pKTsKKwlp ZiAoZXJyKSB7CisJCWRldl9lcnIoZGV2LCAicmVhZCBkZXZpY2UgbW9kZSBmYWlsZWRcbiIpOwor CQlyZXR1cm4gZXJyOworCX0KKworCWVyciA9IGNjZ19yZWFkKHVjLCBDQ0dYX1JBQl9SRUFEX0FM TF9WRVIsICh1OCAqKXZlcnNpb24sCisJCSAgICAgICBzaXplb2YodmVyc2lvbikpOworCWlmIChl cnIpIHsKKwkJZGV2X2VycihkZXYsICJyZWFkIGRldmljZSBtb2RlIGZhaWxlZFxuIik7CisJCXJl dHVybiBlcnI7CisJfQorCisJaWYgKG1lbWNtcCgmdmVyc2lvbltGVzFdLCAiXDBcMFwwXDBcMFww XDBcMCIsCisJCSAgIHNpemVvZihzdHJ1Y3QgdmVyc2lvbl9pbmZvKSkgPT0gMCkgeworCQlkZXZf aW5mbyhkZXYsICJzZWNvbmRhcnkgZncgaXMgbm90IGZsYXNoZWRcbiIpOworCQkqbW9kZSA9IFNF Q09OREFSWV9CTDsKKwl9IGVsc2UgaWYgKGxlMTZfdG9fY3B1KHZlcnNpb25bRlcxXS5iYXNlLmJ1 aWxkKSA8CisJCXNlY29uZGFyeV9md19taW5fdmVyKSB7CisJCWRldl9pbmZvKGRldiwgInNlY29u ZGFyeSBmdyB2ZXJzaW9uIGlzIHRvbyBsb3cgKDwgJWQpXG4iLAorCQkJIHNlY29uZGFyeV9md19t aW5fdmVyKTsKKwkJKm1vZGUgPSBTRUNPTkRBUlk7CisJfSBlbHNlIGlmIChtZW1jbXAoJnZlcnNp b25bRlcyXSwgIlwwXDBcMFwwXDBcMFwwXDAiLAorCQkgICBzaXplb2Yoc3RydWN0IHZlcnNpb25f aW5mbykpID09IDApIHsKKwkJZGV2X2luZm8oZGV2LCAicHJpbWFyeSBmdyBpcyBub3QgZmxhc2hl ZFxuIik7CisJCSptb2RlID0gUFJJTUFSWTsKKwl9IGVsc2UgaWYgKGNjZ19jaGVja19md192ZXJz aW9uKHVjLCBjY2dfZndfbmFtZXNbUFJJTUFSWV0sCisJCSAgICZ2ZXJzaW9uW0ZXMl0uYXBwKSkg eworCQlkZXZfaW5mbyhkZXYsICJmb3VuZCBwcmltYXJ5IGZ3IHdpdGggbGF0ZXIgdmVyc2lvblxu Iik7CisJCSptb2RlID0gUFJJTUFSWTsKKwl9IGVsc2UgeworCQlkZXZfaW5mbyhkZXYsICJzZWNv bmRhcnkgYW5kIHByaW1hcnkgZncgYXJlIHRoZSBsYXRlc3RcbiIpOworCQkqbW9kZSA9IEZMQVNI X05PVF9ORUVERUQ7CisJfQorCXJldHVybiAwOworfQorCitzdGF0aWMgaW50IGRvX2ZsYXNoKHN0 cnVjdCB1Y3NpX2NjZyAqdWMsIGVudW0gZW51bV9mbGFzaF9tb2RlIG1vZGUpCit7CisJc3RydWN0 IGRldmljZSAqZGV2ID0gdWMtPmRldjsKKwljb25zdCBzdHJ1Y3QgZmlybXdhcmUgKmZ3ID0gTlVM TDsKKwljb25zdCBjaGFyICpwLCAqczsKKwljb25zdCBjaGFyICplb2Y7CisJaW50IGVyciwgcm93 LCBsZW4sIGxpbmVfc3osIGxpbmVfY250ID0gMDsKKwl1bnNpZ25lZCBsb25nIHN0YXJ0X3RpbWUg PSBqaWZmaWVzOworCXN0cnVjdCBmd19jb25maWdfdGFibGUgIGZ3X2NmZzsKKwl1OCBmd19jZmdf c2lnW0ZXX0NGR19UQUJMRV9TSUdfU0laRV07CisJdTggKndyX2J1ZjsKKworCWVyciA9IHJlcXVl c3RfZmlybXdhcmUoJmZ3LCBjY2dfZndfbmFtZXNbbW9kZV0sIGRldik7CisJaWYgKGVycikgewor CQlkZXZfZXJyKGRldiwgInJlcXVlc3QgJXMgZmFpbGVkIGVycj0lZFxuIiwKKwkJCWNjZ19md19u YW1lc1ttb2RlXSwgZXJyKTsKKwkJcmV0dXJuIGVycjsKKwl9CisKKwlpZiAoKCh1Yy0+aW5mby5t b2RlICYgQ0NHX0RFVklORk9fRldNT0RFX01BU0spID4+CisJCQlDQ0dfREVWSU5GT19GV01PREVf U0hJRlQpID09IEZXMikgeworCQllcnIgPSBjY2dfY21kX3BvcnRfY29udHJvbCh1YywgZmFsc2Up OworCQlpZiAoZXJyIDwgMCkKKwkJCWdvdG8gcmVsZWFzZV9mdzsKKwkJZXJyID0gY2NnX2NtZF9q dW1wX2Jvb3RfbW9kZSh1YywgMCk7CisJCWlmIChlcnIgPCAwKQorCQkJZ290byByZWxlYXNlX2Z3 OworCX0KKworCWVvZiA9IGZ3LT5kYXRhICsgZnctPnNpemU7CisKKwkvKgorCSAqIGNoZWNrIGlm IHNpZ25lZCBmdworCSAqIGxhc3QgcGFydCBvZiBmdyBpbWFnZSBpcyBmdyBjZmcgdGFibGUgYW5k IHNpZ25hdHVyZQorCSAqLworCWlmIChmdy0+c2l6ZSA8IHNpemVvZihmd19jZmcpICsgc2l6ZW9m KGZ3X2NmZ19zaWcpKQorCQlnb3RvIG5vdF9zaWduZWRfZnc7CisKKwltZW1jcHkoKHVpbnQ4X3Qg KikmZndfY2ZnLCBmdy0+ZGF0YSArIGZ3LT5zaXplIC0KKwkgICAgICAgc2l6ZW9mKGZ3X2NmZykg LSBzaXplb2YoZndfY2ZnX3NpZyksIHNpemVvZihmd19jZmcpKTsKKworCWlmIChmd19jZmcuaWRl bnRpdHkgIT0gKCdGJyB8ICgnVycgPDwgOCkgfCAoJ0MnIDw8IDE2KSB8ICgnVCcgPDwgMjQpKSkg eworCQlkZXZfaW5mbyhkZXYsICJub3QgYSBzaWduZWQgaW1hZ2VcbiIpOworCQlnb3RvIG5vdF9z aWduZWRfZnc7CisJfQorCWVvZiA9IGZ3LT5kYXRhICsgZnctPnNpemUgLSBzaXplb2YoZndfY2Zn KSAtIHNpemVvZihmd19jZmdfc2lnKTsKKworCW1lbWNweSgodWludDhfdCAqKSZmd19jZmdfc2ln LAorCSAgICAgICBmdy0+ZGF0YSArIGZ3LT5zaXplIC0gc2l6ZW9mKGZ3X2NmZ19zaWcpLCBzaXpl b2YoZndfY2ZnX3NpZykpOworCisJLyogZmxhc2ggZncgY29uZmlnIHRhYmxlIGFuZCBzaWduYXR1 cmUgZmlyc3QgKi8KKwllcnIgPSBjY2dfY21kX3dyaXRlX2ZsYXNoX3Jvdyh1YywgMCwgKHU4ICop JmZ3X2NmZywKKwkJCQkgICAgICBGTEFTSF9GV0NUMV9XUl9DTUQpOworCWlmIChlcnIpCisJCWdv dG8gcmVsZWFzZV9mdzsKKworCWVyciA9IGNjZ19jbWRfd3JpdGVfZmxhc2hfcm93KHVjLCAwLCAo dTggKikmZndfY2ZnICsgQ0NHNF9ST1dfU0laRSwKKwkJCQkgICAgICBGTEFTSF9GV0NUMl9XUl9D TUQpOworCWlmIChlcnIpCisJCWdvdG8gcmVsZWFzZV9mdzsKKworCWVyciA9IGNjZ19jbWRfd3Jp dGVfZmxhc2hfcm93KHVjLCAwLCAmZndfY2ZnX3NpZywKKwkJCQkgICAgICBGTEFTSF9GV0NUX1NJ R19XUl9DTUQpOworCWlmIChlcnIpCisJCWdvdG8gcmVsZWFzZV9mdzsKKworbm90X3NpZ25lZF9m dzoKKwl3cl9idWYgPSBremFsbG9jKENDRzRfUk9XX1NJWkUgKyA0LCBHRlBfS0VSTkVMKTsKKwlp ZiAoIXdyX2J1ZikKKwkJcmV0dXJuIC1FTk9NRU07CisKKwllcnIgPSBjY2dfY21kX2VudGVyX2Zs YXNoaW5nKHVjKTsKKwlpZiAoZXJyKQorCQlnb3RvIHJlbGVhc2VfbWVtOworCisJLyoqKioqKioq KioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioq CisJICogQ0NHIGZpcm13YXJlIGltYWdlICguY3lhY2QpIGZpbGUgbGluZSBmb3JtYXQKKwkgKgor CSAqIDowMHJycnJsbGxsW2RkLi4uLl1jYy9yL24KKwkgKgorCSAqIDowMCAgIGhlYWRlcgorCSAq IHJycnIgaXMgcm93IG51bWJlciB0byBmbGFzaAkJCQkoNCBjaGFyKQorCSAqIGxsbGwgaXMgZGF0 YSBsZW4gdG8gZmxhc2gJCQkJKDQgY2hhcikKKwkgKiBkZCAgIGlzIGEgZGF0YSBmaWVsZCByZXBy ZXNlbnRzIG9uZSBieXRlIG9mIGRhdGEJKDUxMiBjaGFyKQorCSAqIGNjICAgaXMgY2hlY2tzdW0J CQkJCSgyIGNoYXIpCisJICogXHJcbiBuZXdsaW5lCisJICoKKwkgKiBUb3RhbCBsZW5ndGg6IDMg KyA0ICsgNCArIDUxMiArIDIgKyAyID0gNTI3CisJICoKKwkgKioqKioqKioqKioqKioqKioqKioq KioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKiovCisKKwlwID0gc3Ry bmNocihmdy0+ZGF0YSwgZnctPnNpemUsICc6Jyk7CisJd2hpbGUgKHAgPCBlb2YpIHsKKwkJcyA9 IHN0cm5jaHIocCArIDEsIGVvZiAtIHAgLSAxLCAnOicpOworCisJCWlmICghcykKKwkJCXMgPSBl b2Y7CisKKwkJbGluZV9zeiA9IHMgLSBwOworCisJCWlmIChsaW5lX3N6ICE9IENZQUNEX0xJTkVf U0laRSkgeworCQkJZGV2X2VycihkZXYsICJCYWQgRlcgZm9ybWF0IGxpbmVfc3o9JWRcbiIsIGxp bmVfc3opOworCQkJZXJyID0gIC1FSU5WQUw7CisJCQlnb3RvIHJlbGVhc2VfbWVtOworCQl9CisK KwkJaWYgKGhleDJiaW4od3JfYnVmLCBwICsgMywgQ0NHNF9ST1dfU0laRSArIDQpKSB7CisJCQll cnIgPSAgLUVJTlZBTDsKKwkJCWdvdG8gcmVsZWFzZV9tZW07CisJCX0KKworCQlyb3cgPSBnZXRf dW5hbGlnbmVkX2JlMTYod3JfYnVmKTsKKwkJbGVuID0gZ2V0X3VuYWxpZ25lZF9iZTE2KCZ3cl9i dWZbMl0pOworCisJCWlmIChsZW4gIT0gQ0NHNF9ST1dfU0laRSkgeworCQkJZXJyID0gIC1FSU5W QUw7CisJCQlnb3RvIHJlbGVhc2VfbWVtOworCQl9CisKKwkJZXJyID0gY2NnX2NtZF93cml0ZV9m bGFzaF9yb3codWMsIHJvdywgd3JfYnVmICsgNCwKKwkJCQkJICAgICAgRkxBU0hfV1JfQ01EKTsK KwkJaWYgKGVycikKKwkJCWdvdG8gcmVsZWFzZV9tZW07CisKKwkJbGluZV9jbnQrKzsKKwkJcCA9 IHM7CisJfQorCisJZGV2X2luZm8oZGV2LCAidG90YWwgJWQgcm93IGZsYXNoZWQuIHRpbWU6ICVk bXNcbiIsCisJCSBsaW5lX2NudCwgamlmZmllc190b19tc2VjcyhqaWZmaWVzIC0gc3RhcnRfdGlt ZSkpOworCisJZXJyID0gY2NnX2NtZF92YWxpZGF0ZV9mdyh1YywgKG1vZGUgPT0gUFJJTUFSWSkg PyBGVzIgOiAgRlcxKTsKKwlpZiAoZXJyKQorCQlkZXZfZXJyKGRldiwgIiVzIHZhbGlkYXRpb24g ZmFpbGVkIGVycj0lZFxuIiwKKwkJCShtb2RlID09IFBSSU1BUlkpID8gIkZXMiIgOiAgIkZXMSIs IGVycik7CisJZWxzZQorCQlkZXZfaW5mbyhkZXYsICIlcyB2YWxpZGF0ZWRcbiIsCisJCQkgKG1v ZGUgPT0gUFJJTUFSWSkgPyAiRlcyIiA6ICAiRlcxIik7CisKKwllcnIgPSBjY2dfY21kX3BvcnRf Y29udHJvbCh1YywgZmFsc2UpOworCWlmIChlcnIgPCAwKQorCQlnb3RvIHJlbGVhc2VfbWVtOwor CisJZXJyID0gY2NnX2NtZF9yZXNldCh1Yyk7CisJaWYgKGVyciA8IDApCisJCWdvdG8gcmVsZWFz ZV9tZW07CisKKwllcnIgPSBjY2dfY21kX3BvcnRfY29udHJvbCh1YywgdHJ1ZSk7CisJaWYgKGVy ciA8IDApCisJCWdvdG8gcmVsZWFzZV9tZW07CisKK3JlbGVhc2VfbWVtOgorCWtmcmVlKHdyX2J1 Zik7CisKK3JlbGVhc2VfZnc6CisJcmVsZWFzZV9maXJtd2FyZShmdyk7CisJcmV0dXJuIGVycjsK K30KKworLyoqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioq KioqKioqKioqKioqKioqKioqKioqKioqKioqKioKKyAqIENDRzQgaGFzIHR3byBjb3BpZXMgb2Yg dGhlIGZpcm13YXJlIGluIGFkZGl0aW9uIHRvIHRoZSBib290bG9hZGVyLgorICogSWYgdGhlIGRl dmljZSBpcyBydW5uaW5nIEZXMSwgRlcyIGNhbiBiZSB1cGRhdGVkIHdpdGggdGhlIG5ldyB2ZXJz aW9uLgorICogRHVhbCBmaXJtd2FyZSBtb2RlIGFsbG93cyB0aGUgQ0NHIGRldmljZSB0byBzdGF5 IGluIGEgUEQgY29udHJhY3QgYW5kIHN1cHBvcnQKKyAqIFVTQiBQRCBhbmQgVHlwZS1DIGZ1bmN0 aW9uYWxpdHkgd2hpbGUgYSBmaXJtd2FyZSB1cGRhdGUgaXMgaW4gcHJvZ3Jlc3MuCisgKioqKioq KioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioqKioq KioqKioqKioqKioqKioqLworc3RhdGljIGludCBjY2dfZndfdXBkYXRlKHN0cnVjdCB1Y3NpX2Nj ZyAqdWMsIGVudW0gZW51bV9mbGFzaF9tb2RlIGZsYXNoX21vZGUpCit7CisJaW50IGVycjsKKwor CXdoaWxlIChmbGFzaF9tb2RlICE9IEZMQVNIX05PVF9ORUVERUQpIHsKKwkJZXJyID0gZG9fZmxh c2godWMsIGZsYXNoX21vZGUpOworCQlpZiAoZXJyIDwgMCkKKwkJCXJldHVybiBlcnI7CisJCWVy ciA9IGNjZ19md191cGRhdGVfbmVlZGVkKHVjLCAmZmxhc2hfbW9kZSk7CisJCWlmIChlcnIgPCAw KQorCQkJcmV0dXJuIGVycjsKKwl9CisJZGV2X2luZm8odWMtPmRldiwgIkNDRyBGVyB1cGRhdGUg c3VjY2Vzc2Z1bFxuIik7CisKKwlyZXR1cm4gZXJyOworfQorCitzdGF0aWMgaW50IGNjZ19yZXN0 YXJ0KHN0cnVjdCB1Y3NpX2NjZyAqdWMpCit7CisJc3RydWN0IGRldmljZSAqZGV2ID0gdWMtPmRl djsKKwlpbnQgc3RhdHVzOworCisJc3RhdHVzID0gdWNzaV9jY2dfaW5pdCh1Yyk7CisJaWYgKHN0 YXR1cyA8IDApIHsKKwkJZGV2X2VycihkZXYsICJ1Y3NpX2NjZ19zdGFydCBmYWlsLCBlcnI9JWRc biIsIHN0YXR1cyk7CisJCXJldHVybiBzdGF0dXM7CisJfQorCisJc3RhdHVzID0gcmVxdWVzdF90 aHJlYWRlZF9pcnEodWMtPmlycSwgTlVMTCwgY2NnX2lycV9oYW5kbGVyLAorCQkJCSAgICAgIElS UUZfT05FU0hPVCB8IElSUUZfVFJJR0dFUl9ISUdILAorCQkJCSAgICAgIGRldl9uYW1lKGRldiks IHVjKTsKKwlpZiAoc3RhdHVzIDwgMCkgeworCQlkZXZfZXJyKGRldiwgInJlcXVlc3RfdGhyZWFk ZWRfaXJxIGZhaWxlZCAtICVkXG4iLCBzdGF0dXMpOworCQlyZXR1cm4gc3RhdHVzOworCX0KKwor CXVjLT51Y3NpID0gdWNzaV9yZWdpc3Rlcl9wcG0oZGV2LCAmdWMtPnBwbSk7CisJaWYgKElTX0VS Uih1Yy0+dWNzaSkpIHsKKwkJZGV2X2Vycih1Yy0+ZGV2LCAidWNzaV9yZWdpc3Rlcl9wcG0gZmFp bGVkXG4iKTsKKwkJcmV0dXJuIFBUUl9FUlIodWMtPnVjc2kpOworCX0KKworCXJldHVybiAwOwor fQorCitzdGF0aWMgdm9pZCBjY2dfdXBkYXRlX2Zpcm13YXJlKHN0cnVjdCB3b3JrX3N0cnVjdCAq d29yaykKK3sKKwlzdHJ1Y3QgdWNzaV9jY2cgKnVjID0gY29udGFpbmVyX29mKHdvcmssIHN0cnVj dCB1Y3NpX2NjZywgd29yayk7CisJZW51bSBlbnVtX2ZsYXNoX21vZGUgZmxhc2hfbW9kZTsKKwlp bnQgc3RhdHVzOworCisJc3RhdHVzID0gY2NnX2Z3X3VwZGF0ZV9uZWVkZWQodWMsICZmbGFzaF9t b2RlKTsKKwlpZiAoc3RhdHVzIDwgMCkKKwkJcmV0dXJuOworCisJaWYgKGZsYXNoX21vZGUgIT0g RkxBU0hfTk9UX05FRURFRCkgeworCQl1Y3NpX3VucmVnaXN0ZXJfcHBtKHVjLT51Y3NpKTsKKwkJ ZnJlZV9pcnEodWMtPmlycSwgdWMpOworCisJCWNjZ19md191cGRhdGUodWMsIGZsYXNoX21vZGUp OworCQljY2dfcmVzdGFydCh1Yyk7CisJfQorfQorCitzdGF0aWMgc3NpemVfdCBkb19mbGFzaF9z dG9yZShzdHJ1Y3QgZGV2aWNlICpkZXYsCisJCQkgICAgICBzdHJ1Y3QgZGV2aWNlX2F0dHJpYnV0 ZSAqYXR0ciwKKwkJCSAgICAgIGNvbnN0IGNoYXIgKmJ1Ziwgc2l6ZV90IG4pCit7CisJc3RydWN0 IGkyY19jbGllbnQgKmkyY19jbCA9IHRvX2kyY19jbGllbnQoZGV2KTsKKwlzdHJ1Y3QgdWNzaV9j Y2cgKnVjID0gaTJjX2dldF9jbGllbnRkYXRhKGkyY19jbCk7CisJdW5zaWduZWQgaW50IG1vZGU7 CisKKwlpZiAoa3N0cnRvdWludChidWYsIDEwLCAmbW9kZSkpCisJCXJldHVybiAtRUlOVkFMOwor CisJaWYgKHVjLT5md19idWlsZCA9PSAweDApIHsKKwkJZGV2X2VycihkZXYsICJmYWlsIHRvIGZs YXNoIEZXIGR1ZSB0byBtaXNzaW5nIEZXIGJ1aWxkIGluZm8iKTsKKwkJcmV0dXJuIC1FSU5WQUw7 CisJfQorCisJaWYgKG1vZGUpCisJCXNjaGVkdWxlX3dvcmsoJnVjLT53b3JrKTsKKworCXJldHVy biBuOworfQorCitzdGF0aWMgREVWSUNFX0FUVFJfV08oZG9fZmxhc2gpOworCitzdGF0aWMgc3Ry dWN0IGF0dHJpYnV0ZSAqCit1Y3NpX2NjZ19zeXNmc19hdHRyc1tdID0geworCSZkZXZfYXR0cl9k b19mbGFzaC5hdHRyLAorCU5VTEwsCit9OworCitzdGF0aWMgc3RydWN0IGF0dHJpYnV0ZV9ncm91 cAordWNzaV9jY2dfYXR0cl9ncm91cCA9IHsKKwkuYXR0cnMgPSB1Y3NpX2NjZ19zeXNmc19hdHRy cywKK307CisKIHN0YXRpYyBpbnQgdWNzaV9jY2dfcHJvYmUoc3RydWN0IGkyY19jbGllbnQgKmNs aWVudCwKIAkJCSAgY29uc3Qgc3RydWN0IGkyY19kZXZpY2VfaWQgKmlkKQogewpAQCAtMjk2LDYg KzEwNzcsMTQgQEAgc3RhdGljIGludCB1Y3NpX2NjZ19wcm9iZShzdHJ1Y3QgaTJjX2NsaWVudCAq Y2xpZW50LAogCXVjLT5wcG0uc3luYyA9IHVjc2lfY2NnX3N5bmM7CiAJdWMtPmRldiA9IGRldjsK IAl1Yy0+Y2xpZW50ID0gY2xpZW50OworCW11dGV4X2luaXQoJnVjLT5sb2NrKTsKKwlJTklUX1dP UksoJnVjLT53b3JrLCBjY2dfdXBkYXRlX2Zpcm13YXJlKTsKKworCS8qIE9ubHkgZmFpbCBGVyBm bGFzaGluZyB3aGVuIEZXIGJ1aWxkIGluZm9ybWF0aW9uIGlzIG5vdCBwcm92aWRlZCAqLworCXN0 YXR1cyA9IGRldmljZV9wcm9wZXJ0eV9yZWFkX3UxNihkZXYsICJjY2d4LGZpcm13YXJlLWJ1aWxk IiwKKwkJCQkJICAmdWMtPmZ3X2J1aWxkKTsKKwlpZiAoc3RhdHVzKQorCQlkZXZfZXJyKHVjLT5k ZXYsICJmYWlsZWQgdG8gZ2V0IEZXIGJ1aWxkIGluZm9ybWF0aW9uXG4iKTsKIAogCS8qIHJlc2V0 IGNjZyBkZXZpY2UgYW5kIGluaXRpYWxpemUgdWNzaSAqLwogCXN0YXR1cyA9IHVjc2lfY2NnX2lu aXQodWMpOwpAQCAtMzEwLDE1ICsxMDk5LDIxIEBAIHN0YXRpYyBpbnQgdWNzaV9jY2dfcHJvYmUo c3RydWN0IGkyY19jbGllbnQgKmNsaWVudCwKIAkJcmV0dXJuIHN0YXR1czsKIAl9CiAKLQlzdGF0 dXMgPSBkZXZtX3JlcXVlc3RfdGhyZWFkZWRfaXJxKGRldiwgY2xpZW50LT5pcnEsIE5VTEwsCi0J CQkJCSAgIGNjZ19pcnFfaGFuZGxlciwKLQkJCQkJICAgSVJRRl9PTkVTSE9UIHwgSVJRRl9UUklH R0VSX0hJR0gsCi0JCQkJCSAgIGRldl9uYW1lKGRldiksIHVjKTsKKwl1Yy0+cG9ydF9udW0gPSAx OworCisJaWYgKHVjLT5pbmZvLm1vZGUgJiBDQ0dfREVWSU5GT19QRFBPUlRTX01BU0spCisJCXVj LT5wb3J0X251bSsrOworCisJc3RhdHVzID0gcmVxdWVzdF90aHJlYWRlZF9pcnEoY2xpZW50LT5p cnEsIE5VTEwsIGNjZ19pcnFfaGFuZGxlciwKKwkJCQkgICAgICBJUlFGX09ORVNIT1QgfCBJUlFG X1RSSUdHRVJfSElHSCwKKwkJCQkgICAgICBkZXZfbmFtZShkZXYpLCB1Yyk7CiAJaWYgKHN0YXR1 cyA8IDApIHsKIAkJZGV2X2Vycih1Yy0+ZGV2LCAicmVxdWVzdF90aHJlYWRlZF9pcnEgZmFpbGVk IC0gJWRcbiIsIHN0YXR1cyk7CiAJCXJldHVybiBzdGF0dXM7CiAJfQogCisJdWMtPmlycSA9IGNs aWVudC0+aXJxOworCiAJdWMtPnVjc2kgPSB1Y3NpX3JlZ2lzdGVyX3BwbShkZXYsICZ1Yy0+cHBt KTsKIAlpZiAoSVNfRVJSKHVjLT51Y3NpKSkgewogCQlkZXZfZXJyKHVjLT5kZXYsICJ1Y3NpX3Jl Z2lzdGVyX3BwbSBmYWlsZWRcbiIpOwpAQCAtMzM1LDYgKzExMzAsMTEgQEAgc3RhdGljIGludCB1 Y3NpX2NjZ19wcm9iZShzdHJ1Y3QgaTJjX2NsaWVudCAqY2xpZW50LAogCX0KIAogCWkyY19zZXRf Y2xpZW50ZGF0YShjbGllbnQsIHVjKTsKKworCXN0YXR1cyA9IHN5c2ZzX2NyZWF0ZV9ncm91cCgm dWMtPmRldi0+a29iaiwgJnVjc2lfY2NnX2F0dHJfZ3JvdXApOworCWlmIChzdGF0dXMpCisJCWRl dl9lcnIodWMtPmRldiwgImNhbm5vdCBjcmVhdGUgc3lzZnMgZ3JvdXA6ICVkXG4iLCBzdGF0dXMp OworCiAJcmV0dXJuIDA7CiB9CiAKQEAgLTM0Miw3ICsxMTQyLDEwIEBAIHN0YXRpYyBpbnQgdWNz aV9jY2dfcmVtb3ZlKHN0cnVjdCBpMmNfY2xpZW50ICpjbGllbnQpCiB7CiAJc3RydWN0IHVjc2lf Y2NnICp1YyA9IGkyY19nZXRfY2xpZW50ZGF0YShjbGllbnQpOwogCisJY2FuY2VsX3dvcmtfc3lu YygmdWMtPndvcmspOwogCXVjc2lfdW5yZWdpc3Rlcl9wcG0odWMtPnVjc2kpOworCWZyZWVfaXJx KHVjLT5pcnEsIHVjKTsKKwlzeXNmc19yZW1vdmVfZ3JvdXAoJnVjLT5kZXYtPmtvYmosICZ1Y3Np X2NjZ19hdHRyX2dyb3VwKTsKIAogCXJldHVybiAwOwogfQo=