drivers/usb/typec/mux/intel_pmc_mux.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Driver for Intel PMC USB mux control
   4  *
   5  * Copyright (C) 2020 Intel Corporation
   6  * Author: Heikki Krogerus <heikki.krogerus@linux.intel.com>
   7  */
   8
   9 #include <linux/acpi.h>
  10 #include <linux/module.h>
  11 #include <linux/platform_device.h>
  12 #include <linux/property.h>
  13 #include <linux/usb/pd.h>
  14 #include <linux/usb/role.h>
  15 #include <linux/usb/typec_mux.h>
  16 #include <linux/usb/typec_dp.h>
  17 #include <linux/usb/typec_tbt.h>
  18
  19 #include <asm/intel_scu_ipc.h>
  20
  21 #define PMC_USBC_CMD            0xa7
  22
  23 /* Response status bits */
  24 #define PMC_USB_RESP_STATUS_FAILURE     BIT(0)
  25 #define PMC_USB_RESP_STATUS_FATAL       BIT(1)
  26
  27 /* "Usage" OOB Message field values */
  28 enum {
  29         PMC_USB_CONNECT,
  30         PMC_USB_DISCONNECT,
  31         PMC_USB_SAFE_MODE,
  32         PMC_USB_ALT_MODE,
  33         PMC_USB_DP_HPD,
  34 };
  35
  36 #define PMC_USB_MSG_USB2_PORT_SHIFT     0
  37 #define PMC_USB_MSG_USB3_PORT_SHIFT     4
  38 #define PMC_USB_MSG_UFP_SHIFT           4
  39 #define PMC_USB_MSG_ORI_HSL_SHIFT       5
  40 #define PMC_USB_MSG_ORI_AUX_SHIFT       6
  41
  42 /* Alt Mode Request */
  43 struct altmode_req {
  44         u8 usage;
  45         u8 mode_type;
  46         u8 mode_id;
  47         u8 reserved;
  48         u32 mode_data;
  49 } __packed;
  50
  51 #define PMC_USB_MODE_TYPE_SHIFT         4
  52
  53 enum {
  54         PMC_USB_MODE_TYPE_USB,
  55         PMC_USB_MODE_TYPE_DP,
  56         PMC_USB_MODE_TYPE_TBT,
  57 };
  58
  59 /* Common Mode Data bits */
  60 #define PMC_USB_ALTMODE_ACTIVE_CABLE    BIT(2)
  61
  62 #define PMC_USB_ALTMODE_ORI_SHIFT       1
  63 #define PMC_USB_ALTMODE_UFP_SHIFT       3
  64
  65 /* DP specific Mode Data bits */
  66 #define PMC_USB_ALTMODE_DP_MODE_SHIFT   8
  67
  68 /* TBT specific Mode Data bits */
  69 #define PMC_USB_ALTMODE_TBT_TYPE        BIT(17)
  70 #define PMC_USB_ALTMODE_CABLE_TYPE      BIT(18)
  71 #define PMC_USB_ALTMODE_ACTIVE_LINK     BIT(20)
  72 #define PMC_USB_ALTMODE_FORCE_LSR       BIT(23)
  73 #define PMC_USB_ALTMODE_CABLE_SPD(_s_)  (((_s_) & GENMASK(2, 0)) << 25)
  74 #define   PMC_USB_ALTMODE_CABLE_USB31   1
  75 #define   PMC_USB_ALTMODE_CABLE_10GPS   2
  76 #define   PMC_USB_ALTMODE_CABLE_20GPS   3
  77 #define PMC_USB_ALTMODE_TBT_GEN(_g_)    (((_g_) & GENMASK(1, 0)) << 28)
  78
  79 /* Display HPD Request bits */
  80 #define PMC_USB_DP_HPD_LVL              BIT(4)
  81 #define PMC_USB_DP_HPD_IRQ              BIT(5)
  82
  83 /*
  84  * Input Output Manager (IOM) PORT STATUS
  85  */
  86 #define IOM_PORT_STATUS_ACTIVITY_TYPE_MASK              GENMASK(9, 6)
  87 #define IOM_PORT_STATUS_ACTIVITY_TYPE_SHIFT             6
  88 #define IOM_PORT_STATUS_ACTIVITY_TYPE_USB               0x03
  89 /* activity type: Safe Mode */
  90 #define IOM_PORT_STATUS_ACTIVITY_TYPE_SAFE_MODE         0x04
  91 /* activity type: Display Port */
  92 #define IOM_PORT_STATUS_ACTIVITY_TYPE_DP                0x05
  93 /* activity type: Display Port Multi Function Device */
  94 #define IOM_PORT_STATUS_ACTIVITY_TYPE_DP_MFD            0x06
  95 /* activity type: Thunderbolt */
  96 #define IOM_PORT_STATUS_ACTIVITY_TYPE_TBT               0x07
  97 #define IOM_PORT_STATUS_ACTIVITY_TYPE_ALT_MODE_USB      0x0c
  98 #define IOM_PORT_STATUS_ACTIVITY_TYPE_ALT_MODE_TBT_USB  0x0d
  99 /* Upstream Facing Port Information */
 100 #define IOM_PORT_STATUS_UFP                             BIT(10)
 101 /* Display Port Hot Plug Detect status */
 102 #define IOM_PORT_STATUS_DHPD_HPD_STATUS_MASK            GENMASK(13, 12)
 103 #define IOM_PORT_STATUS_DHPD_HPD_STATUS_SHIFT           12
 104 #define IOM_PORT_STATUS_DHPD_HPD_STATUS_ASSERT          0x01
 105 #define IOM_PORT_STATUS_DHPD_HPD_SOURCE_TBT             BIT(14)
 106 #define IOM_PORT_STATUS_CONNECTED                       BIT(31)
 107
 108 #define IOM_PORT_ACTIVITY_IS(_status_, _type_)                          \
 109         ((((_status_) & IOM_PORT_STATUS_ACTIVITY_TYPE_MASK) >>          \
 110           IOM_PORT_STATUS_ACTIVITY_TYPE_SHIFT) ==                       \
 111          (IOM_PORT_STATUS_ACTIVITY_TYPE_##_type_))
 112
 113 #define IOM_PORT_HPD_ASSERTED(_status_)                                 \
 114         ((((_status_) & IOM_PORT_STATUS_DHPD_HPD_STATUS_MASK) >>        \
 115           IOM_PORT_STATUS_DHPD_HPD_STATUS_SHIFT) &                      \
 116          IOM_PORT_STATUS_DHPD_HPD_STATUS_ASSERT)
 117
 118 struct pmc_usb;
 119
 120 struct pmc_usb_port {
 121         int num;
 122         u32 iom_status;
 123         struct pmc_usb *pmc;
 124         struct typec_mux *typec_mux;
 125         struct typec_switch *typec_sw;
 126         struct usb_role_switch *usb_sw;
 127
 128         enum typec_orientation orientation;
 129         enum usb_role role;
 130
 131         u8 usb2_port;
 132         u8 usb3_port;
 133
 134         enum typec_orientation sbu_orientation;
 135         enum typec_orientation hsl_orientation;
 136 };
 137
 138 struct pmc_usb {
 139         u8 num_ports;
 140         struct device *dev;
 141         struct intel_scu_ipc_dev *ipc;
 142         struct pmc_usb_port *port;
 143         struct acpi_device *iom_adev;
 144         void __iomem *iom_base;
 145         u32 iom_port_status_offset;
 146 };
 147
 148 static void update_port_status(struct pmc_usb_port *port)
 149 {
 150         u8 port_num;
 151
 152         /* SoC expects the USB Type-C port numbers to start with 0 */
 153         port_num = port->usb3_port - 1;
 154
 155         port->iom_status = readl(port->pmc->iom_base +
 156                                  port->pmc->iom_port_status_offset +
 157                                  port_num * sizeof(u32));
 158 }
 159
 160 static int sbu_orientation(struct pmc_usb_port *port)
 161 {
 162         if (port->sbu_orientation)
 163                 return port->sbu_orientation - 1;
 164
 165         return port->orientation - 1;
 166 }
 167
 168 static int hsl_orientation(struct pmc_usb_port *port)
 169 {
 170         if (port->hsl_orientation)
 171                 return port->hsl_orientation - 1;
 172
 173         return port->orientation - 1;
 174 }
 175
 176 static int pmc_usb_command(struct pmc_usb_port *port, u8 *msg, u32 len)
 177 {
 178         u8 response[4];
 179         int ret;
 180
 181         /*
 182          * Error bit will always be 0 with the USBC command.
 183          * Status can be checked from the response message if the
 184          * function intel_scu_ipc_dev_command succeeds.
 185          */
 186         ret = intel_scu_ipc_dev_command(port->pmc->ipc, PMC_USBC_CMD, 0, msg,
 187                                         len, response, sizeof(response));
 188
 189         if (ret)
 190                 return ret;
 191
 192         if (response[2] & PMC_USB_RESP_STATUS_FAILURE) {
 193                 if (response[2] & PMC_USB_RESP_STATUS_FATAL)
 194                         return -EIO;
 195                 return -EBUSY;
 196         }
 197
 198         return 0;
 199 }
 200
 201 static int
 202 pmc_usb_mux_dp_hpd(struct pmc_usb_port *port, struct typec_displayport_data *dp)
 203 {
 204         u8 msg[2] = { };
 205         int ret;
 206
 207         msg[0] = PMC_USB_DP_HPD;
 208         msg[0] |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 209
 210         /* Configure HPD first if HPD,IRQ comes together */
 211         if (!IOM_PORT_HPD_ASSERTED(port->iom_status) &&
 212             dp->status & DP_STATUS_IRQ_HPD &&
 213             dp->status & DP_STATUS_HPD_STATE) {
 214                 msg[1] = PMC_USB_DP_HPD_LVL;
 215                 ret = pmc_usb_command(port, msg, sizeof(msg));
 216                 if (ret)
 217                         return ret;
 218         }
 219
 220         if (dp->status & DP_STATUS_IRQ_HPD)
 221                 msg[1] = PMC_USB_DP_HPD_IRQ;
 222
 223         if (dp->status & DP_STATUS_HPD_STATE)
 224                 msg[1] |= PMC_USB_DP_HPD_LVL;
 225
 226         return pmc_usb_command(port, msg, sizeof(msg));
 227 }
 228
 229 static int
 230 pmc_usb_mux_dp(struct pmc_usb_port *port, struct typec_mux_state *state)
 231 {
 232         struct typec_displayport_data *data = state->data;
 233         struct altmode_req req = { };
 234         int ret;
 235
 236         if (IOM_PORT_ACTIVITY_IS(port->iom_status, DP) ||
 237             IOM_PORT_ACTIVITY_IS(port->iom_status, DP_MFD)) {
 238                 if (IOM_PORT_HPD_ASSERTED(port->iom_status) &&
 239                     (!(data->status & DP_STATUS_IRQ_HPD) &&
 240                      data->status & DP_STATUS_HPD_STATE))
 241                         return 0;
 242
 243                 return pmc_usb_mux_dp_hpd(port, state->data);
 244         }
 245
 246         req.usage = PMC_USB_ALT_MODE;
 247         req.usage |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 248         req.mode_type = PMC_USB_MODE_TYPE_DP << PMC_USB_MODE_TYPE_SHIFT;
 249
 250         req.mode_data = (port->orientation - 1) << PMC_USB_ALTMODE_ORI_SHIFT;
 251         req.mode_data |= (port->role - 1) << PMC_USB_ALTMODE_UFP_SHIFT;
 252
 253         req.mode_data |= (state->mode - TYPEC_STATE_MODAL) <<
 254                          PMC_USB_ALTMODE_DP_MODE_SHIFT;
 255
 256         ret = pmc_usb_command(port, (void *)&req, sizeof(req));
 257         if (ret)
 258                 return ret;
 259
 260         if (data->status & (DP_STATUS_IRQ_HPD | DP_STATUS_HPD_STATE))
 261                 return pmc_usb_mux_dp_hpd(port, state->data);
 262
 263         return 0;
 264 }
 265
 266 static int
 267 pmc_usb_mux_tbt(struct pmc_usb_port *port, struct typec_mux_state *state)
 268 {
 269         struct typec_thunderbolt_data *data = state->data;
 270         u8 cable_speed = TBT_CABLE_SPEED(data->cable_mode);
 271         struct altmode_req req = { };
 272
 273         if (IOM_PORT_ACTIVITY_IS(port->iom_status, TBT) ||
 274             IOM_PORT_ACTIVITY_IS(port->iom_status, ALT_MODE_TBT_USB))
 275                 return 0;
 276
 277         req.usage = PMC_USB_ALT_MODE;
 278         req.usage |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 279         req.mode_type = PMC_USB_MODE_TYPE_TBT << PMC_USB_MODE_TYPE_SHIFT;
 280
 281         req.mode_data = (port->orientation - 1) << PMC_USB_ALTMODE_ORI_SHIFT;
 282         req.mode_data |= (port->role - 1) << PMC_USB_ALTMODE_UFP_SHIFT;
 283
 284         if (TBT_ADAPTER(data->device_mode) == TBT_ADAPTER_TBT3)
 285                 req.mode_data |= PMC_USB_ALTMODE_TBT_TYPE;
 286
 287         if (data->cable_mode & TBT_CABLE_OPTICAL)
 288                 req.mode_data |= PMC_USB_ALTMODE_CABLE_TYPE;
 289
 290         if (data->cable_mode & TBT_CABLE_LINK_TRAINING)
 291                 req.mode_data |= PMC_USB_ALTMODE_ACTIVE_LINK;
 292
 293         if (data->enter_vdo & TBT_ENTER_MODE_ACTIVE_CABLE)
 294                 req.mode_data |= PMC_USB_ALTMODE_ACTIVE_CABLE;
 295
 296         req.mode_data |= PMC_USB_ALTMODE_CABLE_SPD(cable_speed);
 297
 298         return pmc_usb_command(port, (void *)&req, sizeof(req));
 299 }
 300
 301 static int
 302 pmc_usb_mux_usb4(struct pmc_usb_port *port, struct typec_mux_state *state)
 303 {
 304         struct enter_usb_data *data = state->data;
 305         struct altmode_req req = { };
 306         u8 cable_speed;
 307
 308         if (IOM_PORT_ACTIVITY_IS(port->iom_status, TBT) ||
 309             IOM_PORT_ACTIVITY_IS(port->iom_status, ALT_MODE_TBT_USB))
 310                 return 0;
 311
 312         req.usage = PMC_USB_ALT_MODE;
 313         req.usage |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 314         req.mode_type = PMC_USB_MODE_TYPE_TBT << PMC_USB_MODE_TYPE_SHIFT;
 315
 316         /* USB4 Mode */
 317         req.mode_data = PMC_USB_ALTMODE_FORCE_LSR;
 318
 319         if (data->active_link_training)
 320                 req.mode_data |= PMC_USB_ALTMODE_ACTIVE_LINK;
 321
 322         req.mode_data |= (port->orientation - 1) << PMC_USB_ALTMODE_ORI_SHIFT;
 323         req.mode_data |= (port->role - 1) << PMC_USB_ALTMODE_UFP_SHIFT;
 324
 325         switch ((data->eudo & EUDO_CABLE_TYPE_MASK) >> EUDO_CABLE_TYPE_SHIFT) {
 326         case EUDO_CABLE_TYPE_PASSIVE:
 327                 break;
 328         case EUDO_CABLE_TYPE_OPTICAL:
 329                 req.mode_data |= PMC_USB_ALTMODE_CABLE_TYPE;
 330                 fallthrough;
 331         default:
 332                 req.mode_data |= PMC_USB_ALTMODE_ACTIVE_CABLE;
 333                 break;
 334         }
 335
 336         cable_speed = (data->eudo & EUDO_CABLE_SPEED_MASK) >> EUDO_CABLE_SPEED_SHIFT;
 337         req.mode_data |= PMC_USB_ALTMODE_CABLE_SPD(cable_speed);
 338
 339         return pmc_usb_command(port, (void *)&req, sizeof(req));
 340 }
 341
 342 static int pmc_usb_mux_safe_state(struct pmc_usb_port *port)
 343 {
 344         u8 msg;
 345
 346         if (IOM_PORT_ACTIVITY_IS(port->iom_status, SAFE_MODE))
 347                 return 0;
 348
 349         msg = PMC_USB_SAFE_MODE;
 350         msg |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 351
 352         return pmc_usb_command(port, &msg, sizeof(msg));
 353 }
 354
 355 static int pmc_usb_disconnect(struct pmc_usb_port *port)
 356 {
 357         struct typec_displayport_data data = { };
 358         u8 msg[2];
 359
 360         if (!(port->iom_status & IOM_PORT_STATUS_CONNECTED))
 361                 return 0;
 362
 363         /* Clear DisplayPort HPD if it's still asserted. */
 364         if (IOM_PORT_HPD_ASSERTED(port->iom_status))
 365                 pmc_usb_mux_dp_hpd(port, &data);
 366
 367         msg[0] = PMC_USB_DISCONNECT;
 368         msg[0] |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 369
 370         msg[1] = port->usb2_port << PMC_USB_MSG_USB2_PORT_SHIFT;
 371
 372         return pmc_usb_command(port, msg, sizeof(msg));
 373 }
 374
 375 static int pmc_usb_connect(struct pmc_usb_port *port, enum usb_role role)
 376 {
 377         u8 ufp = role == USB_ROLE_DEVICE ? 1 : 0;
 378         u8 msg[2];
 379         int ret;
 380
 381         if (port->orientation == TYPEC_ORIENTATION_NONE)
 382                 return -EINVAL;
 383
 384         if (port->iom_status & IOM_PORT_STATUS_CONNECTED) {
 385                 if (port->role == role || port->role == USB_ROLE_NONE)
 386                         return 0;
 387
 388                 /* Role swap */
 389                 ret = pmc_usb_disconnect(port);
 390                 if (ret)
 391                         return ret;
 392         }
 393
 394         msg[0] = PMC_USB_CONNECT;
 395         msg[0] |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 396
 397         msg[1] = port->usb2_port << PMC_USB_MSG_USB2_PORT_SHIFT;
 398         msg[1] |= ufp << PMC_USB_MSG_UFP_SHIFT;
 399         msg[1] |= hsl_orientation(port) << PMC_USB_MSG_ORI_HSL_SHIFT;
 400         msg[1] |= sbu_orientation(port) << PMC_USB_MSG_ORI_AUX_SHIFT;
 401
 402         return pmc_usb_command(port, msg, sizeof(msg));
 403 }
 404
 405 static int
 406 pmc_usb_mux_set(struct typec_mux *mux, struct typec_mux_state *state)
 407 {
 408         struct pmc_usb_port *port = typec_mux_get_drvdata(mux);
 409
 410         update_port_status(port);
 411
 412         if (port->orientation == TYPEC_ORIENTATION_NONE || port->role == USB_ROLE_NONE)
 413                 return 0;
 414
 415         if (state->mode == TYPEC_STATE_SAFE)
 416                 return pmc_usb_mux_safe_state(port);
 417         if (state->mode == TYPEC_STATE_USB)
 418                 return pmc_usb_connect(port, port->role);
 419
 420         if (state->alt) {
 421                 switch (state->alt->svid) {
 422                 case USB_TYPEC_TBT_SID:
 423                         return pmc_usb_mux_tbt(port, state);
 424                 case USB_TYPEC_DP_SID:
 425                         return pmc_usb_mux_dp(port, state);
 426                 }
 427         } else {
 428                 switch (state->mode) {
 429                 case TYPEC_MODE_USB2:
 430                         /* REVISIT: Try with usb3_port set to 0? */
 431                         break;
 432                 case TYPEC_MODE_USB3:
 433                         return pmc_usb_connect(port, port->role);
 434                 case TYPEC_MODE_USB4:
 435                         return pmc_usb_mux_usb4(port, state);
 436                 }
 437         }
 438
 439         return -EOPNOTSUPP;
 440 }
 441
 442 static int pmc_usb_set_orientation(struct typec_switch *sw,
 443                                    enum typec_orientation orientation)
 444 {
 445         struct pmc_usb_port *port = typec_switch_get_drvdata(sw);
 446
 447         update_port_status(port);
 448
 449         port->orientation = orientation;
 450
 451         return 0;
 452 }
 453
 454 static int pmc_usb_set_role(struct usb_role_switch *sw, enum usb_role role)
 455 {
 456         struct pmc_usb_port *port = usb_role_switch_get_drvdata(sw);
 457         int ret;
 458
 459         update_port_status(port);
 460
 461         if (role == USB_ROLE_NONE)
 462                 ret = pmc_usb_disconnect(port);
 463         else
 464                 ret = pmc_usb_connect(port, role);
 465
 466         port->role = role;
 467
 468         return ret;
 469 }
 470
 471 static int pmc_usb_register_port(struct pmc_usb *pmc, int index,
 472                                  struct fwnode_handle *fwnode)
 473 {
 474         struct pmc_usb_port *port = &pmc->port[index];
 475         struct usb_role_switch_desc desc = { };
 476         struct typec_switch_desc sw_desc = { };
 477         struct typec_mux_desc mux_desc = { };
 478         const char *str;
 479         int ret;
 480
 481         ret = fwnode_property_read_u8(fwnode, "usb2-port-number", &port->usb2_port);
 482         if (ret)
 483                 return ret;
 484
 485         ret = fwnode_property_read_u8(fwnode, "usb3-port-number", &port->usb3_port);
 486         if (ret)
 487                 return ret;
 488
 489         ret = fwnode_property_read_string(fwnode, "sbu-orientation", &str);
 490         if (!ret)
 491                 port->sbu_orientation = typec_find_orientation(str);
 492
 493         ret = fwnode_property_read_string(fwnode, "hsl-orientation", &str);
 494         if (!ret)
 495                 port->hsl_orientation = typec_find_orientation(str);
 496
 497         port->num = index;
 498         port->pmc = pmc;
 499
 500         sw_desc.fwnode = fwnode;
 501         sw_desc.drvdata = port;
 502         sw_desc.name = fwnode_get_name(fwnode);
 503         sw_desc.set = pmc_usb_set_orientation;
 504
 505         port->typec_sw = typec_switch_register(pmc->dev, &sw_desc);
 506         if (IS_ERR(port->typec_sw))
 507                 return PTR_ERR(port->typec_sw);
 508
 509         mux_desc.fwnode = fwnode;
 510         mux_desc.drvdata = port;
 511         mux_desc.name = fwnode_get_name(fwnode);
 512         mux_desc.set = pmc_usb_mux_set;
 513
 514         port->typec_mux = typec_mux_register(pmc->dev, &mux_desc);
 515         if (IS_ERR(port->typec_mux)) {
 516                 ret = PTR_ERR(port->typec_mux);
 517                 goto err_unregister_switch;
 518         }
 519
 520         desc.fwnode = fwnode;
 521         desc.driver_data = port;
 522         desc.name = fwnode_get_name(fwnode);
 523         desc.set = pmc_usb_set_role;
 524
 525         port->usb_sw = usb_role_switch_register(pmc->dev, &desc);
 526         if (IS_ERR(port->usb_sw)) {
 527                 ret = PTR_ERR(port->usb_sw);
 528                 goto err_unregister_mux;
 529         }
 530
 531         return 0;
 532
 533 err_unregister_mux:
 534         typec_mux_unregister(port->typec_mux);
 535
 536 err_unregister_switch:
 537         typec_switch_unregister(port->typec_sw);
 538
 539         return ret;
 540 }
 541
 542 static int is_memory(struct acpi_resource *res, void *data)
 543 {
 544         struct resource_win win = {};
 545         struct resource *r = &win.res;
 546
 547         return !(acpi_dev_resource_memory(res, r) ||
 548                  acpi_dev_resource_address_space(res, &win));
 549 }
 550
 551 /* IOM ACPI IDs and IOM_PORT_STATUS_OFFSET */
 552 static const struct acpi_device_id iom_acpi_ids[] = {
 553         /* TigerLake */
 554         { "INTC1072", 0x560, },
 555
 556         /* AlderLake */
 557         { "INTC1079", 0x160, },
 558
 559         /* Meteor Lake */
 560         { "INTC107A", 0x160, },
 561         {}
 562 };
 563
 564 static int pmc_usb_probe_iom(struct pmc_usb *pmc)
 565 {
 566         struct list_head resource_list;
 567         struct resource_entry *rentry;
 568         static const struct acpi_device_id *dev_id;
 569         struct acpi_device *adev = NULL;
 570         int ret;
 571
 572         for (dev_id = &iom_acpi_ids[0]; dev_id->id[0]; dev_id++) {
 573                 if (acpi_dev_present(dev_id->id, NULL, -1)) {
 574                         pmc->iom_port_status_offset = (u32)dev_id->driver_data;
 575                         adev = acpi_dev_get_first_match_dev(dev_id->id, NULL, -1);
 576                         break;
 577                 }
 578         }
 579
 580         if (!adev)
 581                 return -ENODEV;
 582
 583         INIT_LIST_HEAD(&resource_list);
 584         ret = acpi_dev_get_resources(adev, &resource_list, is_memory, NULL);
 585         if (ret < 0)
 586                 return ret;
 587
 588         rentry = list_first_entry_or_null(&resource_list, struct resource_entry, node);
 589         if (rentry)
 590                 pmc->iom_base = devm_ioremap_resource(pmc->dev, rentry->res);
 591
 592         acpi_dev_free_resource_list(&resource_list);
 593
 594         if (!pmc->iom_base) {
 595                 put_device(&adev->dev);
 596                 return -ENOMEM;
 597         }
 598
 599         if (IS_ERR(pmc->iom_base)) {
 600                 put_device(&adev->dev);
 601                 return PTR_ERR(pmc->iom_base);
 602         }
 603
 604         pmc->iom_adev = adev;
 605
 606         return 0;
 607 }
 608
 609 static int pmc_usb_probe(struct platform_device *pdev)
 610 {
 611         struct fwnode_handle *fwnode = NULL;
 612         struct pmc_usb *pmc;
 613         int i = 0;
 614         int ret;
 615
 616         pmc = devm_kzalloc(&pdev->dev, sizeof(*pmc), GFP_KERNEL);
 617         if (!pmc)
 618                 return -ENOMEM;
 619
 620         device_for_each_child_node(&pdev->dev, fwnode)
 621                 pmc->num_ports++;
 622
 623         /* The IOM microcontroller has a limitation of max 4 ports. */
 624         if (pmc->num_ports > 4) {
 625                 dev_err(&pdev->dev, "driver limited to 4 ports\n");
 626                 return -ERANGE;
 627         }
 628
 629         pmc->port = devm_kcalloc(&pdev->dev, pmc->num_ports,
 630                                  sizeof(struct pmc_usb_port), GFP_KERNEL);
 631         if (!pmc->port)
 632                 return -ENOMEM;
 633
 634         pmc->ipc = devm_intel_scu_ipc_dev_get(&pdev->dev);
 635         if (!pmc->ipc)
 636                 return -ENODEV;
 637
 638         pmc->dev = &pdev->dev;
 639
 640         ret = pmc_usb_probe_iom(pmc);
 641         if (ret)
 642                 return ret;
 643
 644         /*
 645          * For every physical USB connector (USB2 and USB3 combo) there is a
 646          * child ACPI device node under the PMC mux ACPI device object.
 647          */
 648         for (i = 0; i < pmc->num_ports; i++) {
 649                 fwnode = device_get_next_child_node(pmc->dev, fwnode);
 650                 if (!fwnode)
 651                         break;
 652
 653                 ret = pmc_usb_register_port(pmc, i, fwnode);
 654                 if (ret) {
 655                         fwnode_handle_put(fwnode);
 656                         goto err_remove_ports;
 657                 }
 658         }
 659
 660         platform_set_drvdata(pdev, pmc);
 661
 662         return 0;
 663
 664 err_remove_ports:
 665         for (i = 0; i < pmc->num_ports; i++) {
 666                 typec_switch_unregister(pmc->port[i].typec_sw);
 667                 typec_mux_unregister(pmc->port[i].typec_mux);
 668                 usb_role_switch_unregister(pmc->port[i].usb_sw);
 669         }
 670
 671         put_device(&pmc->iom_adev->dev);
 672
 673         return ret;
 674 }
 675
 676 static int pmc_usb_remove(struct platform_device *pdev)
 677 {
 678         struct pmc_usb *pmc = platform_get_drvdata(pdev);
 679         int i;
 680
 681         for (i = 0; i < pmc->num_ports; i++) {
 682                 typec_switch_unregister(pmc->port[i].typec_sw);
 683                 typec_mux_unregister(pmc->port[i].typec_mux);
 684                 usb_role_switch_unregister(pmc->port[i].usb_sw);
 685         }
 686
 687         put_device(&pmc->iom_adev->dev);
 688
 689         return 0;
 690 }
 691
 692 static const struct acpi_device_id pmc_usb_acpi_ids[] = {
 693         { "INTC105C", },
 694         { }
 695 };
 696 MODULE_DEVICE_TABLE(acpi, pmc_usb_acpi_ids);
 697
 698 static struct platform_driver pmc_usb_driver = {
 699         .driver = {
 700                 .name = "intel_pmc_usb",
 701                 .acpi_match_table = ACPI_PTR(pmc_usb_acpi_ids),
 702         },
 703         .probe = pmc_usb_probe,
 704         .remove = pmc_usb_remove,
 705 };
 706
 707 module_platform_driver(pmc_usb_driver);
 708
 709 MODULE_AUTHOR("Heikki Krogerus <heikki.krogerus@linux.intel.com>");
 710 MODULE_LICENSE("GPL v2");
 711 MODULE_DESCRIPTION("Intel PMC USB mux control");