drivers/usb/typec/tcpm/tcpci.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright 2015-2017 Google, Inc
   4  *
   5  * USB Type-C Port Controller Interface.
   6  */
   7
   8 #include <linux/delay.h>
   9 #include <linux/kernel.h>
  10 #include <linux/module.h>
  11 #include <linux/i2c.h>
  12 #include <linux/interrupt.h>
  13 #include <linux/property.h>
  14 #include <linux/regmap.h>
  15 #include <linux/usb/pd.h>
  16 #include <linux/usb/tcpci.h>
  17 #include <linux/usb/tcpm.h>
  18 #include <linux/usb/typec.h>
  19
  20 #define PD_RETRY_COUNT_DEFAULT                  3
  21 #define PD_RETRY_COUNT_3_0_OR_HIGHER            2
  22 #define AUTO_DISCHARGE_DEFAULT_THRESHOLD_MV     3500
  23 #define VSINKPD_MIN_IR_DROP_MV                  750
  24 #define VSRC_NEW_MIN_PERCENT                    95
  25 #define VSRC_VALID_MIN_MV                       500
  26 #define VPPS_NEW_MIN_PERCENT                    95
  27 #define VPPS_VALID_MIN_MV                       100
  28 #define VSINKDISCONNECT_PD_MIN_PERCENT          90
  29
  30 struct tcpci {
  31         struct device *dev;
  32
  33         struct tcpm_port *port;
  34
  35         struct regmap *regmap;
  36         unsigned int alert_mask;
  37
  38         bool controls_vbus;
  39
  40         struct tcpc_dev tcpc;
  41         struct tcpci_data *data;
  42 };
  43
  44 struct tcpci_chip {
  45         struct tcpci *tcpci;
  46         struct tcpci_data data;
  47 };
  48
  49 struct tcpm_port *tcpci_get_tcpm_port(struct tcpci *tcpci)
  50 {
  51         return tcpci->port;
  52 }
  53 EXPORT_SYMBOL_GPL(tcpci_get_tcpm_port);
  54
  55 static inline struct tcpci *tcpc_to_tcpci(struct tcpc_dev *tcpc)
  56 {
  57         return container_of(tcpc, struct tcpci, tcpc);
  58 }
  59
  60 static int tcpci_read16(struct tcpci *tcpci, unsigned int reg, u16 *val)
  61 {
  62         return regmap_raw_read(tcpci->regmap, reg, val, sizeof(u16));
  63 }
  64
  65 static int tcpci_write16(struct tcpci *tcpci, unsigned int reg, u16 val)
  66 {
  67         return regmap_raw_write(tcpci->regmap, reg, &val, sizeof(u16));
  68 }
  69
  70 static int tcpci_check_std_output_cap(struct regmap *regmap, u8 mask)
  71 {
  72         unsigned int reg;
  73         int ret;
  74
  75         ret = regmap_read(regmap, TCPC_STD_OUTPUT_CAP, &reg);
  76         if (ret < 0)
  77                 return ret;
  78
  79         return (reg & mask) == mask;
  80 }
  81
  82 static int tcpci_set_cc(struct tcpc_dev *tcpc, enum typec_cc_status cc)
  83 {
  84         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
  85         bool vconn_pres;
  86         enum typec_cc_polarity polarity = TYPEC_POLARITY_CC1;
  87         unsigned int reg;
  88         int ret;
  89
  90         ret = regmap_read(tcpci->regmap, TCPC_POWER_STATUS, &reg);
  91         if (ret < 0)
  92                 return ret;
  93
  94         vconn_pres = !!(reg & TCPC_POWER_STATUS_VCONN_PRES);
  95         if (vconn_pres) {
  96                 ret = regmap_read(tcpci->regmap, TCPC_TCPC_CTRL, &reg);
  97                 if (ret < 0)
  98                         return ret;
  99
 100                 if (reg & TCPC_TCPC_CTRL_ORIENTATION)
 101                         polarity = TYPEC_POLARITY_CC2;
 102         }
 103
 104         switch (cc) {
 105         case TYPEC_CC_RA:
 106                 reg = (TCPC_ROLE_CTRL_CC_RA << TCPC_ROLE_CTRL_CC1_SHIFT) |
 107                         (TCPC_ROLE_CTRL_CC_RA << TCPC_ROLE_CTRL_CC2_SHIFT);
 108                 break;
 109         case TYPEC_CC_RD:
 110                 reg = (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC1_SHIFT) |
 111                         (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC2_SHIFT);
 112                 break;
 113         case TYPEC_CC_RP_DEF:
 114                 reg = (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT) |
 115                         (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT) |
 116                         (TCPC_ROLE_CTRL_RP_VAL_DEF <<
 117                          TCPC_ROLE_CTRL_RP_VAL_SHIFT);
 118                 break;
 119         case TYPEC_CC_RP_1_5:
 120                 reg = (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT) |
 121                         (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT) |
 122                         (TCPC_ROLE_CTRL_RP_VAL_1_5 <<
 123                          TCPC_ROLE_CTRL_RP_VAL_SHIFT);
 124                 break;
 125         case TYPEC_CC_RP_3_0:
 126                 reg = (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT) |
 127                         (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT) |
 128                         (TCPC_ROLE_CTRL_RP_VAL_3_0 <<
 129                          TCPC_ROLE_CTRL_RP_VAL_SHIFT);
 130                 break;
 131         case TYPEC_CC_OPEN:
 132         default:
 133                 reg = (TCPC_ROLE_CTRL_CC_OPEN << TCPC_ROLE_CTRL_CC1_SHIFT) |
 134                         (TCPC_ROLE_CTRL_CC_OPEN << TCPC_ROLE_CTRL_CC2_SHIFT);
 135                 break;
 136         }
 137
 138         if (vconn_pres) {
 139                 if (polarity == TYPEC_POLARITY_CC2) {
 140                         reg &= ~(TCPC_ROLE_CTRL_CC1_MASK << TCPC_ROLE_CTRL_CC1_SHIFT);
 141                         reg |= (TCPC_ROLE_CTRL_CC_OPEN << TCPC_ROLE_CTRL_CC1_SHIFT);
 142                 } else {
 143                         reg &= ~(TCPC_ROLE_CTRL_CC2_MASK << TCPC_ROLE_CTRL_CC2_SHIFT);
 144                         reg |= (TCPC_ROLE_CTRL_CC_OPEN << TCPC_ROLE_CTRL_CC2_SHIFT);
 145                 }
 146         }
 147
 148         ret = regmap_write(tcpci->regmap, TCPC_ROLE_CTRL, reg);
 149         if (ret < 0)
 150                 return ret;
 151
 152         return 0;
 153 }
 154
 155 static int tcpci_apply_rc(struct tcpc_dev *tcpc, enum typec_cc_status cc,
 156                           enum typec_cc_polarity polarity)
 157 {
 158         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 159         unsigned int reg;
 160         int ret;
 161
 162         ret = regmap_read(tcpci->regmap, TCPC_ROLE_CTRL, &reg);
 163         if (ret < 0)
 164                 return ret;
 165
 166         /*
 167          * APPLY_RC state is when ROLE_CONTROL.CC1 != ROLE_CONTROL.CC2 and vbus autodischarge on
 168          * disconnect is disabled. Bail out when ROLE_CONTROL.CC1 != ROLE_CONTROL.CC2.
 169          */
 170         if (((reg & (TCPC_ROLE_CTRL_CC2_MASK << TCPC_ROLE_CTRL_CC2_SHIFT)) >>
 171              TCPC_ROLE_CTRL_CC2_SHIFT) !=
 172             ((reg & (TCPC_ROLE_CTRL_CC1_MASK << TCPC_ROLE_CTRL_CC1_SHIFT)) >>
 173              TCPC_ROLE_CTRL_CC1_SHIFT))
 174                 return 0;
 175
 176         return regmap_update_bits(tcpci->regmap, TCPC_ROLE_CTRL, polarity == TYPEC_POLARITY_CC1 ?
 177                                   TCPC_ROLE_CTRL_CC2_MASK << TCPC_ROLE_CTRL_CC2_SHIFT :
 178                                   TCPC_ROLE_CTRL_CC1_MASK << TCPC_ROLE_CTRL_CC1_SHIFT,
 179                                   TCPC_ROLE_CTRL_CC_OPEN);
 180 }
 181
 182 static int tcpci_start_toggling(struct tcpc_dev *tcpc,
 183                                 enum typec_port_type port_type,
 184                                 enum typec_cc_status cc)
 185 {
 186         int ret;
 187         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 188         unsigned int reg = TCPC_ROLE_CTRL_DRP;
 189
 190         if (port_type != TYPEC_PORT_DRP)
 191                 return -EOPNOTSUPP;
 192
 193         /* Handle vendor drp toggling */
 194         if (tcpci->data->start_drp_toggling) {
 195                 ret = tcpci->data->start_drp_toggling(tcpci, tcpci->data, cc);
 196                 if (ret < 0)
 197                         return ret;
 198         }
 199
 200         switch (cc) {
 201         default:
 202         case TYPEC_CC_RP_DEF:
 203                 reg |= (TCPC_ROLE_CTRL_RP_VAL_DEF <<
 204                         TCPC_ROLE_CTRL_RP_VAL_SHIFT);
 205                 break;
 206         case TYPEC_CC_RP_1_5:
 207                 reg |= (TCPC_ROLE_CTRL_RP_VAL_1_5 <<
 208                         TCPC_ROLE_CTRL_RP_VAL_SHIFT);
 209                 break;
 210         case TYPEC_CC_RP_3_0:
 211                 reg |= (TCPC_ROLE_CTRL_RP_VAL_3_0 <<
 212                         TCPC_ROLE_CTRL_RP_VAL_SHIFT);
 213                 break;
 214         }
 215
 216         if (cc == TYPEC_CC_RD)
 217                 reg |= (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC1_SHIFT) |
 218                            (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC2_SHIFT);
 219         else
 220                 reg |= (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT) |
 221                            (TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT);
 222         ret = regmap_write(tcpci->regmap, TCPC_ROLE_CTRL, reg);
 223         if (ret < 0)
 224                 return ret;
 225         return regmap_write(tcpci->regmap, TCPC_COMMAND,
 226                             TCPC_CMD_LOOK4CONNECTION);
 227 }
 228
 229 static int tcpci_get_cc(struct tcpc_dev *tcpc,
 230                         enum typec_cc_status *cc1, enum typec_cc_status *cc2)
 231 {
 232         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 233         unsigned int reg, role_control;
 234         int ret;
 235
 236         ret = regmap_read(tcpci->regmap, TCPC_ROLE_CTRL, &role_control);
 237         if (ret < 0)
 238                 return ret;
 239
 240         ret = regmap_read(tcpci->regmap, TCPC_CC_STATUS, &reg);
 241         if (ret < 0)
 242                 return ret;
 243
 244         *cc1 = tcpci_to_typec_cc((reg >> TCPC_CC_STATUS_CC1_SHIFT) &
 245                                  TCPC_CC_STATUS_CC1_MASK,
 246                                  reg & TCPC_CC_STATUS_TERM ||
 247                                  tcpc_presenting_rd(role_control, CC1));
 248         *cc2 = tcpci_to_typec_cc((reg >> TCPC_CC_STATUS_CC2_SHIFT) &
 249                                  TCPC_CC_STATUS_CC2_MASK,
 250                                  reg & TCPC_CC_STATUS_TERM ||
 251                                  tcpc_presenting_rd(role_control, CC2));
 252
 253         return 0;
 254 }
 255
 256 static int tcpci_set_polarity(struct tcpc_dev *tcpc,
 257                               enum typec_cc_polarity polarity)
 258 {
 259         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 260         unsigned int reg;
 261         int ret;
 262         enum typec_cc_status cc1, cc2;
 263
 264         /* Obtain Rp setting from role control */
 265         ret = regmap_read(tcpci->regmap, TCPC_ROLE_CTRL, &reg);
 266         if (ret < 0)
 267                 return ret;
 268
 269         ret = tcpci_get_cc(tcpc, &cc1, &cc2);
 270         if (ret < 0)
 271                 return ret;
 272
 273         /*
 274          * When port has drp toggling enabled, ROLE_CONTROL would only have the initial
 275          * terminations for the toggling and does not indicate the final cc
 276          * terminations when ConnectionResult is 0 i.e. drp toggling stops and
 277          * the connection is resolved. Infer port role from TCPC_CC_STATUS based on the
 278          * terminations seen. The port role is then used to set the cc terminations.
 279          */
 280         if (reg & TCPC_ROLE_CTRL_DRP) {
 281                 /* Disable DRP for the OPEN setting to take effect */
 282                 reg = reg & ~TCPC_ROLE_CTRL_DRP;
 283
 284                 if (polarity == TYPEC_POLARITY_CC2) {
 285                         reg &= ~(TCPC_ROLE_CTRL_CC2_MASK << TCPC_ROLE_CTRL_CC2_SHIFT);
 286                         /* Local port is source */
 287                         if (cc2 == TYPEC_CC_RD)
 288                                 /* Role control would have the Rp setting when DRP was enabled */
 289                                 reg |= TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC2_SHIFT;
 290                         else
 291                                 reg |= TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC2_SHIFT;
 292                 } else {
 293                         reg &= ~(TCPC_ROLE_CTRL_CC1_MASK << TCPC_ROLE_CTRL_CC1_SHIFT);
 294                         /* Local port is source */
 295                         if (cc1 == TYPEC_CC_RD)
 296                                 /* Role control would have the Rp setting when DRP was enabled */
 297                                 reg |= TCPC_ROLE_CTRL_CC_RP << TCPC_ROLE_CTRL_CC1_SHIFT;
 298                         else
 299                                 reg |= TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC1_SHIFT;
 300                 }
 301         }
 302
 303         if (polarity == TYPEC_POLARITY_CC2)
 304                 reg |= TCPC_ROLE_CTRL_CC_OPEN << TCPC_ROLE_CTRL_CC1_SHIFT;
 305         else
 306                 reg |= TCPC_ROLE_CTRL_CC_OPEN << TCPC_ROLE_CTRL_CC2_SHIFT;
 307         ret = regmap_write(tcpci->regmap, TCPC_ROLE_CTRL, reg);
 308         if (ret < 0)
 309                 return ret;
 310
 311         return regmap_write(tcpci->regmap, TCPC_TCPC_CTRL,
 312                            (polarity == TYPEC_POLARITY_CC2) ?
 313                            TCPC_TCPC_CTRL_ORIENTATION : 0);
 314 }
 315
 316 static int tcpci_set_orientation(struct tcpc_dev *tcpc,
 317                                  enum typec_orientation orientation)
 318 {
 319         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 320         unsigned int reg;
 321
 322         switch (orientation) {
 323         case TYPEC_ORIENTATION_NONE:
 324                 /* We can't put a single output into high impedance */
 325                 fallthrough;
 326         case TYPEC_ORIENTATION_NORMAL:
 327                 reg = TCPC_CONFIG_STD_OUTPUT_ORIENTATION_NORMAL;
 328                 break;
 329         case TYPEC_ORIENTATION_REVERSE:
 330                 reg = TCPC_CONFIG_STD_OUTPUT_ORIENTATION_FLIPPED;
 331                 break;
 332         }
 333
 334         return regmap_update_bits(tcpci->regmap, TCPC_CONFIG_STD_OUTPUT,
 335                                   TCPC_CONFIG_STD_OUTPUT_ORIENTATION_MASK, reg);
 336 }
 337
 338 static void tcpci_set_partner_usb_comm_capable(struct tcpc_dev *tcpc, bool capable)
 339 {
 340         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 341
 342         if (tcpci->data->set_partner_usb_comm_capable)
 343                 tcpci->data->set_partner_usb_comm_capable(tcpci, tcpci->data, capable);
 344 }
 345
 346 static int tcpci_set_vconn(struct tcpc_dev *tcpc, bool enable)
 347 {
 348         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 349         int ret;
 350
 351         /* Handle vendor set vconn */
 352         if (tcpci->data->set_vconn) {
 353                 ret = tcpci->data->set_vconn(tcpci, tcpci->data, enable);
 354                 if (ret < 0)
 355                         return ret;
 356         }
 357
 358         return regmap_update_bits(tcpci->regmap, TCPC_POWER_CTRL,
 359                                 TCPC_POWER_CTRL_VCONN_ENABLE,
 360                                 enable ? TCPC_POWER_CTRL_VCONN_ENABLE : 0);
 361 }
 362
 363 static int tcpci_enable_auto_vbus_discharge(struct tcpc_dev *dev, bool enable)
 364 {
 365         struct tcpci *tcpci = tcpc_to_tcpci(dev);
 366         int ret;
 367
 368         ret = regmap_update_bits(tcpci->regmap, TCPC_POWER_CTRL, TCPC_POWER_CTRL_AUTO_DISCHARGE,
 369                                  enable ? TCPC_POWER_CTRL_AUTO_DISCHARGE : 0);
 370         return ret;
 371 }
 372
 373 static int tcpci_set_auto_vbus_discharge_threshold(struct tcpc_dev *dev, enum typec_pwr_opmode mode,
 374                                                    bool pps_active, u32 requested_vbus_voltage_mv)
 375 {
 376         struct tcpci *tcpci = tcpc_to_tcpci(dev);
 377         unsigned int pwr_ctrl, threshold = 0;
 378         int ret;
 379
 380         /*
 381          * Indicates that vbus is going to go away due PR_SWAP, hard reset etc.
 382          * Do not discharge vbus here.
 383          */
 384         if (requested_vbus_voltage_mv == 0)
 385                 goto write_thresh;
 386
 387         ret = regmap_read(tcpci->regmap, TCPC_POWER_CTRL, &pwr_ctrl);
 388         if (ret < 0)
 389                 return ret;
 390
 391         if (pwr_ctrl & TCPC_FAST_ROLE_SWAP_EN) {
 392                 /* To prevent disconnect when the source is fast role swap is capable. */
 393                 threshold = AUTO_DISCHARGE_DEFAULT_THRESHOLD_MV;
 394         } else if (mode == TYPEC_PWR_MODE_PD) {
 395                 if (pps_active)
 396                         threshold = ((VPPS_NEW_MIN_PERCENT * requested_vbus_voltage_mv / 100) -
 397                                      VSINKPD_MIN_IR_DROP_MV - VPPS_VALID_MIN_MV) *
 398                                      VSINKDISCONNECT_PD_MIN_PERCENT / 100;
 399                 else
 400                         threshold = ((VSRC_NEW_MIN_PERCENT * requested_vbus_voltage_mv / 100) -
 401                                      VSINKPD_MIN_IR_DROP_MV - VSRC_VALID_MIN_MV) *
 402                                      VSINKDISCONNECT_PD_MIN_PERCENT / 100;
 403         } else {
 404                 /* 3.5V for non-pd sink */
 405                 threshold = AUTO_DISCHARGE_DEFAULT_THRESHOLD_MV;
 406         }
 407
 408         threshold = threshold / TCPC_VBUS_SINK_DISCONNECT_THRESH_LSB_MV;
 409
 410         if (threshold > TCPC_VBUS_SINK_DISCONNECT_THRESH_MAX)
 411                 return -EINVAL;
 412
 413 write_thresh:
 414         return tcpci_write16(tcpci, TCPC_VBUS_SINK_DISCONNECT_THRESH, threshold);
 415 }
 416
 417 static int tcpci_enable_frs(struct tcpc_dev *dev, bool enable)
 418 {
 419         struct tcpci *tcpci = tcpc_to_tcpci(dev);
 420         int ret;
 421
 422         /* To prevent disconnect during FRS, set disconnect threshold to 3.5V */
 423         ret = tcpci_write16(tcpci, TCPC_VBUS_SINK_DISCONNECT_THRESH, enable ? 0 : 0x8c);
 424         if (ret < 0)
 425                 return ret;
 426
 427         ret = regmap_update_bits(tcpci->regmap, TCPC_POWER_CTRL, TCPC_FAST_ROLE_SWAP_EN, enable ?
 428                                  TCPC_FAST_ROLE_SWAP_EN : 0);
 429
 430         return ret;
 431 }
 432
 433 static void tcpci_frs_sourcing_vbus(struct tcpc_dev *dev)
 434 {
 435         struct tcpci *tcpci = tcpc_to_tcpci(dev);
 436
 437         if (tcpci->data->frs_sourcing_vbus)
 438                 tcpci->data->frs_sourcing_vbus(tcpci, tcpci->data);
 439 }
 440
 441 static void tcpci_check_contaminant(struct tcpc_dev *dev)
 442 {
 443         struct tcpci *tcpci = tcpc_to_tcpci(dev);
 444
 445         if (tcpci->data->check_contaminant)
 446                 tcpci->data->check_contaminant(tcpci, tcpci->data);
 447 }
 448
 449 static int tcpci_set_bist_data(struct tcpc_dev *tcpc, bool enable)
 450 {
 451         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 452
 453         return regmap_update_bits(tcpci->regmap, TCPC_TCPC_CTRL, TCPC_TCPC_CTRL_BIST_TM,
 454                                  enable ? TCPC_TCPC_CTRL_BIST_TM : 0);
 455 }
 456
 457 static int tcpci_set_roles(struct tcpc_dev *tcpc, bool attached,
 458                            enum typec_role role, enum typec_data_role data)
 459 {
 460         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 461         unsigned int reg;
 462         int ret;
 463
 464         reg = PD_REV20 << TCPC_MSG_HDR_INFO_REV_SHIFT;
 465         if (role == TYPEC_SOURCE)
 466                 reg |= TCPC_MSG_HDR_INFO_PWR_ROLE;
 467         if (data == TYPEC_HOST)
 468                 reg |= TCPC_MSG_HDR_INFO_DATA_ROLE;
 469         ret = regmap_write(tcpci->regmap, TCPC_MSG_HDR_INFO, reg);
 470         if (ret < 0)
 471                 return ret;
 472
 473         return 0;
 474 }
 475
 476 static int tcpci_set_pd_rx(struct tcpc_dev *tcpc, bool enable)
 477 {
 478         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 479         unsigned int reg = 0;
 480         int ret;
 481
 482         if (enable) {
 483                 reg = TCPC_RX_DETECT_SOP | TCPC_RX_DETECT_HARD_RESET;
 484                 if (tcpci->data->cable_comm_capable)
 485                         reg |= TCPC_RX_DETECT_SOP1;
 486         }
 487         ret = regmap_write(tcpci->regmap, TCPC_RX_DETECT, reg);
 488         if (ret < 0)
 489                 return ret;
 490
 491         return 0;
 492 }
 493
 494 static int tcpci_get_vbus(struct tcpc_dev *tcpc)
 495 {
 496         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 497         unsigned int reg;
 498         int ret;
 499
 500         ret = regmap_read(tcpci->regmap, TCPC_POWER_STATUS, &reg);
 501         if (ret < 0)
 502                 return ret;
 503
 504         return !!(reg & TCPC_POWER_STATUS_VBUS_PRES);
 505 }
 506
 507 static bool tcpci_is_vbus_vsafe0v(struct tcpc_dev *tcpc)
 508 {
 509         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 510         unsigned int reg;
 511         int ret;
 512
 513         ret = regmap_read(tcpci->regmap, TCPC_EXTENDED_STATUS, &reg);
 514         if (ret < 0)
 515                 return false;
 516
 517         return !!(reg & TCPC_EXTENDED_STATUS_VSAFE0V);
 518 }
 519
 520 static int tcpci_set_vbus(struct tcpc_dev *tcpc, bool source, bool sink)
 521 {
 522         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 523         int ret;
 524
 525         if (tcpci->data->set_vbus) {
 526                 ret = tcpci->data->set_vbus(tcpci, tcpci->data, source, sink);
 527                 /* Bypass when ret > 0 */
 528                 if (ret != 0)
 529                         return ret < 0 ? ret : 0;
 530         }
 531
 532         /* Disable both source and sink first before enabling anything */
 533
 534         if (!source) {
 535                 ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
 536                                    TCPC_CMD_DISABLE_SRC_VBUS);
 537                 if (ret < 0)
 538                         return ret;
 539         }
 540
 541         if (!sink) {
 542                 ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
 543                                    TCPC_CMD_DISABLE_SINK_VBUS);
 544                 if (ret < 0)
 545                         return ret;
 546         }
 547
 548         if (source) {
 549                 ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
 550                                    TCPC_CMD_SRC_VBUS_DEFAULT);
 551                 if (ret < 0)
 552                         return ret;
 553         }
 554
 555         if (sink) {
 556                 ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
 557                                    TCPC_CMD_SINK_VBUS);
 558                 if (ret < 0)
 559                         return ret;
 560         }
 561
 562         return 0;
 563 }
 564
 565 static int tcpci_pd_transmit(struct tcpc_dev *tcpc, enum tcpm_transmit_type type,
 566                              const struct pd_message *msg, unsigned int negotiated_rev)
 567 {
 568         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 569         u16 header = msg ? le16_to_cpu(msg->header) : 0;
 570         unsigned int reg, cnt;
 571         int ret;
 572
 573         cnt = msg ? pd_header_cnt(header) * 4 : 0;
 574         /**
 575          * TCPCI spec forbids direct access of TCPC_TX_DATA.
 576          * But, since some of the chipsets offer this capability,
 577          * it's fair to support both.
 578          */
 579         if (tcpci->data->TX_BUF_BYTE_x_hidden) {
 580                 u8 buf[TCPC_TRANSMIT_BUFFER_MAX_LEN] = {0,};
 581                 u8 pos = 0;
 582
 583                 /* Payload + header + TCPC_TX_BYTE_CNT */
 584                 buf[pos++] = cnt + 2;
 585
 586                 if (msg)
 587                         memcpy(&buf[pos], &msg->header, sizeof(msg->header));
 588
 589                 pos += sizeof(header);
 590
 591                 if (cnt > 0)
 592                         memcpy(&buf[pos], msg->payload, cnt);
 593
 594                 pos += cnt;
 595                 ret = regmap_raw_write(tcpci->regmap, TCPC_TX_BYTE_CNT, buf, pos);
 596                 if (ret < 0)
 597                         return ret;
 598         } else {
 599                 ret = regmap_write(tcpci->regmap, TCPC_TX_BYTE_CNT, cnt + 2);
 600                 if (ret < 0)
 601                         return ret;
 602
 603                 ret = tcpci_write16(tcpci, TCPC_TX_HDR, header);
 604                 if (ret < 0)
 605                         return ret;
 606
 607                 if (cnt > 0) {
 608                         ret = regmap_raw_write(tcpci->regmap, TCPC_TX_DATA, &msg->payload, cnt);
 609                         if (ret < 0)
 610                                 return ret;
 611                 }
 612         }
 613
 614         /* nRetryCount is 3 in PD2.0 spec where 2 in PD3.0 spec */
 615         reg = ((negotiated_rev > PD_REV20 ? PD_RETRY_COUNT_3_0_OR_HIGHER : PD_RETRY_COUNT_DEFAULT)
 616                << TCPC_TRANSMIT_RETRY_SHIFT) | (type << TCPC_TRANSMIT_TYPE_SHIFT);
 617         ret = regmap_write(tcpci->regmap, TCPC_TRANSMIT, reg);
 618         if (ret < 0)
 619                 return ret;
 620
 621         return 0;
 622 }
 623
 624 static bool tcpci_cable_comm_capable(struct tcpc_dev *tcpc)
 625 {
 626         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 627
 628         return tcpci->data->cable_comm_capable;
 629 }
 630
 631 static bool tcpci_attempt_vconn_swap_discovery(struct tcpc_dev *tcpc)
 632 {
 633         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 634
 635         if (tcpci->data->attempt_vconn_swap_discovery)
 636                 return tcpci->data->attempt_vconn_swap_discovery(tcpci, tcpci->data);
 637
 638         return false;
 639 }
 640
 641 static int tcpci_init(struct tcpc_dev *tcpc)
 642 {
 643         struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
 644         unsigned long timeout = jiffies + msecs_to_jiffies(2000); /* XXX */
 645         unsigned int reg;
 646         int ret;
 647
 648         while (time_before_eq(jiffies, timeout)) {
 649                 ret = regmap_read(tcpci->regmap, TCPC_POWER_STATUS, &reg);
 650                 if (ret < 0)
 651                         return ret;
 652                 if (!(reg & TCPC_POWER_STATUS_UNINIT))
 653                         break;
 654                 usleep_range(10000, 20000);
 655         }
 656         if (time_after(jiffies, timeout))
 657                 return -ETIMEDOUT;
 658
 659         ret = tcpci_write16(tcpci, TCPC_FAULT_STATUS, TCPC_FAULT_STATUS_ALL_REG_RST_TO_DEFAULT);
 660         if (ret < 0)
 661                 return ret;
 662
 663         /* Handle vendor init */
 664         if (tcpci->data->init) {
 665                 ret = tcpci->data->init(tcpci, tcpci->data);
 666                 if (ret < 0)
 667                         return ret;
 668         }
 669
 670         /* Clear all events */
 671         ret = tcpci_write16(tcpci, TCPC_ALERT, 0xffff);
 672         if (ret < 0)
 673                 return ret;
 674
 675         if (tcpci->controls_vbus)
 676                 reg = TCPC_POWER_STATUS_VBUS_PRES;
 677         else
 678                 reg = 0;
 679         ret = regmap_write(tcpci->regmap, TCPC_POWER_STATUS_MASK, reg);
 680         if (ret < 0)
 681                 return ret;
 682
 683         /* Enable Vbus detection */
 684         ret = regmap_write(tcpci->regmap, TCPC_COMMAND,
 685                            TCPC_CMD_ENABLE_VBUS_DETECT);
 686         if (ret < 0)
 687                 return ret;
 688
 689         reg = TCPC_ALERT_TX_SUCCESS | TCPC_ALERT_TX_FAILED |
 690                 TCPC_ALERT_TX_DISCARDED | TCPC_ALERT_RX_STATUS |
 691                 TCPC_ALERT_RX_HARD_RST | TCPC_ALERT_CC_STATUS;
 692         if (tcpci->controls_vbus)
 693                 reg |= TCPC_ALERT_POWER_STATUS;
 694         /* Enable VSAFE0V status interrupt when detecting VSAFE0V is supported */
 695         if (tcpci->data->vbus_vsafe0v) {
 696                 reg |= TCPC_ALERT_EXTENDED_STATUS;
 697                 ret = regmap_write(tcpci->regmap, TCPC_EXTENDED_STATUS_MASK,
 698                                    TCPC_EXTENDED_STATUS_VSAFE0V);
 699                 if (ret < 0)
 700                         return ret;
 701         }
 702
 703         tcpci->alert_mask = reg;
 704
 705         return tcpci_write16(tcpci, TCPC_ALERT_MASK, reg);
 706 }
 707
 708 irqreturn_t tcpci_irq(struct tcpci *tcpci)
 709 {
 710         u16 status;
 711         int ret;
 712         unsigned int raw;
 713
 714         tcpci_read16(tcpci, TCPC_ALERT, &status);
 715
 716         /*
 717          * Clear alert status for everything except RX_STATUS, which shouldn't
 718          * be cleared until we have successfully retrieved message.
 719          */
 720         if (status & ~TCPC_ALERT_RX_STATUS)
 721                 tcpci_write16(tcpci, TCPC_ALERT,
 722                               status & ~TCPC_ALERT_RX_STATUS);
 723
 724         if (status & TCPC_ALERT_CC_STATUS)
 725                 tcpm_cc_change(tcpci->port);
 726
 727         if (status & TCPC_ALERT_POWER_STATUS) {
 728                 regmap_read(tcpci->regmap, TCPC_POWER_STATUS_MASK, &raw);
 729                 /*
 730                  * If power status mask has been reset, then the TCPC
 731                  * has reset.
 732                  */
 733                 if (raw == 0xff)
 734                         tcpm_tcpc_reset(tcpci->port);
 735                 else
 736                         tcpm_vbus_change(tcpci->port);
 737         }
 738
 739         if (status & TCPC_ALERT_RX_STATUS) {
 740                 struct pd_message msg;
 741                 unsigned int cnt, payload_cnt;
 742                 u16 header;
 743
 744                 regmap_read(tcpci->regmap, TCPC_RX_BYTE_CNT, &cnt);
 745                 /*
 746                  * 'cnt' corresponds to READABLE_BYTE_COUNT in section 4.4.14
 747                  * of the TCPCI spec [Rev 2.0 Ver 1.0 October 2017] and is
 748                  * defined in table 4-36 as one greater than the number of
 749                  * bytes received. And that number includes the header. So:
 750                  */
 751                 if (cnt > 3)
 752                         payload_cnt = cnt - (1 + sizeof(msg.header));
 753                 else
 754                         payload_cnt = 0;
 755
 756                 tcpci_read16(tcpci, TCPC_RX_HDR, &header);
 757                 msg.header = cpu_to_le16(header);
 758
 759                 if (WARN_ON(payload_cnt > sizeof(msg.payload)))
 760                         payload_cnt = sizeof(msg.payload);
 761
 762                 if (payload_cnt > 0)
 763                         regmap_raw_read(tcpci->regmap, TCPC_RX_DATA,
 764                                         &msg.payload, payload_cnt);
 765
 766                 /* Read complete, clear RX status alert bit */
 767                 tcpci_write16(tcpci, TCPC_ALERT, TCPC_ALERT_RX_STATUS);
 768
 769                 tcpm_pd_receive(tcpci->port, &msg, TCPC_TX_SOP);
 770         }
 771
 772         if (tcpci->data->vbus_vsafe0v && (status & TCPC_ALERT_EXTENDED_STATUS)) {
 773                 ret = regmap_read(tcpci->regmap, TCPC_EXTENDED_STATUS, &raw);
 774                 if (!ret && (raw & TCPC_EXTENDED_STATUS_VSAFE0V))
 775                         tcpm_vbus_change(tcpci->port);
 776         }
 777
 778         if (status & TCPC_ALERT_RX_HARD_RST)
 779                 tcpm_pd_hard_reset(tcpci->port);
 780
 781         if (status & TCPC_ALERT_TX_SUCCESS)
 782                 tcpm_pd_transmit_complete(tcpci->port, TCPC_TX_SUCCESS);
 783         else if (status & TCPC_ALERT_TX_DISCARDED)
 784                 tcpm_pd_transmit_complete(tcpci->port, TCPC_TX_DISCARDED);
 785         else if (status & TCPC_ALERT_TX_FAILED)
 786                 tcpm_pd_transmit_complete(tcpci->port, TCPC_TX_FAILED);
 787
 788         return IRQ_RETVAL(status & tcpci->alert_mask);
 789 }
 790 EXPORT_SYMBOL_GPL(tcpci_irq);
 791
 792 static irqreturn_t _tcpci_irq(int irq, void *dev_id)
 793 {
 794         struct tcpci_chip *chip = dev_id;
 795
 796         return tcpci_irq(chip->tcpci);
 797 }
 798
 799 static const struct regmap_config tcpci_regmap_config = {
 800         .reg_bits = 8,
 801         .val_bits = 8,
 802
 803         .max_register = 0x7F, /* 0x80 .. 0xFF are vendor defined */
 804 };
 805
 806 static int tcpci_parse_config(struct tcpci *tcpci)
 807 {
 808         tcpci->controls_vbus = true; /* XXX */
 809
 810         tcpci->tcpc.fwnode = device_get_named_child_node(tcpci->dev,
 811                                                          "connector");
 812         if (!tcpci->tcpc.fwnode) {
 813                 dev_err(tcpci->dev, "Can't find connector node.\n");
 814                 return -EINVAL;
 815         }
 816
 817         return 0;
 818 }
 819
 820 struct tcpci *tcpci_register_port(struct device *dev, struct tcpci_data *data)
 821 {
 822         struct tcpci *tcpci;
 823         int err;
 824
 825         tcpci = devm_kzalloc(dev, sizeof(*tcpci), GFP_KERNEL);
 826         if (!tcpci)
 827                 return ERR_PTR(-ENOMEM);
 828
 829         tcpci->dev = dev;
 830         tcpci->data = data;
 831         tcpci->regmap = data->regmap;
 832
 833         tcpci->tcpc.init = tcpci_init;
 834         tcpci->tcpc.get_vbus = tcpci_get_vbus;
 835         tcpci->tcpc.set_vbus = tcpci_set_vbus;
 836         tcpci->tcpc.set_cc = tcpci_set_cc;
 837         tcpci->tcpc.apply_rc = tcpci_apply_rc;
 838         tcpci->tcpc.get_cc = tcpci_get_cc;
 839         tcpci->tcpc.set_polarity = tcpci_set_polarity;
 840         tcpci->tcpc.set_vconn = tcpci_set_vconn;
 841         tcpci->tcpc.start_toggling = tcpci_start_toggling;
 842
 843         tcpci->tcpc.set_pd_rx = tcpci_set_pd_rx;
 844         tcpci->tcpc.set_roles = tcpci_set_roles;
 845         tcpci->tcpc.pd_transmit = tcpci_pd_transmit;
 846         tcpci->tcpc.set_bist_data = tcpci_set_bist_data;
 847         tcpci->tcpc.enable_frs = tcpci_enable_frs;
 848         tcpci->tcpc.frs_sourcing_vbus = tcpci_frs_sourcing_vbus;
 849         tcpci->tcpc.set_partner_usb_comm_capable = tcpci_set_partner_usb_comm_capable;
 850         tcpci->tcpc.cable_comm_capable = tcpci_cable_comm_capable;
 851         tcpci->tcpc.attempt_vconn_swap_discovery = tcpci_attempt_vconn_swap_discovery;
 852
 853         if (tcpci->data->check_contaminant)
 854                 tcpci->tcpc.check_contaminant = tcpci_check_contaminant;
 855
 856         if (tcpci->data->auto_discharge_disconnect) {
 857                 tcpci->tcpc.enable_auto_vbus_discharge = tcpci_enable_auto_vbus_discharge;
 858                 tcpci->tcpc.set_auto_vbus_discharge_threshold =
 859                         tcpci_set_auto_vbus_discharge_threshold;
 860                 regmap_update_bits(tcpci->regmap, TCPC_POWER_CTRL, TCPC_POWER_CTRL_BLEED_DISCHARGE,
 861                                    TCPC_POWER_CTRL_BLEED_DISCHARGE);
 862         }
 863
 864         if (tcpci->data->vbus_vsafe0v)
 865                 tcpci->tcpc.is_vbus_vsafe0v = tcpci_is_vbus_vsafe0v;
 866
 867         if (tcpci->data->set_orientation)
 868                 tcpci->tcpc.set_orientation = tcpci_set_orientation;
 869
 870         err = tcpci_parse_config(tcpci);
 871         if (err < 0)
 872                 return ERR_PTR(err);
 873
 874         tcpci->port = tcpm_register_port(tcpci->dev, &tcpci->tcpc);
 875         if (IS_ERR(tcpci->port)) {
 876                 fwnode_handle_put(tcpci->tcpc.fwnode);
 877                 return ERR_CAST(tcpci->port);
 878         }
 879
 880         return tcpci;
 881 }
 882 EXPORT_SYMBOL_GPL(tcpci_register_port);
 883
 884 void tcpci_unregister_port(struct tcpci *tcpci)
 885 {
 886         tcpm_unregister_port(tcpci->port);
 887         fwnode_handle_put(tcpci->tcpc.fwnode);
 888 }
 889 EXPORT_SYMBOL_GPL(tcpci_unregister_port);
 890
 891 static int tcpci_probe(struct i2c_client *client)
 892 {
 893         struct tcpci_chip *chip;
 894         int err;
 895         u16 val = 0;
 896
 897         chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL);
 898         if (!chip)
 899                 return -ENOMEM;
 900
 901         chip->data.regmap = devm_regmap_init_i2c(client, &tcpci_regmap_config);
 902         if (IS_ERR(chip->data.regmap))
 903                 return PTR_ERR(chip->data.regmap);
 904
 905         i2c_set_clientdata(client, chip);
 906
 907         /* Disable chip interrupts before requesting irq */
 908         err = regmap_raw_write(chip->data.regmap, TCPC_ALERT_MASK, &val,
 909                                sizeof(u16));
 910         if (err < 0)
 911                 return err;
 912
 913         err = tcpci_check_std_output_cap(chip->data.regmap,
 914                                          TCPC_STD_OUTPUT_CAP_ORIENTATION);
 915         if (err < 0)
 916                 return err;
 917
 918         chip->data.set_orientation = err;
 919
 920         chip->tcpci = tcpci_register_port(&client->dev, &chip->data);
 921         if (IS_ERR(chip->tcpci))
 922                 return PTR_ERR(chip->tcpci);
 923
 924         err = devm_request_threaded_irq(&client->dev, client->irq, NULL,
 925                                         _tcpci_irq,
 926                                         IRQF_SHARED | IRQF_ONESHOT | IRQF_TRIGGER_LOW,
 927                                         dev_name(&client->dev), chip);
 928         if (err < 0) {
 929                 tcpci_unregister_port(chip->tcpci);
 930                 return err;
 931         }
 932
 933         return 0;
 934 }
 935
 936 static void tcpci_remove(struct i2c_client *client)
 937 {
 938         struct tcpci_chip *chip = i2c_get_clientdata(client);
 939         int err;
 940
 941         /* Disable chip interrupts before unregistering port */
 942         err = tcpci_write16(chip->tcpci, TCPC_ALERT_MASK, 0);
 943         if (err < 0)
 944                 dev_warn(&client->dev, "Failed to disable irqs (%pe)\n", ERR_PTR(err));
 945
 946         tcpci_unregister_port(chip->tcpci);
 947 }
 948
 949 static const struct i2c_device_id tcpci_id[] = {
 950         { "tcpci" },
 951         { }
 952 };
 953 MODULE_DEVICE_TABLE(i2c, tcpci_id);
 954
 955 #ifdef CONFIG_OF
 956 static const struct of_device_id tcpci_of_match[] = {
 957         { .compatible = "nxp,ptn5110", },
 958         { .compatible = "tcpci", },
 959         {},
 960 };
 961 MODULE_DEVICE_TABLE(of, tcpci_of_match);
 962 #endif
 963
 964 static struct i2c_driver tcpci_i2c_driver = {
 965         .driver = {
 966                 .name = "tcpci",
 967                 .of_match_table = of_match_ptr(tcpci_of_match),
 968         },
 969         .probe = tcpci_probe,
 970         .remove = tcpci_remove,
 971         .id_table = tcpci_id,
 972 };
 973 module_i2c_driver(tcpci_i2c_driver);
 974
 975 MODULE_DESCRIPTION("USB Type-C Port Controller Interface driver");
 976 MODULE_LICENSE("GPL");