usb: typec: add driver for MT6392 PMIC

Signed-off-by: Fabien Parent <fparent@baylibre.com>
diff --git a/drivers/usb/typec/Kconfig b/drivers/usb/typec/Kconfig
index 8445890..a9ae780 100644
--- a/drivers/usb/typec/Kconfig
+++ b/drivers/usb/typec/Kconfig
@@ -103,6 +103,13 @@
 	  If you choose to build this driver as a dynamically linked module, the
 	  module will be called tps6598x.ko.
 
+config TYPEC_MT6392
+	tristate "MediaTek MT6392 PMIC based Type-C controller driver"
+	depends on MFD_MT6397 || COMPILE_TEST
+	depends on USB_ROLE_SWITCH
+	help
+	  Say Y or M here if your system has a MediaTek MT6392 controller driver.
+
 source "drivers/usb/typec/mux/Kconfig"
 
 source "drivers/usb/typec/altmodes/Kconfig"
diff --git a/drivers/usb/typec/Makefile b/drivers/usb/typec/Makefile
index 45b0aef..1bc86ca 100644
--- a/drivers/usb/typec/Makefile
+++ b/drivers/usb/typec/Makefile
@@ -6,6 +6,7 @@
 obj-y				+= fusb302/
 obj-$(CONFIG_TYPEC_WCOVE)	+= typec_wcove.o
 obj-$(CONFIG_TYPEC_UCSI)	+= ucsi/
+obj-$(CONFIG_TYPEC_MT6392)	+= mt6392.o
 obj-$(CONFIG_TYPEC_TPS6598X)	+= tps6598x.o
 obj-$(CONFIG_TYPEC)		+= mux/
 obj-$(CONFIG_TYPEC_TCPCI)	+= tcpci.o
diff --git a/drivers/usb/typec/mt6392.c b/drivers/usb/typec/mt6392.c
new file mode 100644
index 0000000..a8fa592
--- /dev/null
+++ b/drivers/usb/typec/mt6392.c
@@ -0,0 +1,220 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (C) 2020 BayLibre, SAS.
+ * Author: Fabien Parent <fparent@baylibre.com>
+ */
+
+#include <linux/interrupt.h>
+#include <linux/mfd/mt6397/core.h>
+#include <linux/module.h>
+#include <linux/of.h>
+#include <linux/platform_device.h>
+#include <linux/regmap.h>
+#include <linux/usb/usb_phy_generic.h>
+#include <linux/usb/role.h>
+#include <linux/usb/typec.h>
+
+#define TYPEC_CTRL		0x06
+#define     PORT_SUPPORT_ROLE_SINK	0
+#define     PORT_SUPPORT_ROLE_SOURCE	1
+#define     PORT_SUPPORT_ROLE_DRP	2
+#define     PORT_SUPPORT_ROLE_MASK	3
+#define TYPEC_CC_SW_CTRL	0x0a
+#define     STATE_ENTER_DISABLED	BIT(0)
+#define     STATE_ENTER_UNATTACHED_SRC	BIT(1)
+#define     STATE_ENTER_UNATTACHED_SINK	BIT(2)
+#define TYPEC_INTR_EN_0		0x30
+#define TYPEC_INTR_EN_2		0x34
+#define TYPEC_INTR_0		0x38
+#define     INTR_ENTER_ATTACHED_SRC	BIT(0)
+#define     INTR_ENTER_ATTACHED_SINK	BIT(1)
+#define     INTR_ENTER_UNATTACHED_SRC	BIT(4)
+#define     INTR_ENTER_ATTACH_WAIT_SINK	BIT(7)
+#define TYPEC_INTR_2		0x3c
+#define TYPEC_CC_STATUS		0x40
+#define TYPEC_PWR_STATUS	0x42
+
+struct mt6392_typec {
+	struct device			*dev;
+	struct regmap			*regmap;
+	struct usb_role_switch		*role_sw;
+	struct typec_port		*port;
+	struct typec_capability		cap;
+	u32				base_addr;
+	int				irq;
+};
+
+static int typec_write(struct mt6392_typec *typec, u32 reg, u16 val)
+{
+	return regmap_write(typec->regmap, typec->base_addr + reg, val);
+}
+
+static u16 typec_read(struct mt6392_typec *typec, u32 reg)
+{
+	unsigned int val;
+
+	regmap_read(typec->regmap, typec->base_addr + reg, &val);
+
+	return val;
+}
+
+static irqreturn_t mtk_typec_irq_handler_thread(int irq, void *data)
+{
+	uint16_t intr0;
+	struct mt6392_typec *typec = data;
+
+	intr0 = typec_read(typec, TYPEC_INTR_0);
+	typec_write(typec, TYPEC_INTR_0, intr0);
+
+	if (!intr0)
+		return IRQ_NONE;
+
+	if (intr0 & INTR_ENTER_ATTACHED_SRC) {
+		usb_role_switch_set_role(typec->role_sw, USB_ROLE_HOST);
+		typec_set_data_role(typec->port, TYPEC_HOST);
+	} else if (intr0 & INTR_ENTER_ATTACH_WAIT_SINK) {
+		usb_role_switch_set_role(typec->role_sw, USB_ROLE_DEVICE);
+		typec_set_data_role(typec->port, TYPEC_DEVICE);
+	} else if (intr0 & INTR_ENTER_UNATTACHED_SRC) {
+		usb_role_switch_set_role(typec->role_sw, USB_ROLE_NONE);
+	} else {
+		dev_err(typec->dev, "unexpected IRQ: %d\n", intr0);
+		return IRQ_NONE;
+	}
+
+	return IRQ_HANDLED;
+}
+
+static void mt6392_enable_irq(struct mt6392_typec *typec)
+{
+	regmap_write(typec->regmap, typec->base_addr + TYPEC_INTR_EN_0,
+		INTR_ENTER_ATTACHED_SRC | INTR_ENTER_UNATTACHED_SRC |
+		INTR_ENTER_ATTACH_WAIT_SINK);
+}
+
+static void mt6392_disable_irq(struct mt6392_typec *typec)
+{
+	regmap_write(typec->regmap, typec->base_addr + TYPEC_INTR_EN_0, 0);
+	regmap_write(typec->regmap, typec->base_addr + TYPEC_INTR_EN_2, 0);
+}
+
+static int mt6392_typec_probe(struct platform_device *pdev)
+{
+	struct resource *res;
+	struct mt6397_chip *mt6397_chip = dev_get_drvdata(pdev->dev.parent);
+	struct mt6392_typec *typec;
+	int ret;
+
+	typec = devm_kzalloc(&pdev->dev, sizeof(*typec), GFP_KERNEL);
+	if (!typec)
+		return -ENOMEM;
+
+	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+	typec->base_addr = res->start;
+
+	typec->irq = platform_get_irq(pdev, 0);
+	if (typec->irq < 0)
+		return typec->irq;
+
+	typec->regmap = mt6397_chip->regmap;
+	typec->dev = &pdev->dev;
+
+	platform_set_drvdata(pdev, typec);
+
+	typec->role_sw = usb_role_switch_get(&pdev->dev);
+	if (IS_ERR(typec->role_sw))
+		return PTR_ERR(typec->role_sw);
+
+	typec->cap.prefer_role = TYPEC_NO_PREFERRED_ROLE;
+	typec->cap.type = TYPEC_PORT_DRP;
+	typec->cap.data = TYPEC_PORT_DRD;
+	typec->cap.revision = USB_TYPEC_REV_1_1;
+
+	typec->port = typec_register_port(typec->dev, &typec->cap);
+	if (IS_ERR(typec->port)) {
+		ret = PTR_ERR(typec->port);
+		goto out_role_switch_put;
+	}
+
+	mt6392_disable_irq(typec);
+
+	regmap_update_bits(typec->regmap, typec->base_addr + TYPEC_CTRL,
+		PORT_SUPPORT_ROLE_MASK, PORT_SUPPORT_ROLE_DRP);
+	regmap_update_bits(typec->regmap, typec->base_addr + TYPEC_CC_SW_CTRL,
+		STATE_ENTER_UNATTACHED_SRC, STATE_ENTER_UNATTACHED_SRC);
+
+	ret = devm_request_threaded_irq(typec->dev, typec->irq, NULL,
+				   mtk_typec_irq_handler_thread,
+				   IRQF_ONESHOT | IRQF_TRIGGER_LOW,
+				   "mt6392-typec", typec);
+	if (ret) {
+		dev_err(&pdev->dev, "Failed to request IRQ%d: %d\n",
+			typec->irq, ret);
+		goto out_typec_unregister_port;
+	}
+
+	mt6392_enable_irq(typec);
+
+	return 0;
+
+out_typec_unregister_port:
+	typec_unregister_port(typec->port);
+out_role_switch_put:
+	usb_role_switch_put(typec->role_sw);
+
+	return ret;
+}
+
+static int mt6392_typec_remove(struct platform_device *pdev)
+{
+	struct mt6392_typec *typec = platform_get_drvdata(pdev);
+
+	disable_irq(typec->irq);
+	typec_unregister_port(typec->port);
+	usb_role_switch_put(typec->role_sw);
+
+	return 0;
+}
+
+static int __maybe_unused mt6392_typec_suspend(struct device *dev)
+{
+	struct mt6392_typec *typec = dev_get_drvdata(dev);
+
+	disable_irq(typec->irq);
+
+	return 0;
+}
+
+static int __maybe_unused mt6392_typec_resume(struct device *dev)
+{
+	struct mt6392_typec *typec = dev_get_drvdata(dev);
+
+	enable_irq(typec->irq);
+
+	return 0;
+}
+
+static SIMPLE_DEV_PM_OPS(mt6392_typec_pm_ops, mt6392_typec_suspend,
+			mt6392_typec_resume);
+
+static const struct of_device_id mt6392_typec_of_match[] = {
+	{ .compatible = "mediatek,mt6392-typec" },
+	{ /* sentinel */ }
+};
+MODULE_DEVICE_TABLE(of, mt6392_typec_of_match);
+
+static struct platform_driver mt6392_typec_driver = {
+	.probe = mt6392_typec_probe,
+	.remove = mt6392_typec_remove,
+	.driver = {
+		.name  = "mt6392-typec",
+		.of_match_table = of_match_ptr(mt6392_typec_of_match),
+		.pm = &mt6392_typec_pm_ops,
+	},
+};
+
+module_platform_driver(mt6392_typec_driver);
+
+MODULE_LICENSE("GPL v2");
+MODULE_AUTHOR("Fabien Parent <fparent@baylibre.com>");
+MODULE_DESCRIPTION("MediaTek MT6392 Type-C Controller Driver");