From e1caf9d1ba10d67cd3dfd255687d8999b3b15249 Mon Sep 17 00:00:00 2001
From: Zhangqun Ming <north_sea@qq.com>
Date: Tue, 21 Dec 2021 11:49:33 +0000
Subject: [PATCH] WIP: tusb322
---
drivers/extcon/Makefile | 1 +
drivers/extcon/extcon-usbc-tusb322.c | 184 +++++++++++++++++++++++++++
2 files changed, 185 insertions(+)
create mode 100644 drivers/extcon/extcon-usbc-tusb322.c
diff --git a/drivers/extcon/Makefile b/drivers/extcon/Makefile
index 52096fd8a216c..be73d81f1654a 100644
--- a/drivers/extcon/Makefile
+++ b/drivers/extcon/Makefile
@@ -25,3 +25,4 @@ obj-$(CONFIG_EXTCON_RT8973A) += extcon-rt8973a.o
obj-$(CONFIG_EXTCON_SM5502) += extcon-sm5502.o
obj-$(CONFIG_EXTCON_USB_GPIO) += extcon-usb-gpio.o
obj-$(CONFIG_EXTCON_USBC_CROS_EC) += extcon-usbc-cros-ec.o
+obj-m += extcon-usbc-tusb322.o
diff --git a/drivers/extcon/extcon-usbc-tusb322.c b/drivers/extcon/extcon-usbc-tusb322.c
new file mode 100644
index 0000000000000..10cfb95aa495f
--- /dev/null
+++ b/drivers/extcon/extcon-usbc-tusb322.c
@@ -0,0 +1,184 @@
+// SPDX-License-Identifier: GPL-2.0
+/**
+ * drivers/extcon/extcon-tusb322.c - tusb322 extcon driver
+ *
+ * Copyright (C) 2020 National Instruments Corporation
+ * Author: Michael Auchter <michael.auchter@ni.com>
+ */
+
+#include <linux/extcon-provider.h>
+#include <linux/i2c.h>
+#include <linux/init.h>
+#include <linux/interrupt.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/regmap.h>
+
+#define tusb322_REG9 0x9
+#define tusb322_REG9_ATTACHED_STATE_SHIFT 6
+#define tusb322_REG9_ATTACHED_STATE_MASK 0x3
+#define tusb322_REG9_CABLE_DIRECTION BIT(5)
+#define tusb322_REG9_INTERRUPT_STATUS BIT(4)
+#define tusb322_ATTACHED_STATE_NONE 0x0
+#define tusb322_ATTACHED_STATE_DFP 0x1
+#define tusb322_ATTACHED_STATE_UFP 0x2
+#define tusb322_ATTACHED_STATE_ACC 0x3
+
+struct tusb322_priv {
+ struct device *dev;
+ struct regmap *regmap;
+ struct extcon_dev *edev;
+};
+
+static const char * const tusb_attached_states[] = {
+ [tusb322_ATTACHED_STATE_NONE] = "not attached",
+ [tusb322_ATTACHED_STATE_DFP] = "downstream facing port",
+ [tusb322_ATTACHED_STATE_UFP] = "upstream facing port",
+ [tusb322_ATTACHED_STATE_ACC] = "accessory",
+};
+
+static const unsigned int tusb322_extcon_cable[] = {
+ EXTCON_USB,
+ EXTCON_USB_HOST,
+ EXTCON_NONE,
+};
+
+static int tusb322_check_signature(struct tusb322_priv *priv)
+{
+ static const char sig[] = { '\0', 'T', 'U', 'S', 'B', '3', '2', '2' };
+ unsigned val;
+ int i, ret;
+
+ for (i = 0; i < sizeof(sig); i++) {
+ ret = regmap_read(priv->regmap, sizeof(sig) - 1 - i, &val);
+ if (ret < 0)
+ return ret;
+ if (val != sig[i]) {
+ dev_err(priv->dev, "signature mismatch!\n");
+ return -ENODEV;
+ }
+ }
+
+ return 0;
+}
+
+static irqreturn_t tusb322_irq_handler(int irq, void *dev_id)
+{
+ struct tusb322_priv *priv = dev_id;
+ int state, polarity;
+ unsigned reg;
+
+ if (regmap_read(priv->regmap, tusb322_REG9, ®)) {
+ dev_err(priv->dev, "error during i2c read!\n");
+ return IRQ_NONE;
+ }
+
+ if (!(reg & tusb322_REG9_INTERRUPT_STATUS))
+ return IRQ_NONE;
+
+ state = (reg >> tusb322_REG9_ATTACHED_STATE_SHIFT) &
+ tusb322_REG9_ATTACHED_STATE_MASK;
+ polarity = !!(reg & tusb322_REG9_CABLE_DIRECTION);
+
+ dev_dbg(priv->dev, "attached state: %s, polarity: %d\n",
+ tusb_attached_states[state], polarity);
+
+ extcon_set_state(priv->edev, EXTCON_USB,
+ state == tusb322_ATTACHED_STATE_UFP);
+ extcon_set_state(priv->edev, EXTCON_USB_HOST,
+ state == tusb322_ATTACHED_STATE_DFP);
+ extcon_set_property(priv->edev, EXTCON_USB,
+ EXTCON_PROP_USB_TYPEC_POLARITY,
+ (union extcon_property_value)polarity);
+ extcon_set_property(priv->edev, EXTCON_USB_HOST,
+ EXTCON_PROP_USB_TYPEC_POLARITY,
+ (union extcon_property_value)polarity);
+ extcon_sync(priv->edev, EXTCON_USB);
+ extcon_sync(priv->edev, EXTCON_USB_HOST);
+
+ regmap_write(priv->regmap, tusb322_REG9, reg);
+
+ return IRQ_HANDLED;
+}
+
+static const struct regmap_config tusb322_regmap_config = {
+ .reg_bits = 8,
+ .val_bits = 8,
+};
+
+static int tusb322_extcon_probe(struct i2c_client *client,
+ const struct i2c_device_id *id)
+{
+ struct tusb322_priv *priv;
+ int ret;
+
+ priv = devm_kzalloc(&client->dev, sizeof(*priv), GFP_KERNEL);
+ if (!priv)
+ return -ENOMEM;
+ priv->dev = &client->dev;
+
+ priv->regmap = devm_regmap_init_i2c(client, &tusb322_regmap_config);
+ if (IS_ERR(priv->regmap))
+ return PTR_ERR(priv->regmap);
+
+ ret = tusb322_check_signature(priv);
+ if (ret)
+ return ret;
+
+ priv->edev = devm_extcon_dev_allocate(priv->dev, tusb322_extcon_cable);
+ if (IS_ERR(priv->edev)) {
+ dev_err(priv->dev, "failed to allocate extcon device\n");
+ return PTR_ERR(priv->edev);
+ }
+
+ ret = devm_extcon_dev_register(priv->dev, priv->edev);
+ if (ret < 0) {
+ dev_err(priv->dev, "failed to register extcon device\n");
+ return ret;
+ }
+
+ extcon_set_property_capability(priv->edev, EXTCON_USB,
+ EXTCON_PROP_USB_TYPEC_POLARITY);
+ extcon_set_property_capability(priv->edev, EXTCON_USB_HOST,
+ EXTCON_PROP_USB_TYPEC_POLARITY);
+
+ /* update initial state */
+ tusb322_irq_handler(client->irq, priv);
+
+ ret = devm_request_threaded_irq(priv->dev, client->irq, NULL,
+ tusb322_irq_handler,
+ IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
+ client->name, priv);
+
+ return ret;
+}
+
+static const struct of_device_id tusb322_extcon_dt_match[] = {
+ { .compatible = "ti,tusb322", },
+ { }
+};
+MODULE_DEVICE_TABLE(of, tusb322_extcon_dt_match);
+
+static struct i2c_driver tusb322_extcon_driver = {
+ .probe = tusb322_extcon_probe,
+ .driver = {
+ .name = "extcon-tusb322",
+ .of_match_table = tusb322_extcon_dt_match,
+ },
+};
+
+static int __init tusb322_init(void)
+{
+ return i2c_add_driver(&tusb322_extcon_driver);
+}
+subsys_initcall(tusb322_init);
+
+static void __exit tusb322_exit(void)
+{
+ i2c_del_driver(&tusb322_extcon_driver);
+}
+module_exit(tusb322_exit);
+
+MODULE_AUTHOR("Michael Auchter <michael.auchter@ni.com>");
+MODULE_DESCRIPTION("TI tusb322 extcon driver");
+MODULE_LICENSE("GPL v2");
--
GitLab