From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Google-Smtp-Source: AG47ELtvLvIex5UgJVE3UF+BQczCeSVm1++BfTej/JoGT+HhjY6yP9Wbp1NaK2fLmgiDqDYf3W3R ARC-Seal: i=1; a=rsa-sha256; t=1521550672; cv=none; d=google.com; s=arc-20160816; b=i8/5X1wVvCsnozD4T0+QEj+CKS1wX8ZwryKve3z7a99jj9e3h/ze+q3B982RAbXyvR 7/HZnNtkwYRsm1MHfHrEIuhalhUxqaNFMifpWVdTqfin1C/7J78WQ/ww8xD6h53XPCLa x6i23TuXQdTTrenBRlqWn7UouqtwUJ/7/CjR4qbCa9tBRoQtHphX0GknTJQ8jpKphL+4 RgtEQRrF8lfC17a5Z5+wVJVkotyVJITZMfOkzEsJVPi0hV/dbhBBt2v121VTCLKoyut0 xLJlKC5KbCTfQ/NoBXe50E1t5DP1IfdVQARpQbaWN5SpV6izZdBrW6s3bTsOkT0dcZuX 5+tA== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=references:in-reply-to:message-id:date:subject:cc:to:from :arc-authentication-results; bh=pwu/0WELrtJmackTQOkSFwS6mGCwyYORs/4V32fN//I=; b=LpRDqGW2x3xkN5TxePQvH1IA8Cy9w4qlVORjSgft22nzzW/xt2TQPyRPIvIV3AJdut 1Pu7RzQTzcFcAuQ1Anqa4Q96NWlBi7h8G0RaXAzgyazsF10hGnX4HZuApl3vwsJ+Rfi4 or0D+tk+oZcmWx5hGqoo9AxUOoOjt2X1lEqFM8IGuVJlcnOBGd4aLZGcGvHNrANoBbPE i47rMuYtbNeqJXF6K0YDgFfOrZQz90Ij6aePX6N04r5XslgNJ+PFf0nrnIfvHpfjTkrY z/5W4vC0/w+LfaTxSAndNSUuZI4dJybQYRNwS9rY6rLT70IB6nf4RAXWbANtMx5JIAb6 dzqg== ARC-Authentication-Results: i=1; mx.google.com; spf=pass (google.com: best guess record for domain of heikki.krogerus@linux.intel.com designates 134.134.136.31 as permitted sender) smtp.mailfrom=heikki.krogerus@linux.intel.com Authentication-Results: mx.google.com; spf=pass (google.com: best guess record for domain of heikki.krogerus@linux.intel.com designates 134.134.136.31 as permitted sender) smtp.mailfrom=heikki.krogerus@linux.intel.com X-Amp-Result: SKIPPED(no attachment in message) X-Amp-File-Uploaded: False X-ExtLoop1: 1 X-IronPort-AV: E=Sophos;i="5.48,335,1517904000"; d="scan'208";a="39592607" From: Heikki Krogerus To: Greg Kroah-Hartman , Hans de Goede Cc: Darren Hart , Andy Shevchenko , MyungJoo Ham , Chanwoo Choi , Mathias Nyman , Guenter Roeck , Jun Li , platform-driver-x86@vger.kernel.org, linux-kernel@vger.kernel.org, linux-usb@vger.kernel.org Subject: [PATCH v9 10/12] usb: typec: driver for Pericom PI3USB30532 Type-C cross switch Date: Tue, 20 Mar 2018 15:57:11 +0300 Message-Id: <20180320125713.85465-11-heikki.krogerus@linux.intel.com> X-Mailer: git-send-email 2.16.2 In-Reply-To: <20180320125713.85465-1-heikki.krogerus@linux.intel.com> References: <20180320125713.85465-1-heikki.krogerus@linux.intel.com> X-getmail-retrieved-from-mailbox: INBOX X-GMAIL-THRID: =?utf-8?q?1595461518026851633?= X-GMAIL-MSGID: =?utf-8?q?1595461518026851633?= X-Mailing-List: linux-kernel@vger.kernel.org List-ID: From: Hans de Goede Add a driver for the Pericom PI3USB30532 Type-C cross switch / mux chip found on some devices with a Type-C port. Signed-off-by: Hans de Goede Reviewed-by: Andy Shevchenko Signed-off-by: Heikki Krogerus --- Changes in v7: - Remove unneeded semicolon Changes in v4: -Add Andy's Reviewed-by Changes in v2: -Cleanup pi3usb30532_set_conf() error handling -Add Heikki's Reviewed-by Changes in v1: -This is a rewrite of my previous driver which was using the drivers/mux framework to use the new drivers/usb/typec/mux framework --- MAINTAINERS | 6 ++ drivers/usb/typec/Kconfig | 2 + drivers/usb/typec/Makefile | 1 + drivers/usb/typec/mux/Kconfig | 10 ++ drivers/usb/typec/mux/Makefile | 3 + drivers/usb/typec/mux/pi3usb30532.c | 178 ++++++++++++++++++++++++++++++++++++ 6 files changed, 200 insertions(+) create mode 100644 drivers/usb/typec/mux/Kconfig create mode 100644 drivers/usb/typec/mux/Makefile create mode 100644 drivers/usb/typec/mux/pi3usb30532.c diff --git a/MAINTAINERS b/MAINTAINERS index e6c0a3f1c734..880b7098da42 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -14607,6 +14607,12 @@ F: drivers/usb/ F: include/linux/usb.h F: include/linux/usb/ +USB TYPEC PI3USB30532 MUX DRIVER +M: Hans de Goede +L: linux-usb@vger.kernel.org +S: Maintained +F: drivers/usb/typec/mux/pi3usb30532.c + USB TYPEC SUBSYSTEM M: Heikki Krogerus L: linux-usb@vger.kernel.org diff --git a/drivers/usb/typec/Kconfig b/drivers/usb/typec/Kconfig index a2a0684e7c82..030f88cb0c3f 100644 --- a/drivers/usb/typec/Kconfig +++ b/drivers/usb/typec/Kconfig @@ -85,4 +85,6 @@ config TYPEC_TPS6598X If you choose to build this driver as a dynamically linked module, the module will be called tps6598x.ko. +source "drivers/usb/typec/mux/Kconfig" + endif # TYPEC diff --git a/drivers/usb/typec/Makefile b/drivers/usb/typec/Makefile index 56b2e9516ec1..1f599a6c30cc 100644 --- a/drivers/usb/typec/Makefile +++ b/drivers/usb/typec/Makefile @@ -6,3 +6,4 @@ obj-y += fusb302/ obj-$(CONFIG_TYPEC_WCOVE) += typec_wcove.o obj-$(CONFIG_TYPEC_UCSI) += ucsi/ obj-$(CONFIG_TYPEC_TPS6598X) += tps6598x.o +obj-$(CONFIG_TYPEC) += mux/ diff --git a/drivers/usb/typec/mux/Kconfig b/drivers/usb/typec/mux/Kconfig new file mode 100644 index 000000000000..9a954d2b8d8f --- /dev/null +++ b/drivers/usb/typec/mux/Kconfig @@ -0,0 +1,10 @@ +menu "USB Type-C Multiplexer/DeMultiplexer Switch support" + +config TYPEC_MUX_PI3USB30532 + tristate "Pericom PI3USB30532 Type-C cross switch driver" + depends on I2C + help + Say Y or M if your system has a Pericom PI3USB30532 Type-C cross + switch / mux chip found on some devices with a Type-C port. + +endmenu diff --git a/drivers/usb/typec/mux/Makefile b/drivers/usb/typec/mux/Makefile new file mode 100644 index 000000000000..1332e469b8a0 --- /dev/null +++ b/drivers/usb/typec/mux/Makefile @@ -0,0 +1,3 @@ +# SPDX-License-Identifier: GPL-2.0 + +obj-$(CONFIG_TYPEC_MUX_PI3USB30532) += pi3usb30532.o diff --git a/drivers/usb/typec/mux/pi3usb30532.c b/drivers/usb/typec/mux/pi3usb30532.c new file mode 100644 index 000000000000..b0e88db60ecf --- /dev/null +++ b/drivers/usb/typec/mux/pi3usb30532.c @@ -0,0 +1,178 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Pericom PI3USB30532 Type-C cross switch / mux driver + * + * Copyright (c) 2017-2018 Hans de Goede + */ + +#include +#include +#include +#include +#include +#include + +#define PI3USB30532_CONF 0x00 + +#define PI3USB30532_CONF_OPEN 0x00 +#define PI3USB30532_CONF_SWAP 0x01 +#define PI3USB30532_CONF_4LANE_DP 0x02 +#define PI3USB30532_CONF_USB3 0x04 +#define PI3USB30532_CONF_USB3_AND_2LANE_DP 0x06 + +struct pi3usb30532 { + struct i2c_client *client; + struct mutex lock; /* protects the cached conf register */ + struct typec_switch sw; + struct typec_mux mux; + u8 conf; +}; + +static int pi3usb30532_set_conf(struct pi3usb30532 *pi, u8 new_conf) +{ + int ret = 0; + + if (pi->conf == new_conf) + return 0; + + ret = i2c_smbus_write_byte_data(pi->client, PI3USB30532_CONF, new_conf); + if (ret) { + dev_err(&pi->client->dev, "Error writing conf: %d\n", ret); + return ret; + } + + pi->conf = new_conf; + return 0; +} + +static int pi3usb30532_sw_set(struct typec_switch *sw, + enum typec_orientation orientation) +{ + struct pi3usb30532 *pi = container_of(sw, struct pi3usb30532, sw); + u8 new_conf; + int ret; + + mutex_lock(&pi->lock); + new_conf = pi->conf; + + switch (orientation) { + case TYPEC_ORIENTATION_NONE: + new_conf = PI3USB30532_CONF_OPEN; + break; + case TYPEC_ORIENTATION_NORMAL: + new_conf &= ~PI3USB30532_CONF_SWAP; + break; + case TYPEC_ORIENTATION_REVERSE: + new_conf |= PI3USB30532_CONF_SWAP; + break; + } + + ret = pi3usb30532_set_conf(pi, new_conf); + mutex_unlock(&pi->lock); + + return ret; +} + +static int pi3usb30532_mux_set(struct typec_mux *mux, int state) +{ + struct pi3usb30532 *pi = container_of(mux, struct pi3usb30532, mux); + u8 new_conf; + int ret; + + mutex_lock(&pi->lock); + new_conf = pi->conf; + + switch (state) { + case TYPEC_MUX_NONE: + new_conf = PI3USB30532_CONF_OPEN; + break; + case TYPEC_MUX_USB: + new_conf = (new_conf & PI3USB30532_CONF_SWAP) | + PI3USB30532_CONF_USB3; + break; + case TYPEC_MUX_DP: + new_conf = (new_conf & PI3USB30532_CONF_SWAP) | + PI3USB30532_CONF_4LANE_DP; + break; + case TYPEC_MUX_DOCK: + new_conf = (new_conf & PI3USB30532_CONF_SWAP) | + PI3USB30532_CONF_USB3_AND_2LANE_DP; + break; + } + + ret = pi3usb30532_set_conf(pi, new_conf); + mutex_unlock(&pi->lock); + + return ret; +} + +static int pi3usb30532_probe(struct i2c_client *client) +{ + struct device *dev = &client->dev; + struct pi3usb30532 *pi; + int ret; + + pi = devm_kzalloc(dev, sizeof(*pi), GFP_KERNEL); + if (!pi) + return -ENOMEM; + + pi->client = client; + pi->sw.dev = dev; + pi->sw.set = pi3usb30532_sw_set; + pi->mux.dev = dev; + pi->mux.set = pi3usb30532_mux_set; + mutex_init(&pi->lock); + + ret = i2c_smbus_read_byte_data(client, PI3USB30532_CONF); + if (ret < 0) { + dev_err(dev, "Error reading config register %d\n", ret); + return ret; + } + pi->conf = ret; + + ret = typec_switch_register(&pi->sw); + if (ret) { + dev_err(dev, "Error registering typec switch: %d\n", ret); + return ret; + } + + ret = typec_mux_register(&pi->mux); + if (ret) { + typec_switch_unregister(&pi->sw); + dev_err(dev, "Error registering typec mux: %d\n", ret); + return ret; + } + + i2c_set_clientdata(client, pi); + return 0; +} + +static int pi3usb30532_remove(struct i2c_client *client) +{ + struct pi3usb30532 *pi = i2c_get_clientdata(client); + + typec_mux_unregister(&pi->mux); + typec_switch_unregister(&pi->sw); + return 0; +} + +static const struct i2c_device_id pi3usb30532_table[] = { + { "pi3usb30532" }, + { } +}; +MODULE_DEVICE_TABLE(i2c, pi3usb30532_table); + +static struct i2c_driver pi3usb30532_driver = { + .driver = { + .name = "pi3usb30532", + }, + .probe_new = pi3usb30532_probe, + .remove = pi3usb30532_remove, + .id_table = pi3usb30532_table, +}; + +module_i2c_driver(pi3usb30532_driver); + +MODULE_AUTHOR("Hans de Goede "); +MODULE_DESCRIPTION("Pericom PI3USB30532 Type-C mux driver"); +MODULE_LICENSE("GPL"); -- 2.16.2 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: [v9,10/12] usb: typec: driver for Pericom PI3USB30532 Type-C cross switch From: Heikki Krogerus Message-Id: <20180320125713.85465-11-heikki.krogerus@linux.intel.com> Date: Tue, 20 Mar 2018 15:57:11 +0300 To: Greg Kroah-Hartman , Hans de Goede Cc: Darren Hart , Andy Shevchenko , MyungJoo Ham , Chanwoo Choi , Mathias Nyman , Guenter Roeck , Jun Li , platform-driver-x86@vger.kernel.org, linux-kernel@vger.kernel.org, linux-usb@vger.kernel.org List-ID: RnJvbTogSGFucyBkZSBHb2VkZSA8aGRlZ29lZGVAcmVkaGF0LmNvbT4KCkFkZCBhIGRyaXZlciBm b3IgdGhlIFBlcmljb20gUEkzVVNCMzA1MzIgVHlwZS1DIGNyb3NzIHN3aXRjaCAvCm11eCBjaGlw IGZvdW5kIG9uIHNvbWUgZGV2aWNlcyB3aXRoIGEgVHlwZS1DIHBvcnQuCgpTaWduZWQtb2ZmLWJ5 OiBIYW5zIGRlIEdvZWRlIDxoZGVnb2VkZUByZWRoYXQuY29tPgpSZXZpZXdlZC1ieTogQW5keSBT aGV2Y2hlbmtvIDxhbmR5LnNoZXZjaGVua29AZ21haWwuY29tPgpTaWduZWQtb2ZmLWJ5OiBIZWlr a2kgS3JvZ2VydXMgPGhlaWtraS5rcm9nZXJ1c0BsaW51eC5pbnRlbC5jb20+Ci0tLQpDaGFuZ2Vz IGluIHY3OgotIFJlbW92ZSB1bm5lZWRlZCBzZW1pY29sb24KCkNoYW5nZXMgaW4gdjQ6Ci1BZGQg QW5keSdzIFJldmlld2VkLWJ5CgpDaGFuZ2VzIGluIHYyOgotQ2xlYW51cCBwaTN1c2IzMDUzMl9z ZXRfY29uZigpIGVycm9yIGhhbmRsaW5nCi1BZGQgSGVpa2tpJ3MgUmV2aWV3ZWQtYnkKCkNoYW5n ZXMgaW4gdjE6Ci1UaGlzIGlzIGEgcmV3cml0ZSBvZiBteSBwcmV2aW91cyBkcml2ZXIgd2hpY2gg d2FzIHVzaW5nIHRoZQogZHJpdmVycy9tdXggZnJhbWV3b3JrIHRvIHVzZSB0aGUgbmV3IGRyaXZl cnMvdXNiL3R5cGVjL211eCBmcmFtZXdvcmsKLS0tCiBNQUlOVEFJTkVSUyAgICAgICAgICAgICAg ICAgICAgICAgICB8ICAgNiArKwogZHJpdmVycy91c2IvdHlwZWMvS2NvbmZpZyAgICAgICAgICAg fCAgIDIgKwogZHJpdmVycy91c2IvdHlwZWMvTWFrZWZpbGUgICAgICAgICAgfCAgIDEgKwogZHJp dmVycy91c2IvdHlwZWMvbXV4L0tjb25maWcgICAgICAgfCAgMTAgKysKIGRyaXZlcnMvdXNiL3R5 cGVjL211eC9NYWtlZmlsZSAgICAgIHwgICAzICsKIGRyaXZlcnMvdXNiL3R5cGVjL211eC9waTN1 c2IzMDUzMi5jIHwgMTc4ICsrKysrKysrKysrKysrKysrKysrKysrKysrKysrKysrKysrKwogNiBm aWxlcyBjaGFuZ2VkLCAyMDAgaW5zZXJ0aW9ucygrKQogY3JlYXRlIG1vZGUgMTAwNjQ0IGRyaXZl cnMvdXNiL3R5cGVjL211eC9LY29uZmlnCiBjcmVhdGUgbW9kZSAxMDA2NDQgZHJpdmVycy91c2Iv dHlwZWMvbXV4L01ha2VmaWxlCiBjcmVhdGUgbW9kZSAxMDA2NDQgZHJpdmVycy91c2IvdHlwZWMv bXV4L3BpM3VzYjMwNTMyLmMKCmRpZmYgLS1naXQgYS9NQUlOVEFJTkVSUyBiL01BSU5UQUlORVJT CmluZGV4IGU2YzBhM2YxYzczNC4uODgwYjcwOThkYTQyIDEwMDY0NAotLS0gYS9NQUlOVEFJTkVS UworKysgYi9NQUlOVEFJTkVSUwpAQCAtMTQ2MDcsNiArMTQ2MDcsMTIgQEAgRjoJZHJpdmVycy91 c2IvCiBGOglpbmNsdWRlL2xpbnV4L3VzYi5oCiBGOglpbmNsdWRlL2xpbnV4L3VzYi8KIAorVVNC IFRZUEVDIFBJM1VTQjMwNTMyIE1VWCBEUklWRVIKK006CUhhbnMgZGUgR29lZGUgPGhkZWdvZWRl QHJlZGhhdC5jb20+CitMOglsaW51eC11c2JAdmdlci5rZXJuZWwub3JnCitTOglNYWludGFpbmVk CitGOglkcml2ZXJzL3VzYi90eXBlYy9tdXgvcGkzdXNiMzA1MzIuYworCiBVU0IgVFlQRUMgU1VC U1lTVEVNCiBNOglIZWlra2kgS3JvZ2VydXMgPGhlaWtraS5rcm9nZXJ1c0BsaW51eC5pbnRlbC5j b20+CiBMOglsaW51eC11c2JAdmdlci5rZXJuZWwub3JnCmRpZmYgLS1naXQgYS9kcml2ZXJzL3Vz Yi90eXBlYy9LY29uZmlnIGIvZHJpdmVycy91c2IvdHlwZWMvS2NvbmZpZwppbmRleCBhMmEwNjg0 ZTdjODIuLjAzMGY4OGNiMGMzZiAxMDA2NDQKLS0tIGEvZHJpdmVycy91c2IvdHlwZWMvS2NvbmZp ZworKysgYi9kcml2ZXJzL3VzYi90eXBlYy9LY29uZmlnCkBAIC04NSw0ICs4NSw2IEBAIGNvbmZp ZyBUWVBFQ19UUFM2NTk4WAogCSAgSWYgeW91IGNob29zZSB0byBidWlsZCB0aGlzIGRyaXZlciBh cyBhIGR5bmFtaWNhbGx5IGxpbmtlZCBtb2R1bGUsIHRoZQogCSAgbW9kdWxlIHdpbGwgYmUgY2Fs bGVkIHRwczY1OTh4LmtvLgogCitzb3VyY2UgImRyaXZlcnMvdXNiL3R5cGVjL211eC9LY29uZmln IgorCiBlbmRpZiAjIFRZUEVDCmRpZmYgLS1naXQgYS9kcml2ZXJzL3VzYi90eXBlYy9NYWtlZmls ZSBiL2RyaXZlcnMvdXNiL3R5cGVjL01ha2VmaWxlCmluZGV4IDU2YjJlOTUxNmVjMS4uMWY1OTlh NmMzMGNjIDEwMDY0NAotLS0gYS9kcml2ZXJzL3VzYi90eXBlYy9NYWtlZmlsZQorKysgYi9kcml2 ZXJzL3VzYi90eXBlYy9NYWtlZmlsZQpAQCAtNiwzICs2LDQgQEAgb2JqLXkJCQkJKz0gZnVzYjMw Mi8KIG9iai0kKENPTkZJR19UWVBFQ19XQ09WRSkJKz0gdHlwZWNfd2NvdmUubwogb2JqLSQoQ09O RklHX1RZUEVDX1VDU0kpCSs9IHVjc2kvCiBvYmotJChDT05GSUdfVFlQRUNfVFBTNjU5OFgpCSs9 IHRwczY1OTh4Lm8KK29iai0kKENPTkZJR19UWVBFQykJCSs9IG11eC8KZGlmZiAtLWdpdCBhL2Ry aXZlcnMvdXNiL3R5cGVjL211eC9LY29uZmlnIGIvZHJpdmVycy91c2IvdHlwZWMvbXV4L0tjb25m aWcKbmV3IGZpbGUgbW9kZSAxMDA2NDQKaW5kZXggMDAwMDAwMDAwMDAwLi45YTk1NGQyYjhkOGYK LS0tIC9kZXYvbnVsbAorKysgYi9kcml2ZXJzL3VzYi90eXBlYy9tdXgvS2NvbmZpZwpAQCAtMCww ICsxLDEwIEBACittZW51ICJVU0IgVHlwZS1DIE11bHRpcGxleGVyL0RlTXVsdGlwbGV4ZXIgU3dp dGNoIHN1cHBvcnQiCisKK2NvbmZpZyBUWVBFQ19NVVhfUEkzVVNCMzA1MzIKKwl0cmlzdGF0ZSAi UGVyaWNvbSBQSTNVU0IzMDUzMiBUeXBlLUMgY3Jvc3Mgc3dpdGNoIGRyaXZlciIKKwlkZXBlbmRz IG9uIEkyQworCWhlbHAKKwkgIFNheSBZIG9yIE0gaWYgeW91ciBzeXN0ZW0gaGFzIGEgUGVyaWNv bSBQSTNVU0IzMDUzMiBUeXBlLUMgY3Jvc3MKKwkgIHN3aXRjaCAvIG11eCBjaGlwIGZvdW5kIG9u IHNvbWUgZGV2aWNlcyB3aXRoIGEgVHlwZS1DIHBvcnQuCisKK2VuZG1lbnUKZGlmZiAtLWdpdCBh L2RyaXZlcnMvdXNiL3R5cGVjL211eC9NYWtlZmlsZSBiL2RyaXZlcnMvdXNiL3R5cGVjL211eC9N YWtlZmlsZQpuZXcgZmlsZSBtb2RlIDEwMDY0NAppbmRleCAwMDAwMDAwMDAwMDAuLjEzMzJlNDY5 YjhhMAotLS0gL2Rldi9udWxsCisrKyBiL2RyaXZlcnMvdXNiL3R5cGVjL211eC9NYWtlZmlsZQpA QCAtMCwwICsxLDMgQEAKKyMgU1BEWC1MaWNlbnNlLUlkZW50aWZpZXI6IEdQTC0yLjAKKworb2Jq LSQoQ09ORklHX1RZUEVDX01VWF9QSTNVU0IzMDUzMikJKz0gcGkzdXNiMzA1MzIubwpkaWZmIC0t Z2l0IGEvZHJpdmVycy91c2IvdHlwZWMvbXV4L3BpM3VzYjMwNTMyLmMgYi9kcml2ZXJzL3VzYi90 eXBlYy9tdXgvcGkzdXNiMzA1MzIuYwpuZXcgZmlsZSBtb2RlIDEwMDY0NAppbmRleCAwMDAwMDAw MDAwMDAuLmIwZTg4ZGI2MGVjZgotLS0gL2Rldi9udWxsCisrKyBiL2RyaXZlcnMvdXNiL3R5cGVj L211eC9waTN1c2IzMDUzMi5jCkBAIC0wLDAgKzEsMTc4IEBACisvLyBTUERYLUxpY2Vuc2UtSWRl bnRpZmllcjogR1BMLTIuMCsKKy8qCisgKiBQZXJpY29tIFBJM1VTQjMwNTMyIFR5cGUtQyBjcm9z cyBzd2l0Y2ggLyBtdXggZHJpdmVyCisgKgorICogQ29weXJpZ2h0IChjKSAyMDE3LTIwMTggSGFu cyBkZSBHb2VkZSA8aGRlZ29lZGVAcmVkaGF0LmNvbT4KKyAqLworCisjaW5jbHVkZSA8bGludXgv aTJjLmg+CisjaW5jbHVkZSA8bGludXgva2VybmVsLmg+CisjaW5jbHVkZSA8bGludXgvbW9kdWxl Lmg+CisjaW5jbHVkZSA8bGludXgvbXV0ZXguaD4KKyNpbmNsdWRlIDxsaW51eC91c2IvdGNwbS5o PgorI2luY2x1ZGUgPGxpbnV4L3VzYi90eXBlY19tdXguaD4KKworI2RlZmluZSBQSTNVU0IzMDUz Ml9DT05GCQkJMHgwMAorCisjZGVmaW5lIFBJM1VTQjMwNTMyX0NPTkZfT1BFTgkJCTB4MDAKKyNk ZWZpbmUgUEkzVVNCMzA1MzJfQ09ORl9TV0FQCQkJMHgwMQorI2RlZmluZSBQSTNVU0IzMDUzMl9D T05GXzRMQU5FX0RQCQkweDAyCisjZGVmaW5lIFBJM1VTQjMwNTMyX0NPTkZfVVNCMwkJCTB4MDQK KyNkZWZpbmUgUEkzVVNCMzA1MzJfQ09ORl9VU0IzX0FORF8yTEFORV9EUAkweDA2CisKK3N0cnVj dCBwaTN1c2IzMDUzMiB7CisJc3RydWN0IGkyY19jbGllbnQgKmNsaWVudDsKKwlzdHJ1Y3QgbXV0 ZXggbG9jazsgLyogcHJvdGVjdHMgdGhlIGNhY2hlZCBjb25mIHJlZ2lzdGVyICovCisJc3RydWN0 IHR5cGVjX3N3aXRjaCBzdzsKKwlzdHJ1Y3QgdHlwZWNfbXV4IG11eDsKKwl1OCBjb25mOworfTsK Kworc3RhdGljIGludCBwaTN1c2IzMDUzMl9zZXRfY29uZihzdHJ1Y3QgcGkzdXNiMzA1MzIgKnBp LCB1OCBuZXdfY29uZikKK3sKKwlpbnQgcmV0ID0gMDsKKworCWlmIChwaS0+Y29uZiA9PSBuZXdf Y29uZikKKwkJcmV0dXJuIDA7CisKKwlyZXQgPSBpMmNfc21idXNfd3JpdGVfYnl0ZV9kYXRhKHBp LT5jbGllbnQsIFBJM1VTQjMwNTMyX0NPTkYsIG5ld19jb25mKTsKKwlpZiAocmV0KSB7CisJCWRl dl9lcnIoJnBpLT5jbGllbnQtPmRldiwgIkVycm9yIHdyaXRpbmcgY29uZjogJWRcbiIsIHJldCk7 CisJCXJldHVybiByZXQ7CisJfQorCisJcGktPmNvbmYgPSBuZXdfY29uZjsKKwlyZXR1cm4gMDsK K30KKworc3RhdGljIGludCBwaTN1c2IzMDUzMl9zd19zZXQoc3RydWN0IHR5cGVjX3N3aXRjaCAq c3csCisJCQkgICAgICBlbnVtIHR5cGVjX29yaWVudGF0aW9uIG9yaWVudGF0aW9uKQoreworCXN0 cnVjdCBwaTN1c2IzMDUzMiAqcGkgPSBjb250YWluZXJfb2Yoc3csIHN0cnVjdCBwaTN1c2IzMDUz Miwgc3cpOworCXU4IG5ld19jb25mOworCWludCByZXQ7CisKKwltdXRleF9sb2NrKCZwaS0+bG9j ayk7CisJbmV3X2NvbmYgPSBwaS0+Y29uZjsKKworCXN3aXRjaCAob3JpZW50YXRpb24pIHsKKwlj YXNlIFRZUEVDX09SSUVOVEFUSU9OX05PTkU6CisJCW5ld19jb25mID0gUEkzVVNCMzA1MzJfQ09O Rl9PUEVOOworCQlicmVhazsKKwljYXNlIFRZUEVDX09SSUVOVEFUSU9OX05PUk1BTDoKKwkJbmV3 X2NvbmYgJj0gflBJM1VTQjMwNTMyX0NPTkZfU1dBUDsKKwkJYnJlYWs7CisJY2FzZSBUWVBFQ19P UklFTlRBVElPTl9SRVZFUlNFOgorCQluZXdfY29uZiB8PSBQSTNVU0IzMDUzMl9DT05GX1NXQVA7 CisJCWJyZWFrOworCX0KKworCXJldCA9IHBpM3VzYjMwNTMyX3NldF9jb25mKHBpLCBuZXdfY29u Zik7CisJbXV0ZXhfdW5sb2NrKCZwaS0+bG9jayk7CisKKwlyZXR1cm4gcmV0OworfQorCitzdGF0 aWMgaW50IHBpM3VzYjMwNTMyX211eF9zZXQoc3RydWN0IHR5cGVjX211eCAqbXV4LCBpbnQgc3Rh dGUpCit7CisJc3RydWN0IHBpM3VzYjMwNTMyICpwaSA9IGNvbnRhaW5lcl9vZihtdXgsIHN0cnVj dCBwaTN1c2IzMDUzMiwgbXV4KTsKKwl1OCBuZXdfY29uZjsKKwlpbnQgcmV0OworCisJbXV0ZXhf bG9jaygmcGktPmxvY2spOworCW5ld19jb25mID0gcGktPmNvbmY7CisKKwlzd2l0Y2ggKHN0YXRl KSB7CisJY2FzZSBUWVBFQ19NVVhfTk9ORToKKwkJbmV3X2NvbmYgPSBQSTNVU0IzMDUzMl9DT05G X09QRU47CisJCWJyZWFrOworCWNhc2UgVFlQRUNfTVVYX1VTQjoKKwkJbmV3X2NvbmYgPSAobmV3 X2NvbmYgJiBQSTNVU0IzMDUzMl9DT05GX1NXQVApIHwKKwkJCSAgIFBJM1VTQjMwNTMyX0NPTkZf VVNCMzsKKwkJYnJlYWs7CisJY2FzZSBUWVBFQ19NVVhfRFA6CisJCW5ld19jb25mID0gKG5ld19j b25mICYgUEkzVVNCMzA1MzJfQ09ORl9TV0FQKSB8CisJCQkgICBQSTNVU0IzMDUzMl9DT05GXzRM QU5FX0RQOworCQlicmVhazsKKwljYXNlIFRZUEVDX01VWF9ET0NLOgorCQluZXdfY29uZiA9IChu ZXdfY29uZiAmIFBJM1VTQjMwNTMyX0NPTkZfU1dBUCkgfAorCQkJICAgUEkzVVNCMzA1MzJfQ09O Rl9VU0IzX0FORF8yTEFORV9EUDsKKwkJYnJlYWs7CisJfQorCisJcmV0ID0gcGkzdXNiMzA1MzJf c2V0X2NvbmYocGksIG5ld19jb25mKTsKKwltdXRleF91bmxvY2soJnBpLT5sb2NrKTsKKworCXJl dHVybiByZXQ7Cit9CisKK3N0YXRpYyBpbnQgcGkzdXNiMzA1MzJfcHJvYmUoc3RydWN0IGkyY19j bGllbnQgKmNsaWVudCkKK3sKKwlzdHJ1Y3QgZGV2aWNlICpkZXYgPSAmY2xpZW50LT5kZXY7CisJ c3RydWN0IHBpM3VzYjMwNTMyICpwaTsKKwlpbnQgcmV0OworCisJcGkgPSBkZXZtX2t6YWxsb2Mo ZGV2LCBzaXplb2YoKnBpKSwgR0ZQX0tFUk5FTCk7CisJaWYgKCFwaSkKKwkJcmV0dXJuIC1FTk9N RU07CisKKwlwaS0+Y2xpZW50ID0gY2xpZW50OworCXBpLT5zdy5kZXYgPSBkZXY7CisJcGktPnN3 LnNldCA9IHBpM3VzYjMwNTMyX3N3X3NldDsKKwlwaS0+bXV4LmRldiA9IGRldjsKKwlwaS0+bXV4 LnNldCA9IHBpM3VzYjMwNTMyX211eF9zZXQ7CisJbXV0ZXhfaW5pdCgmcGktPmxvY2spOworCisJ cmV0ID0gaTJjX3NtYnVzX3JlYWRfYnl0ZV9kYXRhKGNsaWVudCwgUEkzVVNCMzA1MzJfQ09ORik7 CisJaWYgKHJldCA8IDApIHsKKwkJZGV2X2VycihkZXYsICJFcnJvciByZWFkaW5nIGNvbmZpZyBy ZWdpc3RlciAlZFxuIiwgcmV0KTsKKwkJcmV0dXJuIHJldDsKKwl9CisJcGktPmNvbmYgPSByZXQ7 CisKKwlyZXQgPSB0eXBlY19zd2l0Y2hfcmVnaXN0ZXIoJnBpLT5zdyk7CisJaWYgKHJldCkgewor CQlkZXZfZXJyKGRldiwgIkVycm9yIHJlZ2lzdGVyaW5nIHR5cGVjIHN3aXRjaDogJWRcbiIsIHJl dCk7CisJCXJldHVybiByZXQ7CisJfQorCisJcmV0ID0gdHlwZWNfbXV4X3JlZ2lzdGVyKCZwaS0+ bXV4KTsKKwlpZiAocmV0KSB7CisJCXR5cGVjX3N3aXRjaF91bnJlZ2lzdGVyKCZwaS0+c3cpOwor CQlkZXZfZXJyKGRldiwgIkVycm9yIHJlZ2lzdGVyaW5nIHR5cGVjIG11eDogJWRcbiIsIHJldCk7 CisJCXJldHVybiByZXQ7CisJfQorCisJaTJjX3NldF9jbGllbnRkYXRhKGNsaWVudCwgcGkpOwor CXJldHVybiAwOworfQorCitzdGF0aWMgaW50IHBpM3VzYjMwNTMyX3JlbW92ZShzdHJ1Y3QgaTJj X2NsaWVudCAqY2xpZW50KQoreworCXN0cnVjdCBwaTN1c2IzMDUzMiAqcGkgPSBpMmNfZ2V0X2Ns aWVudGRhdGEoY2xpZW50KTsKKworCXR5cGVjX211eF91bnJlZ2lzdGVyKCZwaS0+bXV4KTsKKwl0 eXBlY19zd2l0Y2hfdW5yZWdpc3RlcigmcGktPnN3KTsKKwlyZXR1cm4gMDsKK30KKworc3RhdGlj IGNvbnN0IHN0cnVjdCBpMmNfZGV2aWNlX2lkIHBpM3VzYjMwNTMyX3RhYmxlW10gPSB7CisJeyAi cGkzdXNiMzA1MzIiIH0sCisJeyB9Cit9OworTU9EVUxFX0RFVklDRV9UQUJMRShpMmMsIHBpM3Vz YjMwNTMyX3RhYmxlKTsKKworc3RhdGljIHN0cnVjdCBpMmNfZHJpdmVyIHBpM3VzYjMwNTMyX2Ry aXZlciA9IHsKKwkuZHJpdmVyID0geworCQkubmFtZSA9ICJwaTN1c2IzMDUzMiIsCisJfSwKKwku cHJvYmVfbmV3CT0gcGkzdXNiMzA1MzJfcHJvYmUsCisJLnJlbW92ZQkJPSBwaTN1c2IzMDUzMl9y ZW1vdmUsCisJLmlkX3RhYmxlCT0gcGkzdXNiMzA1MzJfdGFibGUsCit9OworCittb2R1bGVfaTJj X2RyaXZlcihwaTN1c2IzMDUzMl9kcml2ZXIpOworCitNT0RVTEVfQVVUSE9SKCJIYW5zIGRlIEdv ZWRlIDxoZGVnb2VkZUByZWRoYXQuY29tPiIpOworTU9EVUxFX0RFU0NSSVBUSU9OKCJQZXJpY29t IFBJM1VTQjMwNTMyIFR5cGUtQyBtdXggZHJpdmVyIik7CitNT0RVTEVfTElDRU5TRSgiR1BMIik7 Cg==