Merge tag 'usb-6.1-rc1' of git://git.kernel.org/pub/scm/linux/kernel/git/gregkh/usb
[platform/kernel/linux-rpi.git] / drivers / usb / typec / tcpm / tcpci_rt1711h.c
index c132771..7b217c7 100644 (file)
@@ -5,6 +5,7 @@
  * Richtek RT1711H Type-C Chip Driver
  */
 
+#include <linux/bits.h>
 #include <linux/kernel.h>
 #include <linux/module.h>
 #include <linux/i2c.h>
 #include <linux/usb/tcpci.h>
 #include <linux/usb/tcpm.h>
 #include <linux/regmap.h>
+#include <linux/regulator/consumer.h>
 
 #define RT1711H_VID            0x29CF
 #define RT1711H_PID            0x1711
+#define RT1711H_DID            0x2171
+#define RT1715_DID             0x2173
 
-#define RT1711H_RTCTRL8                0x9B
+#define RT1711H_PHYCTRL1       0x80
+#define RT1711H_PHYCTRL2       0x81
+
+#define RT1711H_RTCTRL4                0x93
+/* rx threshold of rd/rp: 1b0 for level 0.4V/0.7V, 1b1 for 0.35V/0.75V */
+#define RT1711H_BMCIO_RXDZSEL  BIT(0)
 
+#define RT1711H_RTCTRL8                0x9B
 /* Autoidle timeout = (tout * 2 + 1) * 6.4ms */
 #define RT1711H_RTCTRL8_SET(ck300, ship_off, auto_idle, tout) \
                            (((ck300) << 7) | ((ship_off) << 5) | \
                            ((auto_idle) << 3) | ((tout) & 0x07))
+#define RT1711H_AUTOIDLEEN     BIT(3)
+#define RT1711H_ENEXTMSG       BIT(4)
 
 #define RT1711H_RTCTRL11       0x9E
 
 #define RT1711H_RTCTRL15       0xA2
 #define RT1711H_RTCTRL16       0xA3
 
+#define RT1711H_RTCTRL18       0xAF
+/* 1b0 as fixed rx threshold of rd/rp 0.55V, 1b1 depends on RTCRTL4[0] */
+#define BMCIO_RXDZEN   BIT(0)
+
 struct rt1711h_chip {
        struct tcpci_data data;
        struct tcpci *tcpci;
        struct device *dev;
+       struct regulator *vbus;
+       bool src_en;
+       u16 did;
 };
 
 static int rt1711h_read16(struct rt1711h_chip *chip, unsigned int reg, u16 *val)
@@ -75,8 +94,9 @@ static struct rt1711h_chip *tdata_to_rt1711h(struct tcpci_data *tdata)
 
 static int rt1711h_init(struct tcpci *tcpci, struct tcpci_data *tdata)
 {
-       int ret;
        struct rt1711h_chip *chip = tdata_to_rt1711h(tdata);
+       struct regmap *regmap = chip->data.regmap;
+       int ret;
 
        /* CK 300K from 320K, shipping off, auto_idle enable, tout = 32ms */
        ret = rt1711h_write8(chip, RT1711H_RTCTRL8,
@@ -84,6 +104,14 @@ static int rt1711h_init(struct tcpci *tcpci, struct tcpci_data *tdata)
        if (ret < 0)
                return ret;
 
+       /* Enable PD30 extended message for RT1715 */
+       if (chip->did == RT1715_DID) {
+               ret = regmap_update_bits(regmap, RT1711H_RTCTRL8,
+                                        RT1711H_ENEXTMSG, RT1711H_ENEXTMSG);
+               if (ret < 0)
+                       return ret;
+       }
+
        /* I2C reset : (val + 1) * 12.5ms */
        ret = rt1711h_write8(chip, RT1711H_RTCTRL11,
                             RT1711H_RTCTRL11_SET(1, 0x0F));
@@ -101,7 +129,37 @@ static int rt1711h_init(struct tcpci *tcpci, struct tcpci_data *tdata)
                return ret;
 
        /* dcSRC.DRP : 33% */
-       return rt1711h_write16(chip, RT1711H_RTCTRL16, 330);
+       ret = rt1711h_write16(chip, RT1711H_RTCTRL16, 330);
+       if (ret < 0)
+               return ret;
+
+       /* Enable phy discard retry, retry count 7, rx filter deglitch 100 us */
+       ret = rt1711h_write8(chip, RT1711H_PHYCTRL1, 0xF1);
+       if (ret < 0)
+               return ret;
+
+       /* Decrease wait time of BMC-encoded 1 bit from 2.67us to 2.55us */
+       /* wait time : (val * .4167) us */
+       return rt1711h_write8(chip, RT1711H_PHYCTRL2, 62);
+}
+
+static int rt1711h_set_vbus(struct tcpci *tcpci, struct tcpci_data *tdata,
+                           bool src, bool snk)
+{
+       struct rt1711h_chip *chip = tdata_to_rt1711h(tdata);
+       int ret;
+
+       if (chip->src_en == src)
+               return 0;
+
+       if (src)
+               ret = regulator_enable(chip->vbus);
+       else
+               ret = regulator_disable(chip->vbus);
+
+       if (!ret)
+               chip->src_en = src;
+       return ret;
 }
 
 static int rt1711h_set_vconn(struct tcpci *tcpci, struct tcpci_data *tdata,
@@ -109,8 +167,55 @@ static int rt1711h_set_vconn(struct tcpci *tcpci, struct tcpci_data *tdata,
 {
        struct rt1711h_chip *chip = tdata_to_rt1711h(tdata);
 
-       return rt1711h_write8(chip, RT1711H_RTCTRL8,
-                             RT1711H_RTCTRL8_SET(0, 1, !enable, 2));
+       return regmap_update_bits(chip->data.regmap, RT1711H_RTCTRL8,
+                                 RT1711H_AUTOIDLEEN, enable ? 0 : RT1711H_AUTOIDLEEN);
+}
+
+/*
+ * Selects the CC PHY noise filter voltage level according to the remote current
+ * CC voltage level.
+ *
+ * @status: The port's current cc status read from IC
+ * Return 0 if writes succeed; failure code otherwise
+ */
+static inline int rt1711h_init_cc_params(struct rt1711h_chip *chip, u8 status)
+{
+       int ret, cc1, cc2;
+       u8 role = 0;
+       u32 rxdz_en, rxdz_sel;
+
+       ret = rt1711h_read8(chip, TCPC_ROLE_CTRL, &role);
+       if (ret < 0)
+               return ret;
+
+       cc1 = tcpci_to_typec_cc((status >> TCPC_CC_STATUS_CC1_SHIFT) &
+                               TCPC_CC_STATUS_CC1_MASK,
+                               status & TCPC_CC_STATUS_TERM ||
+                               tcpc_presenting_rd(role, CC1));
+       cc2 = tcpci_to_typec_cc((status >> TCPC_CC_STATUS_CC2_SHIFT) &
+                               TCPC_CC_STATUS_CC2_MASK,
+                               status & TCPC_CC_STATUS_TERM ||
+                               tcpc_presenting_rd(role, CC2));
+
+       if ((cc1 >= TYPEC_CC_RP_1_5 && cc2 < TYPEC_CC_RP_DEF) ||
+           (cc2 >= TYPEC_CC_RP_1_5 && cc1 < TYPEC_CC_RP_DEF)) {
+               rxdz_en = BMCIO_RXDZEN;
+               if (chip->did == RT1715_DID)
+                       rxdz_sel = RT1711H_BMCIO_RXDZSEL;
+               else
+                       rxdz_sel = 0;
+       } else {
+               rxdz_en = 0;
+               rxdz_sel = RT1711H_BMCIO_RXDZSEL;
+       }
+
+       ret = regmap_update_bits(chip->data.regmap, RT1711H_RTCTRL18,
+                                BMCIO_RXDZEN, rxdz_en);
+       if (ret < 0)
+               return ret;
+
+       return regmap_update_bits(chip->data.regmap, RT1711H_RTCTRL4,
+                                 RT1711H_BMCIO_RXDZSEL, rxdz_sel);
 }
 
 static int rt1711h_start_drp_toggling(struct tcpci *tcpci,
@@ -173,6 +278,8 @@ static irqreturn_t rt1711h_irq(int irq, void *dev_id)
                /* Clear cc change event triggered by starting toggling */
                if (status & TCPC_CC_STATUS_TOGGLING)
                        rt1711h_write8(chip, TCPC_ALERT, TCPC_ALERT_CC_STATUS);
+               else
+                       rt1711h_init_cc_params(chip, status);
        }
 
 out:
@@ -191,7 +298,7 @@ static int rt1711h_sw_reset(struct rt1711h_chip *chip)
        return 0;
 }
 
-static int rt1711h_check_revision(struct i2c_client *i2c)
+static int rt1711h_check_revision(struct i2c_client *i2c, struct rt1711h_chip *chip)
 {
        int ret;
 
@@ -209,7 +316,15 @@ static int rt1711h_check_revision(struct i2c_client *i2c)
                dev_err(&i2c->dev, "pid is not correct, 0x%04x\n", ret);
                return -ENODEV;
        }
-       return 0;
+       ret = i2c_smbus_read_word_data(i2c, TCPC_BCD_DEV);
+       if (ret < 0)
+               return ret;
+       if (ret != chip->did) {
+               dev_err(&i2c->dev, "did is not correct, 0x%04x\n", ret);
+               return -ENODEV;
+       }
+       dev_dbg(&i2c->dev, "did is 0x%04x\n", ret);
+       return ret;
 }
 
 static int rt1711h_probe(struct i2c_client *client,
@@ -218,16 +333,18 @@ static int rt1711h_probe(struct i2c_client *client,
        int ret;
        struct rt1711h_chip *chip;
 
-       ret = rt1711h_check_revision(client);
+       chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL);
+       if (!chip)
+               return -ENOMEM;
+
+       chip->did = (size_t)device_get_match_data(&client->dev);
+
+       ret = rt1711h_check_revision(client, chip);
        if (ret < 0) {
                dev_err(&client->dev, "check vid/pid fail\n");
                return ret;
        }
 
-       chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL);
-       if (!chip)
-               return -ENOMEM;
-
        chip->data.regmap = devm_regmap_init_i2c(client,
                                                 &rt1711h_regmap_config);
        if (IS_ERR(chip->data.regmap))
@@ -245,7 +362,12 @@ static int rt1711h_probe(struct i2c_client *client,
        if (ret < 0)
                return ret;
 
+       chip->vbus = devm_regulator_get(&client->dev, "vbus");
+       if (IS_ERR(chip->vbus))
+               return PTR_ERR(chip->vbus);
+
        chip->data.init = rt1711h_init;
+       chip->data.set_vbus = rt1711h_set_vbus;
        chip->data.set_vconn = rt1711h_set_vconn;
        chip->data.start_drp_toggling = rt1711h_start_drp_toggling;
        chip->tcpci = tcpci_register_port(chip->dev, &chip->data);
@@ -272,13 +394,15 @@ static void rt1711h_remove(struct i2c_client *client)
 
 static const struct i2c_device_id rt1711h_id[] = {
        { "rt1711h", 0 },
+       { "rt1715", 0 },
        { }
 };
 MODULE_DEVICE_TABLE(i2c, rt1711h_id);
 
 #ifdef CONFIG_OF
 static const struct of_device_id rt1711h_of_match[] = {
-       { .compatible = "richtek,rt1711h", },
+       { .compatible = "richtek,rt1711h", .data = (void *)RT1711H_DID },
+       { .compatible = "richtek,rt1715", .data = (void *)RT1715_DID },
        {},
 };
 MODULE_DEVICE_TABLE(of, rt1711h_of_match);