Move TCPCI(Typec port controller interface) driver out of staging.

Signed-off-by: Li Jun <[email protected]>
---
 drivers/staging/Kconfig        |   2 -
 drivers/staging/Makefile       |   1 -
 drivers/staging/typec/Kconfig  |  14 -
 drivers/staging/typec/Makefile |   1 -
 drivers/staging/typec/TODO     |   5 -
 drivers/staging/typec/tcpci.c  | 637 -----------------------------------------
 drivers/staging/typec/tcpci.h  | 133 ---------
 drivers/usb/typec/Kconfig      |   7 +
 drivers/usb/typec/Makefile     |   1 +
 drivers/usb/typec/tcpci.c      | 637 +++++++++++++++++++++++++++++++++++++++++
 drivers/usb/typec/tcpci.h      | 133 +++++++++
 11 files changed, 778 insertions(+), 793 deletions(-)

diff --git a/drivers/staging/Kconfig b/drivers/staging/Kconfig
index 5546839..1e3d5d0 100644
--- a/drivers/staging/Kconfig
+++ b/drivers/staging/Kconfig
@@ -112,8 +112,6 @@ source "drivers/staging/vc04_services/Kconfig"
 
 source "drivers/staging/ccree/Kconfig"
 
-source "drivers/staging/typec/Kconfig"
-
 source "drivers/staging/vboxvideo/Kconfig"
 
 source "drivers/staging/pi433/Kconfig"
diff --git a/drivers/staging/Makefile b/drivers/staging/Makefile
index 8951c37..4d1ccb4 100644
--- a/drivers/staging/Makefile
+++ b/drivers/staging/Makefile
@@ -1,7 +1,6 @@
 # Makefile for staging directory
 
 obj-y                          += media/
-obj-y                          += typec/
 obj-$(CONFIG_IRDA)             += irda/net/
 obj-$(CONFIG_IRDA)             += irda/drivers/
 obj-$(CONFIG_PRISM2_USB)       += wlan-ng/
diff --git a/drivers/staging/typec/Kconfig b/drivers/staging/typec/Kconfig
deleted file mode 100644
index 5359f55..0000000
--- a/drivers/staging/typec/Kconfig
+++ /dev/null
@@ -1,14 +0,0 @@
-menu "USB Power Delivery and Type-C drivers"
-
-if TYPEC_TCPM
-
-config TYPEC_TCPCI
-       tristate "Type-C Port Controller Interface driver"
-       depends on I2C
-       select REGMAP_I2C
-       help
-         Type-C Port Controller driver for TCPCI-compliant controller.
-
-endif
-
-endmenu
diff --git a/drivers/staging/typec/Makefile b/drivers/staging/typec/Makefile
deleted file mode 100644
index 53d649a..0000000
--- a/drivers/staging/typec/Makefile
+++ /dev/null
@@ -1 +0,0 @@
-obj-$(CONFIG_TYPEC_TCPCI)      += tcpci.o
diff --git a/drivers/staging/typec/TODO b/drivers/staging/typec/TODO
deleted file mode 100644
index 53fe2f7..0000000
--- a/drivers/staging/typec/TODO
+++ /dev/null
@@ -1,5 +0,0 @@
-tcpci:
-- Test with real hardware
-
-Please send patches to Guenter Roeck <[email protected]> and copy
-Heikki Krogerus <[email protected]>.
diff --git a/drivers/staging/typec/tcpci.c b/drivers/staging/typec/tcpci.c
deleted file mode 100644
index 293a07c..0000000
--- a/drivers/staging/typec/tcpci.c
+++ /dev/null
@@ -1,637 +0,0 @@
-/*
- * Copyright 2015-2017 Google, Inc
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * 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.
- *
- * USB Type-C Port Controller Interface.
- */
-
-#include <linux/delay.h>
-#include <linux/kernel.h>
-#include <linux/module.h>
-#include <linux/i2c.h>
-#include <linux/interrupt.h>
-#include <linux/regmap.h>
-#include <linux/usb/pd.h>
-#include <linux/usb/tcpm.h>
-#include <linux/usb/typec.h>
-
-#include "tcpci.h"
-
-#define PD_RETRY_COUNT 3
-
-struct tcpci {
-       struct device *dev;
-       struct i2c_client *client;
-
-       struct tcpm_port *port;
-
-       struct regmap *regmap;
-
-       bool controls_vbus;
-
-       struct tcpc_dev tcpc;
-};
-
-static inline struct tcpci *tcpc_to_tcpci(struct tcpc_dev *tcpc)
-{
-       return container_of(tcpc, struct tcpci, tcpc);
-}
-
-static int tcpci_read16(struct tcpci *tcpci, unsigned int reg,
-                       unsigned int *val)
-{
-       return regmap_raw_read(tcpci->regmap, reg, val, sizeof(u16));
-}
-
-static int tcpci_write16(struct tcpci *tcpci, unsigned int reg, u16 val)
-{
-       return regmap_raw_write(tcpci->regmap, reg, &val, sizeof(u16));
-}
-
-static int tcpci_set_cc(struct tcpc_dev *tcpc, enum typec_cc_status cc,
-                       bool attached, enum typec_cc_polarity polarity)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-       unsigned int reg = 0, reg_cc1 = 0, reg_cc2 = 0;
-       int ret;
-
-       switch (cc) {
-       case TYPEC_CC_RA:
-               reg = (TCPC_ROLE_CTRL_CC_RA << TCPC_ROLE_CTRL_CC1_SHIFT) |
-                       (TCPC_ROLE_CTRL_CC_RA << TCPC_ROLE_CTRL_CC2_SHIFT);
-               break;
-       case TYPEC_CC_RD:
-               reg_cc1 = TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC1_SHIFT;
-               reg_cc2 = TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC2_SHIFT;
-               break;
-       case TYPEC_CC_RP_DEF:
-               reg_cc1 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT;
-               reg_cc2 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT;
-               reg = TCPC_ROLE_CTRL_RP_VAL_DEF << TCPC_ROLE_CTRL_RP_VAL_SHIFT;
-               break;
-       case TYPEC_CC_RP_1_5:
-               reg_cc1 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT;
-               reg_cc2 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT;
-               reg = TCPC_ROLE_CTRL_RP_VAL_1_5 << TCPC_ROLE_CTRL_RP_VAL_SHIFT;
-               break;
-       case TYPEC_CC_RP_3_0:
-               reg_cc1 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT;
-               reg_cc2 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT;
-               reg = TCPC_ROLE_CTRL_RP_VAL_3_0 << TCPC_ROLE_CTRL_RP_VAL_SHIFT;
-               break;
-       case TYPEC_CC_OPEN:
-       default:
-               reg = (TCPC_ROLE_CTRL_CC_OPEN << TCPC_ROLE_CTRL_CC1_SHIFT) |
-                       (TCPC_ROLE_CTRL_CC_OPEN << TCPC_ROLE_CTRL_CC2_SHIFT);
-               break;
-       }
-
-       if (!attached)
-               reg |= reg_cc1 | reg_cc2;
-       else if (polarity == TYPEC_POLARITY_CC1)
-               reg |= reg_cc1;
-       else
-               reg |= reg_cc2;
-
-       ret = regmap_write(tcpci->regmap, TCPC_ROLE_CTRL, reg);
-       if (ret < 0)
-               return ret;
-
-       return 0;
-}
-
-static int tcpci_start_drp_toggling(struct tcpc_dev *tcpc,
-                                   enum typec_cc_status cc)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-       unsigned int reg = TCPC_ROLE_CTRL_DRP;
-       int ret;
-
-       switch (cc) {
-       default:
-       case TYPEC_CC_RP_DEF:
-               reg |= (TCPC_ROLE_CTRL_RP_VAL_DEF <<
-                       TCPC_ROLE_CTRL_RP_VAL_SHIFT);
-               break;
-       case TYPEC_CC_RP_1_5:
-               reg |= (TCPC_ROLE_CTRL_RP_VAL_1_5 <<
-                       TCPC_ROLE_CTRL_RP_VAL_SHIFT);
-               break;
-       case TYPEC_CC_RP_3_0:
-               reg |= (TCPC_ROLE_CTRL_RP_VAL_3_0 <<
-                       TCPC_ROLE_CTRL_RP_VAL_SHIFT);
-               break;
-       }
-
-       if (cc == TYPEC_CC_RD)
-               reg |= (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC1_SHIFT) |
-                       (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC2_SHIFT);
-       else
-               reg |= (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT) |
-                       (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT);
-
-       ret = regmap_write(tcpci->regmap, TCPC_ROLE_CTRL, reg);
-       if (ret < 0)
-               return ret;
-
-       return regmap_write(tcpci->regmap, TCPC_COMMAND,
-                               TCPC_CMD_LOOK4CONNECTION);
-}
-
-static enum typec_cc_status tcpci_to_typec_cc(unsigned int cc, bool sink)
-{
-       switch (cc) {
-       case 0x1:
-               return sink ? TYPEC_CC_RP_DEF : TYPEC_CC_RA;
-       case 0x2:
-               return sink ? TYPEC_CC_RP_1_5 : TYPEC_CC_RD;
-       case 0x3:
-               if (sink)
-                       return TYPEC_CC_RP_3_0;
-       case 0x0:
-       default:
-               return TYPEC_CC_OPEN;
-       }
-}
-
-static int tcpci_get_cc(struct tcpc_dev *tcpc,
-                       enum typec_cc_status *cc1, enum typec_cc_status *cc2)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-       unsigned int reg;
-       int ret;
-
-       ret = regmap_read(tcpci->regmap, TCPC_CC_STATUS, &reg);
-       if (ret < 0)
-               return ret;
-
-       *cc1 = tcpci_to_typec_cc((reg >> TCPC_CC_STATUS_CC1_SHIFT) &
-                                TCPC_CC_STATUS_CC1_MASK,
-                                reg & TCPC_CC_STATUS_TERM);
-       *cc2 = tcpci_to_typec_cc((reg >> TCPC_CC_STATUS_CC2_SHIFT) &
-                                TCPC_CC_STATUS_CC2_MASK,
-                                reg & TCPC_CC_STATUS_TERM);
-
-       return 0;
-}
-
-static int tcpci_set_polarity(struct tcpc_dev *tcpc,
-                             enum typec_cc_polarity polarity)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-       int ret;
-
-       ret = regmap_write(tcpci->regmap, TCPC_TCPC_CTRL,
-                          (polarity == TYPEC_POLARITY_CC2) ?
-                          TCPC_TCPC_CTRL_ORIENTATION : 0);
-       if (ret < 0)
-               return ret;
-
-       return 0;
-}
-
-static int tcpci_set_vconn(struct tcpc_dev *tcpc, bool enable)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-
-       return regmap_update_bits(tcpci->regmap, TCPC_POWER_CTRL,
-                               TCPC_POWER_CTRL_VCONN_ENABLE,
-                               enable ? TCPC_POWER_CTRL_VCONN_ENABLE : 0);
-}
-
-static int tcpci_set_roles(struct tcpc_dev *tcpc, bool attached,
-                          enum typec_role role, enum typec_data_role data)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-       unsigned int reg;
-       int ret;
-
-       reg = PD_REV20 << TCPC_MSG_HDR_INFO_REV_SHIFT;
-       if (role == TYPEC_SOURCE)
-               reg |= TCPC_MSG_HDR_INFO_PWR_ROLE;
-       if (data == TYPEC_HOST)
-               reg |= TCPC_MSG_HDR_INFO_DATA_ROLE;
-       ret = regmap_write(tcpci->regmap, TCPC_MSG_HDR_INFO, reg);
-       if (ret < 0)
-               return ret;
-
-       return 0;
-}
-
-static int tcpci_set_pd_rx(struct tcpc_dev *tcpc, bool enable)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-       unsigned int reg = 0;
-       int ret;
-
-       if (enable)
-               reg = TCPC_RX_DETECT_SOP | TCPC_RX_DETECT_HARD_RESET;
-       ret = regmap_write(tcpci->regmap, TCPC_RX_DETECT, reg);
-       if (ret < 0)
-               return ret;
-
-       return 0;
-}
-
-static int tcpci_get_vbus(struct tcpc_dev *tcpc)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-       unsigned int reg;
-       int ret;
-
-       ret = regmap_read(tcpci->regmap, TCPC_POWER_STATUS, &reg);
-       if (ret < 0)
-               return ret;
-
-       return !!(reg & TCPC_POWER_STATUS_VBUS_PRES);
-}
-
-static int tcpci_set_vbus(struct tcpc_dev *tcpc, bool source, bool sink)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-       int ret;
-
-       /* Disable both source and sink first before enabling anything */
-
-       if (!source) {
-               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
-                                  TCPC_CMD_DISABLE_SRC_VBUS);
-               if (ret < 0)
-                       return ret;
-       }
-
-       if (!sink) {
-               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
-                                  TCPC_CMD_DISABLE_SINK_VBUS);
-               if (ret < 0)
-                       return ret;
-       }
-
-       if (source) {
-               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
-                                  TCPC_CMD_SRC_VBUS_DEFAULT);
-               if (ret < 0)
-                       return ret;
-       }
-
-       if (sink) {
-               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
-                                  TCPC_CMD_SINK_VBUS);
-               if (ret < 0)
-                       return ret;
-       }
-
-       return 0;
-}
-
-static int tcpci_pd_transmit(struct tcpc_dev *tcpc,
-                            enum tcpm_transmit_type type,
-                            const struct pd_message *msg)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-       unsigned int reg, cnt, header;
-       int ret;
-
-       cnt = msg ? pd_header_cnt(msg->header) * 4 : 0;
-       ret = regmap_write(tcpci->regmap, TCPC_TX_BYTE_CNT, cnt + 2);
-       if (ret < 0)
-               return ret;
-
-       header = msg ? msg->header : 0;
-       ret = tcpci_write16(tcpci, TCPC_TX_HDR, header);
-       if (ret < 0)
-               return ret;
-
-       if (cnt > 0) {
-               ret = regmap_raw_write(tcpci->regmap, TCPC_TX_DATA,
-                                      &msg->payload, cnt);
-               if (ret < 0)
-                       return ret;
-       }
-
-       reg = (PD_RETRY_COUNT << TCPC_TRANSMIT_RETRY_SHIFT) |
-               (type << TCPC_TRANSMIT_TYPE_SHIFT);
-       ret = regmap_write(tcpci->regmap, TCPC_TRANSMIT, reg);
-       if (ret < 0)
-               return ret;
-
-       return 0;
-}
-
-static int tcpci_vbus_detect(struct tcpc_dev *tcpc, bool enable)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-       int ret;
-
-       if (enable) {
-               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
-                                  TCPC_CMD_ENABLE_VBUS_DETECT);
-               if (ret < 0)
-                       return ret;
-       } else {
-               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
-                                  TCPC_CMD_DISABLE_VBUS_DETECT);
-               if (ret < 0)
-                       return ret;
-       }
-
-       return 0;
-}
-
-static int tcpci_init(struct tcpc_dev *tcpc)
-{
-       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
-       unsigned long timeout = jiffies + msecs_to_jiffies(2000); /* XXX */
-       unsigned int reg;
-       int ret;
-
-       while (time_before_eq(jiffies, timeout)) {
-               ret = regmap_read(tcpci->regmap, TCPC_POWER_STATUS, &reg);
-               if (ret < 0)
-                       return ret;
-               if (!(reg & TCPC_POWER_STATUS_UNINIT))
-                       break;
-               usleep_range(10000, 20000);
-       }
-       if (time_after(jiffies, timeout))
-               return -ETIMEDOUT;
-
-       /* Clear all events */
-       ret = tcpci_write16(tcpci, TCPC_ALERT, 0xffff);
-       if (ret < 0)
-               return ret;
-
-       if (tcpci->controls_vbus)
-               reg = TCPC_POWER_STATUS_VBUS_PRES;
-       else
-               reg = 0;
-       ret = regmap_write(tcpci->regmap, TCPC_POWER_STATUS_MASK, reg);
-       if (ret < 0)
-               return ret;
-
-       /* Enable Vbus detection */
-       tcpci_vbus_detect(tcpc, true);
-
-       reg = TCPC_ALERT_TX_SUCCESS | TCPC_ALERT_TX_FAILED |
-               TCPC_ALERT_TX_DISCARDED | TCPC_ALERT_RX_STATUS |
-               TCPC_ALERT_RX_HARD_RST | TCPC_ALERT_CC_STATUS;
-       if (tcpci->controls_vbus)
-               reg |= TCPC_ALERT_POWER_STATUS;
-       return tcpci_write16(tcpci, TCPC_ALERT_MASK, reg);
-}
-
-static irqreturn_t tcpci_irq(int irq, void *dev_id)
-{
-       struct tcpci *tcpci = dev_id;
-       unsigned int status, reg;
-
-       tcpci_read16(tcpci, TCPC_ALERT, &status);
-
-       /*
-        * Clear alert status for everything except RX_STATUS, which shouldn't
-        * be cleared until we have successfully retrieved message.
-        */
-       if (status & ~TCPC_ALERT_RX_STATUS)
-               tcpci_write16(tcpci, TCPC_ALERT,
-                             status & ~TCPC_ALERT_RX_STATUS);
-
-       if (status & TCPC_ALERT_CC_STATUS)
-               tcpm_cc_change(tcpci->port);
-
-       if (status & TCPC_ALERT_POWER_STATUS) {
-               regmap_read(tcpci->regmap, TCPC_POWER_STATUS_MASK, &reg);
-
-               /*
-                * If power status mask has been reset, then the TCPC
-                * has reset.
-                */
-               if (reg == 0xff)
-                       tcpm_tcpc_reset(tcpci->port);
-               else
-                       tcpm_vbus_change(tcpci->port);
-       }
-
-       if (status & TCPC_ALERT_RX_STATUS) {
-               struct pd_message msg;
-               unsigned int cnt;
-
-               regmap_read(tcpci->regmap, TCPC_RX_BYTE_CNT, &cnt);
-
-               tcpci_read16(tcpci, TCPC_RX_HDR, &reg);
-               msg.header = reg;
-
-               if (WARN_ON(cnt > sizeof(msg.payload)))
-                       cnt = sizeof(msg.payload);
-
-               if (cnt > 0)
-                       regmap_raw_read(tcpci->regmap, TCPC_RX_DATA,
-                                       &msg.payload, cnt);
-
-               /* Read complete, clear RX status alert bit */
-               tcpci_write16(tcpci, TCPC_ALERT, TCPC_ALERT_RX_STATUS);
-
-               tcpm_pd_receive(tcpci->port, &msg);
-       }
-
-       if (status & TCPC_ALERT_RX_HARD_RST)
-               tcpm_pd_hard_reset(tcpci->port);
-
-       if (status & TCPC_ALERT_TX_SUCCESS)
-               tcpm_pd_transmit_complete(tcpci->port, TCPC_TX_SUCCESS);
-       else if (status & TCPC_ALERT_TX_DISCARDED)
-               tcpm_pd_transmit_complete(tcpci->port, TCPC_TX_DISCARDED);
-       else if (status & TCPC_ALERT_TX_FAILED)
-               tcpm_pd_transmit_complete(tcpci->port, TCPC_TX_FAILED);
-
-       return IRQ_HANDLED;
-}
-
-static const struct regmap_config tcpci_regmap_config = {
-       .reg_bits = 8,
-       .val_bits = 8,
-
-       .max_register = 0x7F, /* 0x80 .. 0xFF are vendor defined */
-};
-
-/* Populate struct tcpc_config from device-tree */
-static int tcpci_parse_config(struct tcpci *tcpci)
-{
-       struct tcpc_config *tcfg;
-       int ret = -EINVAL;
-
-       tcpci->controls_vbus = true; /* XXX */
-
-       tcpci->tcpc.config = devm_kzalloc(tcpci->dev, sizeof(*tcfg),
-                                         GFP_KERNEL);
-       if (!tcpci->tcpc.config)
-               return -ENOMEM;
-
-       tcfg = tcpci->tcpc.config;
-
-       /* Get port-type */
-       ret = typec_get_port_type(tcpci->dev);
-       if (ret < 0) {
-               dev_err(tcpci->dev, "typec port type is NOT correct!\n");
-               return ret;
-       }
-       tcfg->type = ret;
-
-       if (tcfg->type == TYPEC_PORT_UFP)
-               goto sink;
-
-       /* Get source PDO */
-       tcfg->nr_src_pdo = device_property_read_u32_array(tcpci->dev,
-                                               "src-pdos", NULL, 0);
-       if (tcfg->nr_src_pdo <= 0) {
-               dev_err(tcpci->dev, "typec source pdo is missing!\n");
-               return -EINVAL;
-       }
-
-       tcfg->src_pdo = devm_kzalloc(tcpci->dev,
-               sizeof(*tcfg->src_pdo) * tcfg->nr_src_pdo, GFP_KERNEL);
-       if (!tcfg->src_pdo)
-               return -ENOMEM;
-
-       ret = device_property_read_u32_array(tcpci->dev, "src-pdos",
-                               tcfg->src_pdo, tcfg->nr_src_pdo);
-       if (ret) {
-               dev_err(tcpci->dev, "Failed to read src pdo!\n");
-               return -EINVAL;
-       }
-
-       if (tcfg->type == TYPEC_PORT_DFP)
-               return 0;
-
-       /* Get the preferred power role for drp */
-       ret = typec_get_power_role(tcpci->dev);
-       if (ret < 0) {
-               dev_err(tcpci->dev, "typec preferred role is wrong!\n");
-               return ret;
-       }
-       tcfg->default_role = ret;
-sink:
-       /* Get sink power capability */
-       tcfg->nr_snk_pdo = device_property_read_u32_array(tcpci->dev,
-                                               "snk-pdos", NULL, 0);
-       if (tcfg->nr_snk_pdo <= 0) {
-               dev_err(tcpci->dev, "typec sink pdo is missing!\n");
-               return -EINVAL;
-       }
-
-       tcfg->snk_pdo = devm_kzalloc(tcpci->dev,
-               sizeof(*tcfg->snk_pdo) * tcfg->nr_snk_pdo, GFP_KERNEL);
-       if (!tcfg->snk_pdo)
-               return -ENOMEM;
-
-       ret = device_property_read_u32_array(tcpci->dev, "snk-pdos",
-                               tcfg->snk_pdo, tcfg->nr_snk_pdo);
-       if (ret) {
-               dev_err(tcpci->dev, "Failed to read sink pdo!\n");
-               return -EINVAL;
-       }
-
-       if (device_property_read_u32(tcpci->dev, "max-snk-mv",
-                                    &tcfg->max_snk_mv) ||
-               device_property_read_u32(tcpci->dev, "max-snk-ma",
-                                        &tcfg->max_snk_ma) ||
-               device_property_read_u32(tcpci->dev, "op-snk-mw",
-                                        &tcfg->operating_snk_mw)) {
-               dev_err(tcpci->dev, "Failed to read sink capability!\n");
-               return -EINVAL;
-       }
-
-       return 0;
-}
-
-static int tcpci_probe(struct i2c_client *client,
-                      const struct i2c_device_id *i2c_id)
-{
-       struct tcpci *tcpci;
-       int err;
-
-       tcpci = devm_kzalloc(&client->dev, sizeof(*tcpci), GFP_KERNEL);
-       if (!tcpci)
-               return -ENOMEM;
-
-       tcpci->client = client;
-       tcpci->dev = &client->dev;
-       i2c_set_clientdata(client, tcpci);
-       tcpci->regmap = devm_regmap_init_i2c(client, &tcpci_regmap_config);
-       if (IS_ERR(tcpci->regmap))
-               return PTR_ERR(tcpci->regmap);
-
-       tcpci->tcpc.init = tcpci_init;
-       tcpci->tcpc.get_vbus = tcpci_get_vbus;
-       tcpci->tcpc.set_vbus = tcpci_set_vbus;
-       tcpci->tcpc.set_cc = tcpci_set_cc;
-       tcpci->tcpc.get_cc = tcpci_get_cc;
-       tcpci->tcpc.set_polarity = tcpci_set_polarity;
-       tcpci->tcpc.set_vconn = tcpci_set_vconn;
-       tcpci->tcpc.start_drp_toggling = tcpci_start_drp_toggling;
-
-       tcpci->tcpc.set_pd_rx = tcpci_set_pd_rx;
-       tcpci->tcpc.set_roles = tcpci_set_roles;
-       tcpci->tcpc.pd_transmit = tcpci_pd_transmit;
-
-       err = tcpci_parse_config(tcpci);
-       if (err < 0)
-               return err;
-
-       /* Disable chip interrupts */
-       tcpci_write16(tcpci, TCPC_ALERT_MASK, 0);
-
-       tcpci->port = tcpm_register_port(tcpci->dev, &tcpci->tcpc);
-       if (IS_ERR(tcpci->port))
-               return PTR_ERR(tcpci->port);
-
-       return devm_request_threaded_irq(tcpci->dev, client->irq, NULL,
-                                       tcpci_irq,
-                                       IRQF_ONESHOT | IRQF_TRIGGER_LOW,
-                                       dev_name(tcpci->dev), tcpci);
-}
-
-static int tcpci_remove(struct i2c_client *client)
-{
-       struct tcpci *tcpci = i2c_get_clientdata(client);
-
-       tcpm_unregister_port(tcpci->port);
-
-       return 0;
-}
-
-static const struct i2c_device_id tcpci_id[] = {
-       { "tcpci", 0 },
-       { }
-};
-MODULE_DEVICE_TABLE(i2c, tcpci_id);
-
-#ifdef CONFIG_OF
-static const struct of_device_id tcpci_of_match[] = {
-       { .compatible = "usb,tcpci", },
-       {},
-};
-MODULE_DEVICE_TABLE(of, tcpci_of_match);
-#endif
-
-static struct i2c_driver tcpci_i2c_driver = {
-       .driver = {
-               .name = "tcpci",
-               .of_match_table = of_match_ptr(tcpci_of_match),
-       },
-       .probe = tcpci_probe,
-       .remove = tcpci_remove,
-       .id_table = tcpci_id,
-};
-module_i2c_driver(tcpci_i2c_driver);
-
-MODULE_DESCRIPTION("USB Type-C Port Controller Interface driver");
-MODULE_LICENSE("GPL");
diff --git a/drivers/staging/typec/tcpci.h b/drivers/staging/typec/tcpci.h
deleted file mode 100644
index 10b04c8..0000000
--- a/drivers/staging/typec/tcpci.h
+++ /dev/null
@@ -1,133 +0,0 @@
-/*
- * Copyright 2015-2017 Google, Inc
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * 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.
- *
- * USB Type-C Port Controller Interface.
- */
-
-#ifndef __LINUX_USB_TCPCI_H
-#define __LINUX_USB_TCPCI_H
-
-#define TCPC_VENDOR_ID                 0x0
-#define TCPC_PRODUCT_ID                        0x2
-#define TCPC_BCD_DEV                   0x4
-#define TCPC_TC_REV                    0x6
-#define TCPC_PD_REV                    0x8
-#define TCPC_PD_INT_REV                        0xa
-
-#define TCPC_ALERT                     0x10
-#define TCPC_ALERT_VBUS_DISCNCT                BIT(11)
-#define TCPC_ALERT_RX_BUF_OVF          BIT(10)
-#define TCPC_ALERT_FAULT               BIT(9)
-#define TCPC_ALERT_V_ALARM_LO          BIT(8)
-#define TCPC_ALERT_V_ALARM_HI          BIT(7)
-#define TCPC_ALERT_TX_SUCCESS          BIT(6)
-#define TCPC_ALERT_TX_DISCARDED                BIT(5)
-#define TCPC_ALERT_TX_FAILED           BIT(4)
-#define TCPC_ALERT_RX_HARD_RST         BIT(3)
-#define TCPC_ALERT_RX_STATUS           BIT(2)
-#define TCPC_ALERT_POWER_STATUS                BIT(1)
-#define TCPC_ALERT_CC_STATUS           BIT(0)
-
-#define TCPC_ALERT_MASK                        0x12
-#define TCPC_POWER_STATUS_MASK         0x14
-#define TCPC_FAULT_STATUS_MASK         0x15
-#define TCPC_CONFIG_STD_OUTPUT         0x18
-
-#define TCPC_TCPC_CTRL                 0x19
-#define TCPC_TCPC_CTRL_ORIENTATION     BIT(0)
-
-#define TCPC_ROLE_CTRL                 0x1a
-#define TCPC_ROLE_CTRL_DRP             BIT(6)
-#define TCPC_ROLE_CTRL_RP_VAL_SHIFT    4
-#define TCPC_ROLE_CTRL_RP_VAL_MASK     0x3
-#define TCPC_ROLE_CTRL_RP_VAL_DEF      0x0
-#define TCPC_ROLE_CTRL_RP_VAL_1_5      0x1
-#define TCPC_ROLE_CTRL_RP_VAL_3_0      0x2
-#define TCPC_ROLE_CTRL_CC2_SHIFT       2
-#define TCPC_ROLE_CTRL_CC2_MASK                0x3
-#define TCPC_ROLE_CTRL_CC1_SHIFT       0
-#define TCPC_ROLE_CTRL_CC1_MASK                0x3
-#define TCPC_ROLE_CTRL_CC_RA           0x0
-#define TCPC_ROLE_CTRL_CC_RP           0x1
-#define TCPC_ROLE_CTRL_CC_RD           0x2
-#define TCPC_ROLE_CTRL_CC_OPEN         0x3
-
-#define TCPC_FAULT_CTRL                        0x1b
-
-#define TCPC_POWER_CTRL                        0x1c
-#define TCPC_POWER_CTRL_VCONN_ENABLE   BIT(0)
-
-#define TCPC_CC_STATUS                 0x1d
-#define TCPC_CC_STATUS_TERM            BIT(4)
-#define TCPC_CC_STATUS_CC2_SHIFT       2
-#define TCPC_CC_STATUS_CC2_MASK                0x3
-#define TCPC_CC_STATUS_CC1_SHIFT       0
-#define TCPC_CC_STATUS_CC1_MASK                0x3
-
-#define TCPC_POWER_STATUS              0x1e
-#define TCPC_POWER_STATUS_UNINIT       BIT(6)
-#define TCPC_POWER_STATUS_VBUS_DET     BIT(3)
-#define TCPC_POWER_STATUS_VBUS_PRES    BIT(2)
-
-#define TCPC_FAULT_STATUS              0x1f
-
-#define TCPC_COMMAND                   0x23
-#define TCPC_CMD_WAKE_I2C              0x11
-#define TCPC_CMD_DISABLE_VBUS_DETECT   0x22
-#define TCPC_CMD_ENABLE_VBUS_DETECT    0x33
-#define TCPC_CMD_DISABLE_SINK_VBUS     0x44
-#define TCPC_CMD_SINK_VBUS             0x55
-#define TCPC_CMD_DISABLE_SRC_VBUS      0x66
-#define TCPC_CMD_SRC_VBUS_DEFAULT      0x77
-#define TCPC_CMD_SRC_VBUS_HIGH         0x88
-#define TCPC_CMD_LOOK4CONNECTION       0x99
-#define TCPC_CMD_RXONEMORE             0xAA
-#define TCPC_CMD_I2C_IDLE              0xFF
-
-#define TCPC_DEV_CAP_1                 0x24
-#define TCPC_DEV_CAP_2                 0x26
-#define TCPC_STD_INPUT_CAP             0x28
-#define TCPC_STD_OUTPUT_CAP            0x29
-
-#define TCPC_MSG_HDR_INFO              0x2e
-#define TCPC_MSG_HDR_INFO_DATA_ROLE    BIT(3)
-#define TCPC_MSG_HDR_INFO_PWR_ROLE     BIT(0)
-#define TCPC_MSG_HDR_INFO_REV_SHIFT    1
-#define TCPC_MSG_HDR_INFO_REV_MASK     0x3
-
-#define TCPC_RX_DETECT                 0x2f
-#define TCPC_RX_DETECT_HARD_RESET      BIT(5)
-#define TCPC_RX_DETECT_SOP             BIT(0)
-
-#define TCPC_RX_BYTE_CNT               0x30
-#define TCPC_RX_BUF_FRAME_TYPE         0x31
-#define TCPC_RX_HDR                    0x32
-#define TCPC_RX_DATA                   0x34 /* through 0x4f */
-
-#define TCPC_TRANSMIT                  0x50
-#define TCPC_TRANSMIT_RETRY_SHIFT      4
-#define TCPC_TRANSMIT_RETRY_MASK       0x3
-#define TCPC_TRANSMIT_TYPE_SHIFT       0
-#define TCPC_TRANSMIT_TYPE_MASK                0x7
-
-#define TCPC_TX_BYTE_CNT               0x51
-#define TCPC_TX_HDR                    0x52
-#define TCPC_TX_DATA                   0x54 /* through 0x6f */
-
-#define TCPC_VBUS_VOLTAGE                      0x70
-#define TCPC_VBUS_SINK_DISCONNECT_THRESH       0x72
-#define TCPC_VBUS_STOP_DISCHARGE_THRESH                0x74
-#define TCPC_VBUS_VOLTAGE_ALARM_HI_CFG         0x76
-#define TCPC_VBUS_VOLTAGE_ALARM_LO_CFG         0x78
-
-#endif /* __LINUX_USB_TCPCI_H */
diff --git a/drivers/usb/typec/Kconfig b/drivers/usb/typec/Kconfig
index 819c0ed..33b04c4 100644
--- a/drivers/usb/typec/Kconfig
+++ b/drivers/usb/typec/Kconfig
@@ -14,6 +14,13 @@ config TYPEC_TCPM
 
 if TYPEC_TCPM
 
+config TYPEC_TCPCI
+       tristate "Type-C Port Controller Interface driver"
+       depends on I2C
+       select REGMAP_I2C
+       help
+         Type-C Port Controller driver for TCPCI-compliant controller.
+
 source "drivers/usb/typec/fusb302/Kconfig"
 
 endif
diff --git a/drivers/usb/typec/Makefile b/drivers/usb/typec/Makefile
index b77688c..c2fbf17 100644
--- a/drivers/usb/typec/Makefile
+++ b/drivers/usb/typec/Makefile
@@ -3,3 +3,4 @@ obj-$(CONFIG_TYPEC_TCPM)        += tcpm.o
 obj-y                          += fusb302/
 obj-$(CONFIG_TYPEC_WCOVE)      += typec_wcove.o
 obj-$(CONFIG_TYPEC_UCSI)       += ucsi/
+obj-$(CONFIG_TYPEC_TCPCI)      += tcpci.o
diff --git a/drivers/usb/typec/tcpci.c b/drivers/usb/typec/tcpci.c
new file mode 100644
index 0000000..293a07c
--- /dev/null
+++ b/drivers/usb/typec/tcpci.c
@@ -0,0 +1,637 @@
+/*
+ * Copyright 2015-2017 Google, Inc
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * 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.
+ *
+ * USB Type-C Port Controller Interface.
+ */
+
+#include <linux/delay.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/i2c.h>
+#include <linux/interrupt.h>
+#include <linux/regmap.h>
+#include <linux/usb/pd.h>
+#include <linux/usb/tcpm.h>
+#include <linux/usb/typec.h>
+
+#include "tcpci.h"
+
+#define PD_RETRY_COUNT 3
+
+struct tcpci {
+       struct device *dev;
+       struct i2c_client *client;
+
+       struct tcpm_port *port;
+
+       struct regmap *regmap;
+
+       bool controls_vbus;
+
+       struct tcpc_dev tcpc;
+};
+
+static inline struct tcpci *tcpc_to_tcpci(struct tcpc_dev *tcpc)
+{
+       return container_of(tcpc, struct tcpci, tcpc);
+}
+
+static int tcpci_read16(struct tcpci *tcpci, unsigned int reg,
+                       unsigned int *val)
+{
+       return regmap_raw_read(tcpci->regmap, reg, val, sizeof(u16));
+}
+
+static int tcpci_write16(struct tcpci *tcpci, unsigned int reg, u16 val)
+{
+       return regmap_raw_write(tcpci->regmap, reg, &val, sizeof(u16));
+}
+
+static int tcpci_set_cc(struct tcpc_dev *tcpc, enum typec_cc_status cc,
+                       bool attached, enum typec_cc_polarity polarity)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+       unsigned int reg = 0, reg_cc1 = 0, reg_cc2 = 0;
+       int ret;
+
+       switch (cc) {
+       case TYPEC_CC_RA:
+               reg = (TCPC_ROLE_CTRL_CC_RA << TCPC_ROLE_CTRL_CC1_SHIFT) |
+                       (TCPC_ROLE_CTRL_CC_RA << TCPC_ROLE_CTRL_CC2_SHIFT);
+               break;
+       case TYPEC_CC_RD:
+               reg_cc1 = TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC1_SHIFT;
+               reg_cc2 = TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC2_SHIFT;
+               break;
+       case TYPEC_CC_RP_DEF:
+               reg_cc1 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT;
+               reg_cc2 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT;
+               reg = TCPC_ROLE_CTRL_RP_VAL_DEF << TCPC_ROLE_CTRL_RP_VAL_SHIFT;
+               break;
+       case TYPEC_CC_RP_1_5:
+               reg_cc1 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT;
+               reg_cc2 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT;
+               reg = TCPC_ROLE_CTRL_RP_VAL_1_5 << TCPC_ROLE_CTRL_RP_VAL_SHIFT;
+               break;
+       case TYPEC_CC_RP_3_0:
+               reg_cc1 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT;
+               reg_cc2 = TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT;
+               reg = TCPC_ROLE_CTRL_RP_VAL_3_0 << TCPC_ROLE_CTRL_RP_VAL_SHIFT;
+               break;
+       case TYPEC_CC_OPEN:
+       default:
+               reg = (TCPC_ROLE_CTRL_CC_OPEN << TCPC_ROLE_CTRL_CC1_SHIFT) |
+                       (TCPC_ROLE_CTRL_CC_OPEN << TCPC_ROLE_CTRL_CC2_SHIFT);
+               break;
+       }
+
+       if (!attached)
+               reg |= reg_cc1 | reg_cc2;
+       else if (polarity == TYPEC_POLARITY_CC1)
+               reg |= reg_cc1;
+       else
+               reg |= reg_cc2;
+
+       ret = regmap_write(tcpci->regmap, TCPC_ROLE_CTRL, reg);
+       if (ret < 0)
+               return ret;
+
+       return 0;
+}
+
+static int tcpci_start_drp_toggling(struct tcpc_dev *tcpc,
+                                   enum typec_cc_status cc)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+       unsigned int reg = TCPC_ROLE_CTRL_DRP;
+       int ret;
+
+       switch (cc) {
+       default:
+       case TYPEC_CC_RP_DEF:
+               reg |= (TCPC_ROLE_CTRL_RP_VAL_DEF <<
+                       TCPC_ROLE_CTRL_RP_VAL_SHIFT);
+               break;
+       case TYPEC_CC_RP_1_5:
+               reg |= (TCPC_ROLE_CTRL_RP_VAL_1_5 <<
+                       TCPC_ROLE_CTRL_RP_VAL_SHIFT);
+               break;
+       case TYPEC_CC_RP_3_0:
+               reg |= (TCPC_ROLE_CTRL_RP_VAL_3_0 <<
+                       TCPC_ROLE_CTRL_RP_VAL_SHIFT);
+               break;
+       }
+
+       if (cc == TYPEC_CC_RD)
+               reg |= (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC1_SHIFT) |
+                       (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC2_SHIFT);
+       else
+               reg |= (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT) |
+                       (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT);
+
+       ret = regmap_write(tcpci->regmap, TCPC_ROLE_CTRL, reg);
+       if (ret < 0)
+               return ret;
+
+       return regmap_write(tcpci->regmap, TCPC_COMMAND,
+                               TCPC_CMD_LOOK4CONNECTION);
+}
+
+static enum typec_cc_status tcpci_to_typec_cc(unsigned int cc, bool sink)
+{
+       switch (cc) {
+       case 0x1:
+               return sink ? TYPEC_CC_RP_DEF : TYPEC_CC_RA;
+       case 0x2:
+               return sink ? TYPEC_CC_RP_1_5 : TYPEC_CC_RD;
+       case 0x3:
+               if (sink)
+                       return TYPEC_CC_RP_3_0;
+       case 0x0:
+       default:
+               return TYPEC_CC_OPEN;
+       }
+}
+
+static int tcpci_get_cc(struct tcpc_dev *tcpc,
+                       enum typec_cc_status *cc1, enum typec_cc_status *cc2)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+       unsigned int reg;
+       int ret;
+
+       ret = regmap_read(tcpci->regmap, TCPC_CC_STATUS, &reg);
+       if (ret < 0)
+               return ret;
+
+       *cc1 = tcpci_to_typec_cc((reg >> TCPC_CC_STATUS_CC1_SHIFT) &
+                                TCPC_CC_STATUS_CC1_MASK,
+                                reg & TCPC_CC_STATUS_TERM);
+       *cc2 = tcpci_to_typec_cc((reg >> TCPC_CC_STATUS_CC2_SHIFT) &
+                                TCPC_CC_STATUS_CC2_MASK,
+                                reg & TCPC_CC_STATUS_TERM);
+
+       return 0;
+}
+
+static int tcpci_set_polarity(struct tcpc_dev *tcpc,
+                             enum typec_cc_polarity polarity)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+       int ret;
+
+       ret = regmap_write(tcpci->regmap, TCPC_TCPC_CTRL,
+                          (polarity == TYPEC_POLARITY_CC2) ?
+                          TCPC_TCPC_CTRL_ORIENTATION : 0);
+       if (ret < 0)
+               return ret;
+
+       return 0;
+}
+
+static int tcpci_set_vconn(struct tcpc_dev *tcpc, bool enable)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+
+       return regmap_update_bits(tcpci->regmap, TCPC_POWER_CTRL,
+                               TCPC_POWER_CTRL_VCONN_ENABLE,
+                               enable ? TCPC_POWER_CTRL_VCONN_ENABLE : 0);
+}
+
+static int tcpci_set_roles(struct tcpc_dev *tcpc, bool attached,
+                          enum typec_role role, enum typec_data_role data)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+       unsigned int reg;
+       int ret;
+
+       reg = PD_REV20 << TCPC_MSG_HDR_INFO_REV_SHIFT;
+       if (role == TYPEC_SOURCE)
+               reg |= TCPC_MSG_HDR_INFO_PWR_ROLE;
+       if (data == TYPEC_HOST)
+               reg |= TCPC_MSG_HDR_INFO_DATA_ROLE;
+       ret = regmap_write(tcpci->regmap, TCPC_MSG_HDR_INFO, reg);
+       if (ret < 0)
+               return ret;
+
+       return 0;
+}
+
+static int tcpci_set_pd_rx(struct tcpc_dev *tcpc, bool enable)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+       unsigned int reg = 0;
+       int ret;
+
+       if (enable)
+               reg = TCPC_RX_DETECT_SOP | TCPC_RX_DETECT_HARD_RESET;
+       ret = regmap_write(tcpci->regmap, TCPC_RX_DETECT, reg);
+       if (ret < 0)
+               return ret;
+
+       return 0;
+}
+
+static int tcpci_get_vbus(struct tcpc_dev *tcpc)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+       unsigned int reg;
+       int ret;
+
+       ret = regmap_read(tcpci->regmap, TCPC_POWER_STATUS, &reg);
+       if (ret < 0)
+               return ret;
+
+       return !!(reg & TCPC_POWER_STATUS_VBUS_PRES);
+}
+
+static int tcpci_set_vbus(struct tcpc_dev *tcpc, bool source, bool sink)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+       int ret;
+
+       /* Disable both source and sink first before enabling anything */
+
+       if (!source) {
+               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
+                                  TCPC_CMD_DISABLE_SRC_VBUS);
+               if (ret < 0)
+                       return ret;
+       }
+
+       if (!sink) {
+               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
+                                  TCPC_CMD_DISABLE_SINK_VBUS);
+               if (ret < 0)
+                       return ret;
+       }
+
+       if (source) {
+               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
+                                  TCPC_CMD_SRC_VBUS_DEFAULT);
+               if (ret < 0)
+                       return ret;
+       }
+
+       if (sink) {
+               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
+                                  TCPC_CMD_SINK_VBUS);
+               if (ret < 0)
+                       return ret;
+       }
+
+       return 0;
+}
+
+static int tcpci_pd_transmit(struct tcpc_dev *tcpc,
+                            enum tcpm_transmit_type type,
+                            const struct pd_message *msg)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+       unsigned int reg, cnt, header;
+       int ret;
+
+       cnt = msg ? pd_header_cnt(msg->header) * 4 : 0;
+       ret = regmap_write(tcpci->regmap, TCPC_TX_BYTE_CNT, cnt + 2);
+       if (ret < 0)
+               return ret;
+
+       header = msg ? msg->header : 0;
+       ret = tcpci_write16(tcpci, TCPC_TX_HDR, header);
+       if (ret < 0)
+               return ret;
+
+       if (cnt > 0) {
+               ret = regmap_raw_write(tcpci->regmap, TCPC_TX_DATA,
+                                      &msg->payload, cnt);
+               if (ret < 0)
+                       return ret;
+       }
+
+       reg = (PD_RETRY_COUNT << TCPC_TRANSMIT_RETRY_SHIFT) |
+               (type << TCPC_TRANSMIT_TYPE_SHIFT);
+       ret = regmap_write(tcpci->regmap, TCPC_TRANSMIT, reg);
+       if (ret < 0)
+               return ret;
+
+       return 0;
+}
+
+static int tcpci_vbus_detect(struct tcpc_dev *tcpc, bool enable)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+       int ret;
+
+       if (enable) {
+               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
+                                  TCPC_CMD_ENABLE_VBUS_DETECT);
+               if (ret < 0)
+                       return ret;
+       } else {
+               ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
+                                  TCPC_CMD_DISABLE_VBUS_DETECT);
+               if (ret < 0)
+                       return ret;
+       }
+
+       return 0;
+}
+
+static int tcpci_init(struct tcpc_dev *tcpc)
+{
+       struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
+       unsigned long timeout = jiffies + msecs_to_jiffies(2000); /* XXX */
+       unsigned int reg;
+       int ret;
+
+       while (time_before_eq(jiffies, timeout)) {
+               ret = regmap_read(tcpci->regmap, TCPC_POWER_STATUS, &reg);
+               if (ret < 0)
+                       return ret;
+               if (!(reg & TCPC_POWER_STATUS_UNINIT))
+                       break;
+               usleep_range(10000, 20000);
+       }
+       if (time_after(jiffies, timeout))
+               return -ETIMEDOUT;
+
+       /* Clear all events */
+       ret = tcpci_write16(tcpci, TCPC_ALERT, 0xffff);
+       if (ret < 0)
+               return ret;
+
+       if (tcpci->controls_vbus)
+               reg = TCPC_POWER_STATUS_VBUS_PRES;
+       else
+               reg = 0;
+       ret = regmap_write(tcpci->regmap, TCPC_POWER_STATUS_MASK, reg);
+       if (ret < 0)
+               return ret;
+
+       /* Enable Vbus detection */
+       tcpci_vbus_detect(tcpc, true);
+
+       reg = TCPC_ALERT_TX_SUCCESS | TCPC_ALERT_TX_FAILED |
+               TCPC_ALERT_TX_DISCARDED | TCPC_ALERT_RX_STATUS |
+               TCPC_ALERT_RX_HARD_RST | TCPC_ALERT_CC_STATUS;
+       if (tcpci->controls_vbus)
+               reg |= TCPC_ALERT_POWER_STATUS;
+       return tcpci_write16(tcpci, TCPC_ALERT_MASK, reg);
+}
+
+static irqreturn_t tcpci_irq(int irq, void *dev_id)
+{
+       struct tcpci *tcpci = dev_id;
+       unsigned int status, reg;
+
+       tcpci_read16(tcpci, TCPC_ALERT, &status);
+
+       /*
+        * Clear alert status for everything except RX_STATUS, which shouldn't
+        * be cleared until we have successfully retrieved message.
+        */
+       if (status & ~TCPC_ALERT_RX_STATUS)
+               tcpci_write16(tcpci, TCPC_ALERT,
+                             status & ~TCPC_ALERT_RX_STATUS);
+
+       if (status & TCPC_ALERT_CC_STATUS)
+               tcpm_cc_change(tcpci->port);
+
+       if (status & TCPC_ALERT_POWER_STATUS) {
+               regmap_read(tcpci->regmap, TCPC_POWER_STATUS_MASK, &reg);
+
+               /*
+                * If power status mask has been reset, then the TCPC
+                * has reset.
+                */
+               if (reg == 0xff)
+                       tcpm_tcpc_reset(tcpci->port);
+               else
+                       tcpm_vbus_change(tcpci->port);
+       }
+
+       if (status & TCPC_ALERT_RX_STATUS) {
+               struct pd_message msg;
+               unsigned int cnt;
+
+               regmap_read(tcpci->regmap, TCPC_RX_BYTE_CNT, &cnt);
+
+               tcpci_read16(tcpci, TCPC_RX_HDR, &reg);
+               msg.header = reg;
+
+               if (WARN_ON(cnt > sizeof(msg.payload)))
+                       cnt = sizeof(msg.payload);
+
+               if (cnt > 0)
+                       regmap_raw_read(tcpci->regmap, TCPC_RX_DATA,
+                                       &msg.payload, cnt);
+
+               /* Read complete, clear RX status alert bit */
+               tcpci_write16(tcpci, TCPC_ALERT, TCPC_ALERT_RX_STATUS);
+
+               tcpm_pd_receive(tcpci->port, &msg);
+       }
+
+       if (status & TCPC_ALERT_RX_HARD_RST)
+               tcpm_pd_hard_reset(tcpci->port);
+
+       if (status & TCPC_ALERT_TX_SUCCESS)
+               tcpm_pd_transmit_complete(tcpci->port, TCPC_TX_SUCCESS);
+       else if (status & TCPC_ALERT_TX_DISCARDED)
+               tcpm_pd_transmit_complete(tcpci->port, TCPC_TX_DISCARDED);
+       else if (status & TCPC_ALERT_TX_FAILED)
+               tcpm_pd_transmit_complete(tcpci->port, TCPC_TX_FAILED);
+
+       return IRQ_HANDLED;
+}
+
+static const struct regmap_config tcpci_regmap_config = {
+       .reg_bits = 8,
+       .val_bits = 8,
+
+       .max_register = 0x7F, /* 0x80 .. 0xFF are vendor defined */
+};
+
+/* Populate struct tcpc_config from device-tree */
+static int tcpci_parse_config(struct tcpci *tcpci)
+{
+       struct tcpc_config *tcfg;
+       int ret = -EINVAL;
+
+       tcpci->controls_vbus = true; /* XXX */
+
+       tcpci->tcpc.config = devm_kzalloc(tcpci->dev, sizeof(*tcfg),
+                                         GFP_KERNEL);
+       if (!tcpci->tcpc.config)
+               return -ENOMEM;
+
+       tcfg = tcpci->tcpc.config;
+
+       /* Get port-type */
+       ret = typec_get_port_type(tcpci->dev);
+       if (ret < 0) {
+               dev_err(tcpci->dev, "typec port type is NOT correct!\n");
+               return ret;
+       }
+       tcfg->type = ret;
+
+       if (tcfg->type == TYPEC_PORT_UFP)
+               goto sink;
+
+       /* Get source PDO */
+       tcfg->nr_src_pdo = device_property_read_u32_array(tcpci->dev,
+                                               "src-pdos", NULL, 0);
+       if (tcfg->nr_src_pdo <= 0) {
+               dev_err(tcpci->dev, "typec source pdo is missing!\n");
+               return -EINVAL;
+       }
+
+       tcfg->src_pdo = devm_kzalloc(tcpci->dev,
+               sizeof(*tcfg->src_pdo) * tcfg->nr_src_pdo, GFP_KERNEL);
+       if (!tcfg->src_pdo)
+               return -ENOMEM;
+
+       ret = device_property_read_u32_array(tcpci->dev, "src-pdos",
+                               tcfg->src_pdo, tcfg->nr_src_pdo);
+       if (ret) {
+               dev_err(tcpci->dev, "Failed to read src pdo!\n");
+               return -EINVAL;
+       }
+
+       if (tcfg->type == TYPEC_PORT_DFP)
+               return 0;
+
+       /* Get the preferred power role for drp */
+       ret = typec_get_power_role(tcpci->dev);
+       if (ret < 0) {
+               dev_err(tcpci->dev, "typec preferred role is wrong!\n");
+               return ret;
+       }
+       tcfg->default_role = ret;
+sink:
+       /* Get sink power capability */
+       tcfg->nr_snk_pdo = device_property_read_u32_array(tcpci->dev,
+                                               "snk-pdos", NULL, 0);
+       if (tcfg->nr_snk_pdo <= 0) {
+               dev_err(tcpci->dev, "typec sink pdo is missing!\n");
+               return -EINVAL;
+       }
+
+       tcfg->snk_pdo = devm_kzalloc(tcpci->dev,
+               sizeof(*tcfg->snk_pdo) * tcfg->nr_snk_pdo, GFP_KERNEL);
+       if (!tcfg->snk_pdo)
+               return -ENOMEM;
+
+       ret = device_property_read_u32_array(tcpci->dev, "snk-pdos",
+                               tcfg->snk_pdo, tcfg->nr_snk_pdo);
+       if (ret) {
+               dev_err(tcpci->dev, "Failed to read sink pdo!\n");
+               return -EINVAL;
+       }
+
+       if (device_property_read_u32(tcpci->dev, "max-snk-mv",
+                                    &tcfg->max_snk_mv) ||
+               device_property_read_u32(tcpci->dev, "max-snk-ma",
+                                        &tcfg->max_snk_ma) ||
+               device_property_read_u32(tcpci->dev, "op-snk-mw",
+                                        &tcfg->operating_snk_mw)) {
+               dev_err(tcpci->dev, "Failed to read sink capability!\n");
+               return -EINVAL;
+       }
+
+       return 0;
+}
+
+static int tcpci_probe(struct i2c_client *client,
+                      const struct i2c_device_id *i2c_id)
+{
+       struct tcpci *tcpci;
+       int err;
+
+       tcpci = devm_kzalloc(&client->dev, sizeof(*tcpci), GFP_KERNEL);
+       if (!tcpci)
+               return -ENOMEM;
+
+       tcpci->client = client;
+       tcpci->dev = &client->dev;
+       i2c_set_clientdata(client, tcpci);
+       tcpci->regmap = devm_regmap_init_i2c(client, &tcpci_regmap_config);
+       if (IS_ERR(tcpci->regmap))
+               return PTR_ERR(tcpci->regmap);
+
+       tcpci->tcpc.init = tcpci_init;
+       tcpci->tcpc.get_vbus = tcpci_get_vbus;
+       tcpci->tcpc.set_vbus = tcpci_set_vbus;
+       tcpci->tcpc.set_cc = tcpci_set_cc;
+       tcpci->tcpc.get_cc = tcpci_get_cc;
+       tcpci->tcpc.set_polarity = tcpci_set_polarity;
+       tcpci->tcpc.set_vconn = tcpci_set_vconn;
+       tcpci->tcpc.start_drp_toggling = tcpci_start_drp_toggling;
+
+       tcpci->tcpc.set_pd_rx = tcpci_set_pd_rx;
+       tcpci->tcpc.set_roles = tcpci_set_roles;
+       tcpci->tcpc.pd_transmit = tcpci_pd_transmit;
+
+       err = tcpci_parse_config(tcpci);
+       if (err < 0)
+               return err;
+
+       /* Disable chip interrupts */
+       tcpci_write16(tcpci, TCPC_ALERT_MASK, 0);
+
+       tcpci->port = tcpm_register_port(tcpci->dev, &tcpci->tcpc);
+       if (IS_ERR(tcpci->port))
+               return PTR_ERR(tcpci->port);
+
+       return devm_request_threaded_irq(tcpci->dev, client->irq, NULL,
+                                       tcpci_irq,
+                                       IRQF_ONESHOT | IRQF_TRIGGER_LOW,
+                                       dev_name(tcpci->dev), tcpci);
+}
+
+static int tcpci_remove(struct i2c_client *client)
+{
+       struct tcpci *tcpci = i2c_get_clientdata(client);
+
+       tcpm_unregister_port(tcpci->port);
+
+       return 0;
+}
+
+static const struct i2c_device_id tcpci_id[] = {
+       { "tcpci", 0 },
+       { }
+};
+MODULE_DEVICE_TABLE(i2c, tcpci_id);
+
+#ifdef CONFIG_OF
+static const struct of_device_id tcpci_of_match[] = {
+       { .compatible = "usb,tcpci", },
+       {},
+};
+MODULE_DEVICE_TABLE(of, tcpci_of_match);
+#endif
+
+static struct i2c_driver tcpci_i2c_driver = {
+       .driver = {
+               .name = "tcpci",
+               .of_match_table = of_match_ptr(tcpci_of_match),
+       },
+       .probe = tcpci_probe,
+       .remove = tcpci_remove,
+       .id_table = tcpci_id,
+};
+module_i2c_driver(tcpci_i2c_driver);
+
+MODULE_DESCRIPTION("USB Type-C Port Controller Interface driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/usb/typec/tcpci.h b/drivers/usb/typec/tcpci.h
new file mode 100644
index 0000000..10b04c8
--- /dev/null
+++ b/drivers/usb/typec/tcpci.h
@@ -0,0 +1,133 @@
+/*
+ * Copyright 2015-2017 Google, Inc
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * 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.
+ *
+ * USB Type-C Port Controller Interface.
+ */
+
+#ifndef __LINUX_USB_TCPCI_H
+#define __LINUX_USB_TCPCI_H
+
+#define TCPC_VENDOR_ID                 0x0
+#define TCPC_PRODUCT_ID                        0x2
+#define TCPC_BCD_DEV                   0x4
+#define TCPC_TC_REV                    0x6
+#define TCPC_PD_REV                    0x8
+#define TCPC_PD_INT_REV                        0xa
+
+#define TCPC_ALERT                     0x10
+#define TCPC_ALERT_VBUS_DISCNCT                BIT(11)
+#define TCPC_ALERT_RX_BUF_OVF          BIT(10)
+#define TCPC_ALERT_FAULT               BIT(9)
+#define TCPC_ALERT_V_ALARM_LO          BIT(8)
+#define TCPC_ALERT_V_ALARM_HI          BIT(7)
+#define TCPC_ALERT_TX_SUCCESS          BIT(6)
+#define TCPC_ALERT_TX_DISCARDED                BIT(5)
+#define TCPC_ALERT_TX_FAILED           BIT(4)
+#define TCPC_ALERT_RX_HARD_RST         BIT(3)
+#define TCPC_ALERT_RX_STATUS           BIT(2)
+#define TCPC_ALERT_POWER_STATUS                BIT(1)
+#define TCPC_ALERT_CC_STATUS           BIT(0)
+
+#define TCPC_ALERT_MASK                        0x12
+#define TCPC_POWER_STATUS_MASK         0x14
+#define TCPC_FAULT_STATUS_MASK         0x15
+#define TCPC_CONFIG_STD_OUTPUT         0x18
+
+#define TCPC_TCPC_CTRL                 0x19
+#define TCPC_TCPC_CTRL_ORIENTATION     BIT(0)
+
+#define TCPC_ROLE_CTRL                 0x1a
+#define TCPC_ROLE_CTRL_DRP             BIT(6)
+#define TCPC_ROLE_CTRL_RP_VAL_SHIFT    4
+#define TCPC_ROLE_CTRL_RP_VAL_MASK     0x3
+#define TCPC_ROLE_CTRL_RP_VAL_DEF      0x0
+#define TCPC_ROLE_CTRL_RP_VAL_1_5      0x1
+#define TCPC_ROLE_CTRL_RP_VAL_3_0      0x2
+#define TCPC_ROLE_CTRL_CC2_SHIFT       2
+#define TCPC_ROLE_CTRL_CC2_MASK                0x3
+#define TCPC_ROLE_CTRL_CC1_SHIFT       0
+#define TCPC_ROLE_CTRL_CC1_MASK                0x3
+#define TCPC_ROLE_CTRL_CC_RA           0x0
+#define TCPC_ROLE_CTRL_CC_RP           0x1
+#define TCPC_ROLE_CTRL_CC_RD           0x2
+#define TCPC_ROLE_CTRL_CC_OPEN         0x3
+
+#define TCPC_FAULT_CTRL                        0x1b
+
+#define TCPC_POWER_CTRL                        0x1c
+#define TCPC_POWER_CTRL_VCONN_ENABLE   BIT(0)
+
+#define TCPC_CC_STATUS                 0x1d
+#define TCPC_CC_STATUS_TERM            BIT(4)
+#define TCPC_CC_STATUS_CC2_SHIFT       2
+#define TCPC_CC_STATUS_CC2_MASK                0x3
+#define TCPC_CC_STATUS_CC1_SHIFT       0
+#define TCPC_CC_STATUS_CC1_MASK                0x3
+
+#define TCPC_POWER_STATUS              0x1e
+#define TCPC_POWER_STATUS_UNINIT       BIT(6)
+#define TCPC_POWER_STATUS_VBUS_DET     BIT(3)
+#define TCPC_POWER_STATUS_VBUS_PRES    BIT(2)
+
+#define TCPC_FAULT_STATUS              0x1f
+
+#define TCPC_COMMAND                   0x23
+#define TCPC_CMD_WAKE_I2C              0x11
+#define TCPC_CMD_DISABLE_VBUS_DETECT   0x22
+#define TCPC_CMD_ENABLE_VBUS_DETECT    0x33
+#define TCPC_CMD_DISABLE_SINK_VBUS     0x44
+#define TCPC_CMD_SINK_VBUS             0x55
+#define TCPC_CMD_DISABLE_SRC_VBUS      0x66
+#define TCPC_CMD_SRC_VBUS_DEFAULT      0x77
+#define TCPC_CMD_SRC_VBUS_HIGH         0x88
+#define TCPC_CMD_LOOK4CONNECTION       0x99
+#define TCPC_CMD_RXONEMORE             0xAA
+#define TCPC_CMD_I2C_IDLE              0xFF
+
+#define TCPC_DEV_CAP_1                 0x24
+#define TCPC_DEV_CAP_2                 0x26
+#define TCPC_STD_INPUT_CAP             0x28
+#define TCPC_STD_OUTPUT_CAP            0x29
+
+#define TCPC_MSG_HDR_INFO              0x2e
+#define TCPC_MSG_HDR_INFO_DATA_ROLE    BIT(3)
+#define TCPC_MSG_HDR_INFO_PWR_ROLE     BIT(0)
+#define TCPC_MSG_HDR_INFO_REV_SHIFT    1
+#define TCPC_MSG_HDR_INFO_REV_MASK     0x3
+
+#define TCPC_RX_DETECT                 0x2f
+#define TCPC_RX_DETECT_HARD_RESET      BIT(5)
+#define TCPC_RX_DETECT_SOP             BIT(0)
+
+#define TCPC_RX_BYTE_CNT               0x30
+#define TCPC_RX_BUF_FRAME_TYPE         0x31
+#define TCPC_RX_HDR                    0x32
+#define TCPC_RX_DATA                   0x34 /* through 0x4f */
+
+#define TCPC_TRANSMIT                  0x50
+#define TCPC_TRANSMIT_RETRY_SHIFT      4
+#define TCPC_TRANSMIT_RETRY_MASK       0x3
+#define TCPC_TRANSMIT_TYPE_SHIFT       0
+#define TCPC_TRANSMIT_TYPE_MASK                0x7
+
+#define TCPC_TX_BYTE_CNT               0x51
+#define TCPC_TX_HDR                    0x52
+#define TCPC_TX_DATA                   0x54 /* through 0x6f */
+
+#define TCPC_VBUS_VOLTAGE                      0x70
+#define TCPC_VBUS_SINK_DISCONNECT_THRESH       0x72
+#define TCPC_VBUS_STOP_DISCHARGE_THRESH                0x74
+#define TCPC_VBUS_VOLTAGE_ALARM_HI_CFG         0x76
+#define TCPC_VBUS_VOLTAGE_ALARM_LO_CFG         0x78
+
+#endif /* __LINUX_USB_TCPCI_H */
-- 
2.6.6

--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to [email protected]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to