From: David Cohen <david.a.co...@intel.com>

Add an exntcon driver to for USB OTG ports controlled by 3 GPIOs used on
Intel Baytrail and Cherrytrail tablets.

Signed-off-by: David Cohen <david.a.co...@intel.com>
[hdgo...@redhat.com: Port to current kernel, submit upstream]
Signed-off-by: Hans de Goede <hdego...@redhat.com>
---
 drivers/extcon/Kconfig            |   7 ++
 drivers/extcon/Makefile           |   1 +
 drivers/extcon/extcon-3gpio_otg.c | 201 ++++++++++++++++++++++++++++++++++++++
 3 files changed, 209 insertions(+)
 create mode 100644 drivers/extcon/extcon-3gpio_otg.c

diff --git a/drivers/extcon/Kconfig b/drivers/extcon/Kconfig
index 04788d9..1aaa64f 100644
--- a/drivers/extcon/Kconfig
+++ b/drivers/extcon/Kconfig
@@ -14,6 +14,13 @@ if EXTCON
 
 comment "Extcon Device Drivers"
 
+config EXTCON_3GPIO_OTG
+       tristate "3 GPIO USB OTG extcon driver"
+       depends on GPIOLIB || COMPILE_TEST
+       help
+         Say Y here to enable extcon support for USB OTG ports controlled
+         by 3 GPIOs used on Intel Baytrail and Cherrytrail tablets.
+
 config EXTCON_ADC_JACK
        tristate "ADC Jack extcon support"
        depends on IIO
diff --git a/drivers/extcon/Makefile b/drivers/extcon/Makefile
index 31a0a99..aa646fd 100644
--- a/drivers/extcon/Makefile
+++ b/drivers/extcon/Makefile
@@ -4,6 +4,7 @@
 
 obj-$(CONFIG_EXTCON)           += extcon-core.o
 extcon-core-objs               += extcon.o devres.o
+obj-$(CONFIG_EXTCON_3GPIO_OTG) += extcon-3gpio_otg.o
 obj-$(CONFIG_EXTCON_ADC_JACK)  += extcon-adc-jack.o
 obj-$(CONFIG_EXTCON_ARIZONA)   += extcon-arizona.o
 obj-$(CONFIG_EXTCON_AXP288)    += extcon-axp288.o
diff --git a/drivers/extcon/extcon-3gpio_otg.c 
b/drivers/extcon/extcon-3gpio_otg.c
new file mode 100644
index 0000000..fc8b14d1
--- /dev/null
+++ b/drivers/extcon/extcon-3gpio_otg.c
@@ -0,0 +1,201 @@
+/*
+ * 3 GPIO USB OTG extcon driver
+ *
+ * Copyright (c) 2016) Hans de Goede <hdego...@redhat.com>
+ *
+ * Based on android x86 kernel code which is:
+ *
+ * Copyright (c) 2014, Intel Corporation.
+ * Author: David Cohen <david.a.co...@linux.intel.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include <linux/acpi.h>
+#include <linux/extcon.h>
+#include <linux/gpio.h>
+#include <linux/interrupt.h>
+#include <linux/platform_device.h>
+
+#define DRV_NAME               "usb_otg_port"
+#define USB_OTG_GPIO_USB_ID    0
+#define USB_OTG_GPIO_VBUS_EN   1
+#define USB_OTG_GPIO_USB_MUX   2
+#define DEBOUNCE_TIME          msecs_to_jiffies(50)
+
+struct usb_otg {
+       struct device *dev;
+       struct extcon_dev *edev;
+       struct delayed_work work;
+       struct gpio_desc *gpio_usb_id;
+       struct gpio_desc *gpio_vbus_en;
+       struct gpio_desc *gpio_usb_mux;
+       int usb_id_irq;
+};
+
+static const unsigned int usb_otg_cable[] = {
+       EXTCON_USB_HOST,
+       EXTCON_NONE,
+};
+
+/*
+ * If id == 1, USB port should be set to peripheral
+ * if id == 0, USB port should be set to host
+ *
+ * Peripheral: set USB mux to peripheral and disable VBUS
+ * Host: set USB mux to host and enable VBUS
+ */
+static void usb_otg_set_port(struct usb_otg *otg, int id)
+{
+       int mux_val = id;
+       int vbus_val = !id;
+
+       if (!IS_ERR(otg->gpio_usb_mux))
+               gpiod_direction_output(otg->gpio_usb_mux, mux_val);
+
+       if (!IS_ERR(otg->gpio_vbus_en))
+               gpiod_direction_output(otg->gpio_vbus_en, vbus_val);
+}
+
+static void usb_otg_do_usb_id(struct work_struct *work)
+{
+       struct usb_otg *otg =
+               container_of(work, struct usb_otg, work.work);
+       int id = gpiod_get_value_cansleep(otg->gpio_usb_id);
+
+       dev_info(otg->dev, "USB PORT ID: %s\n", id ? "PERIPHERAL" : "HOST");
+
+       /*
+        * id == 1: PERIPHERAL
+        * id == 0: HOST
+        */
+       usb_otg_set_port(otg, id);
+
+       /*
+        * id == 0: HOST connected
+        * id == 1: Host disconnected
+        */
+       extcon_set_state_sync(otg->edev, EXTCON_USB_HOST, !id);
+}
+
+static irqreturn_t usb_otg_thread_isr(int irq, void *priv)
+{
+       struct usb_otg *otg = priv;
+
+       /* id changed, let the pin settle and then process it */
+       mod_delayed_work(system_wq, &otg->work, DEBOUNCE_TIME);
+
+       return IRQ_HANDLED;
+}
+
+static int usb_otg_probe(struct platform_device *pdev)
+{
+       struct device *dev = &pdev->dev;
+       struct usb_otg *otg;
+       int ret;
+
+       otg = devm_kzalloc(dev, sizeof(*otg), GFP_KERNEL);
+       if (!otg)
+               return -ENOMEM;
+
+       otg->dev = dev;
+       INIT_DELAYED_WORK(&otg->work, usb_otg_do_usb_id);
+
+       otg->gpio_usb_id = devm_gpiod_get_index(dev, "id",
+                                               USB_OTG_GPIO_USB_ID,
+                                               GPIOD_IN);
+       if (IS_ERR(otg->gpio_usb_id)) {
+               dev_err(dev, "can't request USB ID GPIO: ret = %ld\n",
+                       PTR_ERR(otg->gpio_usb_id));
+               return PTR_ERR(otg->gpio_usb_id);
+       }
+
+       otg->usb_id_irq = gpiod_to_irq(otg->gpio_usb_id);
+       if (otg->usb_id_irq <= 0) {
+               dev_err(dev, "invalid USB ID IRQ: %d\n", otg->usb_id_irq);
+               return -EINVAL;
+       }
+
+       otg->gpio_vbus_en = devm_gpiod_get_index(dev, "vbus en",
+                                                USB_OTG_GPIO_VBUS_EN,
+                                                GPIOD_ASIS);
+       if (IS_ERR(otg->gpio_vbus_en))
+               dev_info(dev, "can't request VBUS EN GPIO, skipping it.\n");
+
+       otg->gpio_usb_mux = devm_gpiod_get_index(dev, "usb mux",
+                                                USB_OTG_GPIO_USB_MUX,
+                                                GPIOD_ASIS);
+       if (IS_ERR(otg->gpio_usb_mux))
+               dev_info(dev, "can't request USB MUX, skipping it.\n");
+
+       /* register extcon device */
+       otg->edev = devm_extcon_dev_allocate(dev, usb_otg_cable);
+       if (IS_ERR(otg->edev)) {
+               dev_err(dev, "failed to allocate extcon device\n");
+               return -ENOMEM;
+       }
+
+       ret = devm_extcon_dev_register(dev, otg->edev);
+       if (ret < 0) {
+               dev_err(dev, "failed to register extcon device: %d\n",
+                       ret);
+               return ret;
+       }
+
+       ret = devm_request_threaded_irq(dev, otg->usb_id_irq,
+                                       NULL, usb_otg_thread_isr,
+                                       IRQF_SHARED | IRQF_ONESHOT |
+                                       IRQF_TRIGGER_RISING |
+                                       IRQF_TRIGGER_FALLING,
+                                       dev_name(dev), otg);
+       if (ret < 0) {
+               dev_err(dev, "can't request IRQ for USB ID GPIO: %d\n", ret);
+               return ret;
+       }
+
+       /* queue initial processing of id-pin */
+       queue_delayed_work(system_wq, &otg->work, 0);
+
+       platform_set_drvdata(pdev, otg);
+
+       return 0;
+}
+
+static int usb_otg_remove(struct platform_device *pdev)
+{
+       struct usb_otg *otg = platform_get_drvdata(pdev);
+
+       devm_free_irq(&pdev->dev, otg->usb_id_irq, otg);
+       cancel_delayed_work_sync(&otg->work);
+
+       return 0;
+}
+
+static struct acpi_device_id usb_otg_acpi_match[] = {
+       { "INT3496" },
+       { }
+};
+MODULE_DEVICE_TABLE(acpi, usb_otg_acpi_match);
+
+static struct platform_driver usb_otg_driver = {
+       .driver = {
+               .name = DRV_NAME,
+               .owner = THIS_MODULE,
+               .acpi_match_table = ACPI_PTR(usb_otg_acpi_match),
+       },
+       .probe = usb_otg_probe,
+       .remove = usb_otg_remove,
+};
+
+module_platform_driver(usb_otg_driver);
+
+MODULE_AUTHOR("Hans de Goede <hdego...@redhat.com>");
+MODULE_DESCRIPTION("3 GPIO USB OTG extcon driver");
+MODULE_LICENSE("GPL");
-- 
2.9.3

Reply via email to