Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: base64 Subject: [v4,1/5] usb: typec: tcpm: pdo matching optimization From: Jun Li Message-Id: <1523629125-16332-2-git-send-email-jun.li@nxp.com> Date: Fri, 13 Apr 2018 22:18:41 +0800 To: gregkh@linuxfoundation.org, robh+dt@kernel.org, heikki.krogerus@linux.intel.com, hdegoede@redhat.com Cc: linux@roeck-us.net, rmfrfs@gmail.com, yueyao.zhu@gmail.com, linux-usb@vger.kernel.org, linux-imx@nxp.com List-ID: VGhpcyBwYXRjaCBpcyBhIGNvbWJpbmF0aW9uIG9mIGNvbW1pdCA1N2U2ZjBkN2I4MDQKKCJ0eXBl YzogdGNwbTogT25seSByZXF1ZXN0IG1hdGNoaW5nIHBkb3MiKSBhbmQgc291cmNlCnBkbyBzZWxl Y3Rpb24gb3B0aW1pemF0aW9uIGJhc2VkIG9uIGl0LCBpbnN0ZWFkIG9mIG9ubHkKY29tcGFyZSBi ZXR3ZWVuIHRoZSBzYW1lIHBkbyB0eXBlIG9mIHNpbmsgYW5kIHNvdXJjZSwKd2Ugc2hvdWxkIGNo ZWNrIHNvdXJjZSBwZG8gdm9sdGFnZSByYW5nZSBpcyB3aXRoaW4gdGhlCnZvbHRhZ2UgcmFuZ2Ug b2Ygb25lIHNpbmsgcGRvLgoKUmV2aWV3ZWQtYnk6IEhhbnMgZGUgR29lZGUgPGhkZWdvZWRlQHJl ZGhhdC5jb20+ClNpZ25lZC1vZmYtYnk6IExpIEp1biA8anVuLmxpQG54cC5jb20+Ci0tLQogZHJp dmVycy91c2IvdHlwZWMvdGNwbS5jIHwgMTAyICsrKysrKysrKysrKysrKysrKysrKysrKysrKysr Ky0tLS0tLS0tLS0tLS0tLS0tCiAxIGZpbGUgY2hhbmdlZCwgNjUgaW5zZXJ0aW9ucygrKSwgMzcg ZGVsZXRpb25zKC0pCgpkaWZmIC0tZ2l0IGEvZHJpdmVycy91c2IvdHlwZWMvdGNwbS5jIGIvZHJp dmVycy91c2IvdHlwZWMvdGNwbS5jCmluZGV4IDY3N2QxMjEuLmMxMjczMzkgMTAwNjQ0Ci0tLSBh L2RyaXZlcnMvdXNiL3R5cGVjL3RjcG0uYworKysgYi9kcml2ZXJzL3VzYi90eXBlYy90Y3BtLmMK QEAgLTE3NzIsNDAgKzE3NzIsNjUgQEAgc3RhdGljIGludCB0Y3BtX3BkX2NoZWNrX3JlcXVlc3Qo c3RydWN0IHRjcG1fcG9ydCAqcG9ydCkKIAlyZXR1cm4gMDsKIH0KIAotc3RhdGljIGludCB0Y3Bt X3BkX3NlbGVjdF9wZG8oc3RydWN0IHRjcG1fcG9ydCAqcG9ydCkKKyNkZWZpbmUgbWluX3Bvd2Vy KHgsIHkpIG1pbihwZG9fbWF4X3Bvd2VyKHgpLCBwZG9fbWF4X3Bvd2VyKHkpKQorI2RlZmluZSBt aW5fY3VycmVudCh4LCB5KSBtaW4ocGRvX21heF9jdXJyZW50KHgpLCBwZG9fbWF4X2N1cnJlbnQo eSkpCisKK3N0YXRpYyBpbnQgdGNwbV9wZF9zZWxlY3RfcGRvKHN0cnVjdCB0Y3BtX3BvcnQgKnBv cnQsIGludCAqc2lua19wZG8sCisJCQkgICAgICBpbnQgKnNyY19wZG8pCiB7Ci0JdW5zaWduZWQg aW50IGksIG1heF9tdyA9IDAsIG1heF9tdiA9IDA7CisJdW5zaWduZWQgaW50IGksIGosIG1heF9z cmNfbXYgPSAwLCBtaW5fc3JjX212ID0gMCwgbWF4X213ID0gMCwKKwkJICAgICBtYXhfbXYgPSAw LCBzcmNfbXcgPSAwLCBzcmNfbWEgPSAwLCBtYXhfc25rX212ID0gMCwKKwkJICAgICBtaW5fc25r X212ID0gMDsKIAlpbnQgcmV0ID0gLUVJTlZBTDsKIAogCS8qCi0JICogU2VsZWN0IHRoZSBzb3Vy Y2UgUERPIHByb3ZpZGluZyB0aGUgbW9zdCBwb3dlciB3aGlsZSBzdGF5aW5nIHdpdGhpbgotCSAq IHRoZSBib2FyZCdzIHZvbHRhZ2UgbGltaXRzLiBQcmVmZXIgUERPIHByb3ZpZGluZyBleHAKKwkg KiBTZWxlY3QgdGhlIHNvdXJjZSBQRE8gcHJvdmlkaW5nIHRoZSBtb3N0IHBvd2VyIHdoaWNoIGhh cyBhCisJICogbWF0Y2hpZyBzaW5rIGNhcC4KIAkgKi8KIAlmb3IgKGkgPSAwOyBpIDwgcG9ydC0+ bnJfc291cmNlX2NhcHM7IGkrKykgewogCQl1MzIgcGRvID0gcG9ydC0+c291cmNlX2NhcHNbaV07 CiAJCWVudW0gcGRfcGRvX3R5cGUgdHlwZSA9IHBkb190eXBlKHBkbyk7Ci0JCXVuc2lnbmVkIGlu dCBtdiwgbWEsIG13OwogCi0JCWlmICh0eXBlID09IFBET19UWVBFX0ZJWEVEKQotCQkJbXYgPSBw ZG9fZml4ZWRfdm9sdGFnZShwZG8pOwotCQllbHNlCi0JCQltdiA9IHBkb19taW5fdm9sdGFnZShw ZG8pOworCQlpZiAodHlwZSA9PSBQRE9fVFlQRV9GSVhFRCkgeworCQkJbWF4X3NyY19tdiA9IHBk b19maXhlZF92b2x0YWdlKHBkbyk7CisJCQltaW5fc3JjX212ID0gbWF4X3NyY19tdjsKKwkJfSBl bHNlIHsKKwkJCW1heF9zcmNfbXYgPSBwZG9fbWF4X3ZvbHRhZ2UocGRvKTsKKwkJCW1pbl9zcmNf bXYgPSBwZG9fbWluX3ZvbHRhZ2UocGRvKTsKKwkJfQogCiAJCWlmICh0eXBlID09IFBET19UWVBF X0JBVFQpIHsKLQkJCW13ID0gcGRvX21heF9wb3dlcihwZG8pOworCQkJc3JjX213ID0gcGRvX21h eF9wb3dlcihwZG8pOwogCQl9IGVsc2UgewotCQkJbWEgPSBtaW4ocGRvX21heF9jdXJyZW50KHBk byksCi0JCQkJIHBvcnQtPm1heF9zbmtfbWEpOwotCQkJbXcgPSBtYSAqIG12IC8gMTAwMDsKKwkJ CXNyY19tYSA9IHBkb19tYXhfY3VycmVudChwZG8pOworCQkJc3JjX213ID0gc3JjX21hICogbWlu X3NyY19tdiAvIDEwMDA7CiAJCX0KIAotCQkvKiBQZXJmZXIgaGlnaGVyIHZvbHRhZ2VzIGlmIGF2 YWlsYWJsZSAqLwotCQlpZiAoKG13ID4gbWF4X213IHx8IChtdyA9PSBtYXhfbXcgJiYgbXYgPiBt YXhfbXYpKSAmJgotCQkgICAgbXYgPD0gcG9ydC0+bWF4X3Nua19tdikgewotCQkJcmV0ID0gaTsK LQkJCW1heF9tdyA9IG13OwotCQkJbWF4X212ID0gbXY7CisJCWZvciAoaiA9IDA7IGogPCBwb3J0 LT5ucl9zbmtfcGRvOyBqKyspIHsKKwkJCXBkbyA9IHBvcnQtPnNua19wZG9bal07CisKKwkJCWlm IChwZG9fdHlwZShwZG8pID09IFBET19UWVBFX0ZJWEVEKSB7CisJCQkJbWluX3Nua19tdiA9IHBk b19maXhlZF92b2x0YWdlKHBkbyk7CisJCQkJbWF4X3Nua19tdiA9IHBkb19maXhlZF92b2x0YWdl KHBkbyk7CisJCQl9IGVsc2UgeworCQkJCW1pbl9zbmtfbXYgPSBwZG9fbWluX3ZvbHRhZ2UocGRv KTsKKwkJCQltYXhfc25rX212ID0gcGRvX21heF92b2x0YWdlKHBkbyk7CisJCQl9CisKKwkJCWlm IChtYXhfc3JjX212IDw9IG1heF9zbmtfbXYgJiYKKwkJCQltaW5fc3JjX212ID49IG1pbl9zbmtf bXYpIHsKKwkJCQkvKiBQcmVmZXIgaGlnaGVyIHZvbHRhZ2VzIGlmIGF2YWlsYWJsZSAqLworCQkJ CWlmICgoc3JjX213ID09IG1heF9tdyAmJiBtaW5fc3JjX212ID4gbWF4X212KSB8fAorCQkJCQkJ CXNyY19tdyA+IG1heF9tdykgeworCQkJCQkqc3JjX3BkbyA9IGk7CisJCQkJCSpzaW5rX3BkbyA9 IGo7CisJCQkJCW1heF9tdyA9IHNyY19tdzsKKwkJCQkJbWF4X212ID0gbWluX3NyY19tdjsKKwkJ CQl9CisJCQkJYnJlYWs7CisJCQl9CiAJCX0KKwogCX0KIAogCXJldHVybiByZXQ7CkBAIC0xODE2 LDEzICsxODQxLDE0IEBAIHN0YXRpYyBpbnQgdGNwbV9wZF9idWlsZF9yZXF1ZXN0KHN0cnVjdCB0 Y3BtX3BvcnQgKnBvcnQsIHUzMiAqcmRvKQogCXVuc2lnbmVkIGludCBtdiwgbWEsIG13LCBmbGFn czsKIAl1bnNpZ25lZCBpbnQgbWF4X21hLCBtYXhfbXc7CiAJZW51bSBwZF9wZG9fdHlwZSB0eXBl OwotCWludCBpbmRleDsKLQl1MzIgcGRvOworCWludCBzcmNfcGRvX2luZGV4LCBzbmtfcGRvX2lu ZGV4OworCXUzMiBwZG8sIG1hdGNoaW5nX3Nua19wZG87CiAKLQlpbmRleCA9IHRjcG1fcGRfc2Vs ZWN0X3Bkbyhwb3J0KTsKLQlpZiAoaW5kZXggPCAwKQorCWlmICh0Y3BtX3BkX3NlbGVjdF9wZG8o cG9ydCwgJnNua19wZG9faW5kZXgsICZzcmNfcGRvX2luZGV4KSA8IDApCiAJCXJldHVybiAtRUlO VkFMOwotCXBkbyA9IHBvcnQtPnNvdXJjZV9jYXBzW2luZGV4XTsKKworCXBkbyA9IHBvcnQtPnNv dXJjZV9jYXBzW3NyY19wZG9faW5kZXhdOworCW1hdGNoaW5nX3Nua19wZG8gPSBwb3J0LT5zbmtf cGRvW3Nua19wZG9faW5kZXhdOwogCXR5cGUgPSBwZG9fdHlwZShwZG8pOwogCiAJaWYgKHR5cGUg PT0gUERPX1RZUEVfRklYRUQpCkBAIC0xODMwLDI2ICsxODU2LDI4IEBAIHN0YXRpYyBpbnQgdGNw bV9wZF9idWlsZF9yZXF1ZXN0KHN0cnVjdCB0Y3BtX3BvcnQgKnBvcnQsIHUzMiAqcmRvKQogCWVs c2UKIAkJbXYgPSBwZG9fbWluX3ZvbHRhZ2UocGRvKTsKIAotCS8qIFNlbGVjdCBtYXhpbXVtIGF2 YWlsYWJsZSBjdXJyZW50IHdpdGhpbiB0aGUgYm9hcmQncyBwb3dlciBsaW1pdCAqLworCS8qIFNl bGVjdCBtYXhpbXVtIGF2YWlsYWJsZSBjdXJyZW50IHdpdGhpbiB0aGUgc2luayBwZG8ncyBsaW1p dCAqLwogCWlmICh0eXBlID09IFBET19UWVBFX0JBVFQpIHsKLQkJbXcgPSBwZG9fbWF4X3Bvd2Vy KHBkbyk7Ci0JCW1hID0gMTAwMCAqIG1pbihtdywgcG9ydC0+bWF4X3Nua19tdykgLyBtdjsKKwkJ bXcgPSBtaW5fcG93ZXIocGRvLCBtYXRjaGluZ19zbmtfcGRvKTsKKwkJbWEgPSAxMDAwICogbXcg LyBtdjsKIAl9IGVsc2UgewotCQltYSA9IG1pbihwZG9fbWF4X2N1cnJlbnQocGRvKSwKLQkJCSAx MDAwICogcG9ydC0+bWF4X3Nua19tdyAvIG12KTsKKwkJbWEgPSBtaW5fY3VycmVudChwZG8sIG1h dGNoaW5nX3Nua19wZG8pOworCQltdyA9IG1hICogbXYgLyAxMDAwOwogCX0KLQltYSA9IG1pbiht YSwgcG9ydC0+bWF4X3Nua19tYSk7CiAKIAlmbGFncyA9IFJET19VU0JfQ09NTSB8IFJET19OT19T VVNQRU5EOwogCiAJLyogU2V0IG1pc21hdGNoIGJpdCBpZiBvZmZlcmVkIHBvd2VyIGlzIGxlc3Mg dGhhbiBvcGVyYXRpbmcgcG93ZXIgKi8KLQltdyA9IG1hICogbXYgLyAxMDAwOwogCW1heF9tYSA9 IG1hOwogCW1heF9tdyA9IG13OwogCWlmIChtdyA8IHBvcnQtPm9wZXJhdGluZ19zbmtfbXcpIHsK IAkJZmxhZ3MgfD0gUkRPX0NBUF9NSVNNQVRDSDsKLQkJbWF4X213ID0gcG9ydC0+b3BlcmF0aW5n X3Nua19tdzsKLQkJbWF4X21hID0gbWF4X213ICogMTAwMCAvIG12OworCQlpZiAodHlwZSA9PSBQ RE9fVFlQRV9CQVRUICYmCisJCSAgICAocGRvX21heF9wb3dlcihtYXRjaGluZ19zbmtfcGRvKSA+ IHBkb19tYXhfcG93ZXIocGRvKSkpCisJCQltYXhfbXcgPSBwZG9fbWF4X3Bvd2VyKG1hdGNoaW5n X3Nua19wZG8pOworCQllbHNlIGlmIChwZG9fbWF4X2N1cnJlbnQobWF0Y2hpbmdfc25rX3Bkbykg PgorCQkJIHBkb19tYXhfY3VycmVudChwZG8pKQorCQkJbWF4X21hID0gcGRvX21heF9jdXJyZW50 KG1hdGNoaW5nX3Nua19wZG8pOwogCX0KIAogCXRjcG1fbG9nKHBvcnQsICJjYz0lZCBjYzE9JWQg Y2MyPSVkIHZidXM9JWQgdmNvbm49JXMgcG9sYXJpdHk9JWQiLApAQCAtMTg1OCwxNiArMTg4Niwx NiBAQCBzdGF0aWMgaW50IHRjcG1fcGRfYnVpbGRfcmVxdWVzdChzdHJ1Y3QgdGNwbV9wb3J0ICpw b3J0LCB1MzIgKnJkbykKIAkJIHBvcnQtPnBvbGFyaXR5KTsKIAogCWlmICh0eXBlID09IFBET19U WVBFX0JBVFQpIHsKLQkJKnJkbyA9IFJET19CQVRUKGluZGV4ICsgMSwgbXcsIG1heF9tdywgZmxh Z3MpOworCQkqcmRvID0gUkRPX0JBVFQoc3JjX3Bkb19pbmRleCArIDEsIG13LCBtYXhfbXcsIGZs YWdzKTsKIAogCQl0Y3BtX2xvZyhwb3J0LCAiUmVxdWVzdGluZyBQRE8gJWQ6ICV1IG1WLCAldSBt VyVzIiwKLQkJCSBpbmRleCwgbXYsIG13LAorCQkJIHNyY19wZG9faW5kZXgsIG12LCBtdywKIAkJ CSBmbGFncyAmIFJET19DQVBfTUlTTUFUQ0ggPyAiIFttaXNtYXRjaF0iIDogIiIpOwogCX0gZWxz ZSB7Ci0JCSpyZG8gPSBSRE9fRklYRUQoaW5kZXggKyAxLCBtYSwgbWF4X21hLCBmbGFncyk7CisJ CSpyZG8gPSBSRE9fRklYRUQoc3JjX3Bkb19pbmRleCArIDEsIG1hLCBtYXhfbWEsIGZsYWdzKTsK IAogCQl0Y3BtX2xvZyhwb3J0LCAiUmVxdWVzdGluZyBQRE8gJWQ6ICV1IG1WLCAldSBtQSVzIiwK LQkJCSBpbmRleCwgbXYsIG1hLAorCQkJIHNyY19wZG9faW5kZXgsIG12LCBtYSwKIAkJCSBmbGFn cyAmIFJET19DQVBfTUlTTUFUQ0ggPyAiIFttaXNtYXRjaF0iIDogIiIpOwogCX0KIAo=