linux/drivers/usb/typec/mux/intel_pmc_mux.c
<<
>>
Prefs
   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 */
  28enum {
  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 */
  43struct 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
  53enum {
  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
 118struct pmc_usb;
 119
 120struct 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
 138struct 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
 148static 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
 160static 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
 168static 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
 176static int pmc_usb_command(struct pmc_usb_port *port, u8 *msg, u32 len)
 177{
 178        u8 response[4];
 179        u8 status_res;
 180        int ret;
 181
 182        /*
 183         * Error bit will always be 0 with the USBC command.
 184         * Status can be checked from the response message if the
 185         * function intel_scu_ipc_dev_command succeeds.
 186         */
 187        ret = intel_scu_ipc_dev_command(port->pmc->ipc, PMC_USBC_CMD, 0, msg,
 188                                        len, response, sizeof(response));
 189
 190        if (ret)
 191                return ret;
 192
 193        status_res = (msg[0] & 0xf) < PMC_USB_SAFE_MODE ?
 194                     response[2] : response[1];
 195
 196        if (status_res & PMC_USB_RESP_STATUS_FAILURE) {
 197                if (status_res & PMC_USB_RESP_STATUS_FATAL)
 198                        return -EIO;
 199
 200                return -EBUSY;
 201        }
 202
 203        return 0;
 204}
 205
 206static int
 207pmc_usb_mux_dp_hpd(struct pmc_usb_port *port, struct typec_displayport_data *dp)
 208{
 209        u8 msg[2] = { };
 210        int ret;
 211
 212        msg[0] = PMC_USB_DP_HPD;
 213        msg[0] |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 214
 215        /* Configure HPD first if HPD,IRQ comes together */
 216        if (!IOM_PORT_HPD_ASSERTED(port->iom_status) &&
 217            dp->status & DP_STATUS_IRQ_HPD &&
 218            dp->status & DP_STATUS_HPD_STATE) {
 219                msg[1] = PMC_USB_DP_HPD_LVL;
 220                ret = pmc_usb_command(port, msg, sizeof(msg));
 221                if (ret)
 222                        return ret;
 223        }
 224
 225        if (dp->status & DP_STATUS_IRQ_HPD)
 226                msg[1] = PMC_USB_DP_HPD_IRQ;
 227
 228        if (dp->status & DP_STATUS_HPD_STATE)
 229                msg[1] |= PMC_USB_DP_HPD_LVL;
 230
 231        return pmc_usb_command(port, msg, sizeof(msg));
 232}
 233
 234static int
 235pmc_usb_mux_dp(struct pmc_usb_port *port, struct typec_mux_state *state)
 236{
 237        struct typec_displayport_data *data = state->data;
 238        struct altmode_req req = { };
 239        int ret;
 240
 241        if (IOM_PORT_ACTIVITY_IS(port->iom_status, DP) ||
 242            IOM_PORT_ACTIVITY_IS(port->iom_status, DP_MFD)) {
 243                if (IOM_PORT_HPD_ASSERTED(port->iom_status) &&
 244                    (!(data->status & DP_STATUS_IRQ_HPD) &&
 245                     data->status & DP_STATUS_HPD_STATE))
 246                        return 0;
 247
 248                return pmc_usb_mux_dp_hpd(port, state->data);
 249        }
 250
 251        req.usage = PMC_USB_ALT_MODE;
 252        req.usage |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 253        req.mode_type = PMC_USB_MODE_TYPE_DP << PMC_USB_MODE_TYPE_SHIFT;
 254
 255        req.mode_data = (port->orientation - 1) << PMC_USB_ALTMODE_ORI_SHIFT;
 256        req.mode_data |= (port->role - 1) << PMC_USB_ALTMODE_UFP_SHIFT;
 257
 258        req.mode_data |= (state->mode - TYPEC_STATE_MODAL) <<
 259                         PMC_USB_ALTMODE_DP_MODE_SHIFT;
 260
 261        ret = pmc_usb_command(port, (void *)&req, sizeof(req));
 262        if (ret)
 263                return ret;
 264
 265        if (data->status & (DP_STATUS_IRQ_HPD | DP_STATUS_HPD_STATE))
 266                return pmc_usb_mux_dp_hpd(port, state->data);
 267
 268        return 0;
 269}
 270
 271static int
 272pmc_usb_mux_tbt(struct pmc_usb_port *port, struct typec_mux_state *state)
 273{
 274        struct typec_thunderbolt_data *data = state->data;
 275        u8 cable_rounded = TBT_CABLE_ROUNDED_SUPPORT(data->cable_mode);
 276        u8 cable_speed = TBT_CABLE_SPEED(data->cable_mode);
 277        struct altmode_req req = { };
 278
 279        if (IOM_PORT_ACTIVITY_IS(port->iom_status, TBT) ||
 280            IOM_PORT_ACTIVITY_IS(port->iom_status, ALT_MODE_TBT_USB))
 281                return 0;
 282
 283        req.usage = PMC_USB_ALT_MODE;
 284        req.usage |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 285        req.mode_type = PMC_USB_MODE_TYPE_TBT << PMC_USB_MODE_TYPE_SHIFT;
 286
 287        req.mode_data = (port->orientation - 1) << PMC_USB_ALTMODE_ORI_SHIFT;
 288        req.mode_data |= (port->role - 1) << PMC_USB_ALTMODE_UFP_SHIFT;
 289
 290        if (TBT_ADAPTER(data->device_mode) == TBT_ADAPTER_TBT3)
 291                req.mode_data |= PMC_USB_ALTMODE_TBT_TYPE;
 292
 293        if (data->cable_mode & TBT_CABLE_OPTICAL)
 294                req.mode_data |= PMC_USB_ALTMODE_CABLE_TYPE;
 295
 296        if (data->cable_mode & TBT_CABLE_LINK_TRAINING)
 297                req.mode_data |= PMC_USB_ALTMODE_ACTIVE_LINK;
 298
 299        if (data->enter_vdo & TBT_ENTER_MODE_ACTIVE_CABLE)
 300                req.mode_data |= PMC_USB_ALTMODE_ACTIVE_CABLE;
 301
 302        req.mode_data |= PMC_USB_ALTMODE_CABLE_SPD(cable_speed);
 303
 304        req.mode_data |= PMC_USB_ALTMODE_TBT_GEN(cable_rounded);
 305
 306        return pmc_usb_command(port, (void *)&req, sizeof(req));
 307}
 308
 309static int
 310pmc_usb_mux_usb4(struct pmc_usb_port *port, struct typec_mux_state *state)
 311{
 312        struct enter_usb_data *data = state->data;
 313        struct altmode_req req = { };
 314        u8 cable_speed;
 315
 316        if (IOM_PORT_ACTIVITY_IS(port->iom_status, TBT) ||
 317            IOM_PORT_ACTIVITY_IS(port->iom_status, ALT_MODE_TBT_USB))
 318                return 0;
 319
 320        req.usage = PMC_USB_ALT_MODE;
 321        req.usage |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 322        req.mode_type = PMC_USB_MODE_TYPE_TBT << PMC_USB_MODE_TYPE_SHIFT;
 323
 324        /* USB4 Mode */
 325        req.mode_data = PMC_USB_ALTMODE_FORCE_LSR;
 326
 327        if (data->active_link_training)
 328                req.mode_data |= PMC_USB_ALTMODE_ACTIVE_LINK;
 329
 330        req.mode_data |= (port->orientation - 1) << PMC_USB_ALTMODE_ORI_SHIFT;
 331        req.mode_data |= (port->role - 1) << PMC_USB_ALTMODE_UFP_SHIFT;
 332
 333        switch ((data->eudo & EUDO_CABLE_TYPE_MASK) >> EUDO_CABLE_TYPE_SHIFT) {
 334        case EUDO_CABLE_TYPE_PASSIVE:
 335                break;
 336        case EUDO_CABLE_TYPE_OPTICAL:
 337                req.mode_data |= PMC_USB_ALTMODE_CABLE_TYPE;
 338                fallthrough;
 339        default:
 340                req.mode_data |= PMC_USB_ALTMODE_ACTIVE_CABLE;
 341
 342                /* Configure data rate to rounded in the case of Active TBT3
 343                 * and USB4 cables.
 344                 */
 345                req.mode_data |= PMC_USB_ALTMODE_TBT_GEN(1);
 346                break;
 347        }
 348
 349        cable_speed = (data->eudo & EUDO_CABLE_SPEED_MASK) >> EUDO_CABLE_SPEED_SHIFT;
 350        req.mode_data |= PMC_USB_ALTMODE_CABLE_SPD(cable_speed);
 351
 352        return pmc_usb_command(port, (void *)&req, sizeof(req));
 353}
 354
 355static int pmc_usb_mux_safe_state(struct pmc_usb_port *port)
 356{
 357        u8 msg;
 358
 359        if (IOM_PORT_ACTIVITY_IS(port->iom_status, SAFE_MODE))
 360                return 0;
 361
 362        msg = PMC_USB_SAFE_MODE;
 363        msg |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 364
 365        return pmc_usb_command(port, &msg, sizeof(msg));
 366}
 367
 368static int pmc_usb_disconnect(struct pmc_usb_port *port)
 369{
 370        struct typec_displayport_data data = { };
 371        u8 msg[2];
 372
 373        if (!(port->iom_status & IOM_PORT_STATUS_CONNECTED))
 374                return 0;
 375
 376        /* Clear DisplayPort HPD if it's still asserted. */
 377        if (IOM_PORT_HPD_ASSERTED(port->iom_status))
 378                pmc_usb_mux_dp_hpd(port, &data);
 379
 380        msg[0] = PMC_USB_DISCONNECT;
 381        msg[0] |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 382
 383        msg[1] = port->usb2_port << PMC_USB_MSG_USB2_PORT_SHIFT;
 384
 385        return pmc_usb_command(port, msg, sizeof(msg));
 386}
 387
 388static int pmc_usb_connect(struct pmc_usb_port *port, enum usb_role role)
 389{
 390        u8 ufp = role == USB_ROLE_DEVICE ? 1 : 0;
 391        u8 msg[2];
 392        int ret;
 393
 394        if (port->orientation == TYPEC_ORIENTATION_NONE)
 395                return -EINVAL;
 396
 397        if (port->iom_status & IOM_PORT_STATUS_CONNECTED) {
 398                if (port->role == role || port->role == USB_ROLE_NONE)
 399                        return 0;
 400
 401                /* Role swap */
 402                ret = pmc_usb_disconnect(port);
 403                if (ret)
 404                        return ret;
 405        }
 406
 407        msg[0] = PMC_USB_CONNECT;
 408        msg[0] |= port->usb3_port << PMC_USB_MSG_USB3_PORT_SHIFT;
 409
 410        msg[1] = port->usb2_port << PMC_USB_MSG_USB2_PORT_SHIFT;
 411        msg[1] |= ufp << PMC_USB_MSG_UFP_SHIFT;
 412        msg[1] |= hsl_orientation(port) << PMC_USB_MSG_ORI_HSL_SHIFT;
 413        msg[1] |= sbu_orientation(port) << PMC_USB_MSG_ORI_AUX_SHIFT;
 414
 415        return pmc_usb_command(port, msg, sizeof(msg));
 416}
 417
 418static int
 419pmc_usb_mux_set(struct typec_mux *mux, struct typec_mux_state *state)
 420{
 421        struct pmc_usb_port *port = typec_mux_get_drvdata(mux);
 422
 423        update_port_status(port);
 424
 425        if (port->orientation == TYPEC_ORIENTATION_NONE || port->role == USB_ROLE_NONE)
 426                return 0;
 427
 428        if (state->mode == TYPEC_STATE_SAFE)
 429                return pmc_usb_mux_safe_state(port);
 430        if (state->mode == TYPEC_STATE_USB)
 431                return pmc_usb_connect(port, port->role);
 432
 433        if (state->alt) {
 434                switch (state->alt->svid) {
 435                case USB_TYPEC_TBT_SID:
 436                        return pmc_usb_mux_tbt(port, state);
 437                case USB_TYPEC_DP_SID:
 438                        return pmc_usb_mux_dp(port, state);
 439                }
 440        } else {
 441                switch (state->mode) {
 442                case TYPEC_MODE_USB2:
 443                        /* REVISIT: Try with usb3_port set to 0? */
 444                        break;
 445                case TYPEC_MODE_USB3:
 446                        return pmc_usb_connect(port, port->role);
 447                case TYPEC_MODE_USB4:
 448                        return pmc_usb_mux_usb4(port, state);
 449                }
 450        }
 451
 452        return -EOPNOTSUPP;
 453}
 454
 455static int pmc_usb_set_orientation(struct typec_switch *sw,
 456                                   enum typec_orientation orientation)
 457{
 458        struct pmc_usb_port *port = typec_switch_get_drvdata(sw);
 459
 460        update_port_status(port);
 461
 462        port->orientation = orientation;
 463
 464        return 0;
 465}
 466
 467static int pmc_usb_set_role(struct usb_role_switch *sw, enum usb_role role)
 468{
 469        struct pmc_usb_port *port = usb_role_switch_get_drvdata(sw);
 470        int ret;
 471
 472        update_port_status(port);
 473
 474        if (role == USB_ROLE_NONE)
 475                ret = pmc_usb_disconnect(port);
 476        else
 477                ret = pmc_usb_connect(port, role);
 478
 479        port->role = role;
 480
 481        return ret;
 482}
 483
 484static int pmc_usb_register_port(struct pmc_usb *pmc, int index,
 485                                 struct fwnode_handle *fwnode)
 486{
 487        struct pmc_usb_port *port = &pmc->port[index];
 488        struct usb_role_switch_desc desc = { };
 489        struct typec_switch_desc sw_desc = { };
 490        struct typec_mux_desc mux_desc = { };
 491        const char *str;
 492        int ret;
 493
 494        ret = fwnode_property_read_u8(fwnode, "usb2-port-number", &port->usb2_port);
 495        if (ret)
 496                return ret;
 497
 498        ret = fwnode_property_read_u8(fwnode, "usb3-port-number", &port->usb3_port);
 499        if (ret)
 500                return ret;
 501
 502        ret = fwnode_property_read_string(fwnode, "sbu-orientation", &str);
 503        if (!ret)
 504                port->sbu_orientation = typec_find_orientation(str);
 505
 506        ret = fwnode_property_read_string(fwnode, "hsl-orientation", &str);
 507        if (!ret)
 508                port->hsl_orientation = typec_find_orientation(str);
 509
 510        port->num = index;
 511        port->pmc = pmc;
 512
 513        sw_desc.fwnode = fwnode;
 514        sw_desc.drvdata = port;
 515        sw_desc.name = fwnode_get_name(fwnode);
 516        sw_desc.set = pmc_usb_set_orientation;
 517
 518        port->typec_sw = typec_switch_register(pmc->dev, &sw_desc);
 519        if (IS_ERR(port->typec_sw))
 520                return PTR_ERR(port->typec_sw);
 521
 522        mux_desc.fwnode = fwnode;
 523        mux_desc.drvdata = port;
 524        mux_desc.name = fwnode_get_name(fwnode);
 525        mux_desc.set = pmc_usb_mux_set;
 526
 527        port->typec_mux = typec_mux_register(pmc->dev, &mux_desc);
 528        if (IS_ERR(port->typec_mux)) {
 529                ret = PTR_ERR(port->typec_mux);
 530                goto err_unregister_switch;
 531        }
 532
 533        desc.fwnode = fwnode;
 534        desc.driver_data = port;
 535        desc.name = fwnode_get_name(fwnode);
 536        desc.set = pmc_usb_set_role;
 537
 538        port->usb_sw = usb_role_switch_register(pmc->dev, &desc);
 539        if (IS_ERR(port->usb_sw)) {
 540                ret = PTR_ERR(port->usb_sw);
 541                goto err_unregister_mux;
 542        }
 543
 544        return 0;
 545
 546err_unregister_mux:
 547        typec_mux_unregister(port->typec_mux);
 548
 549err_unregister_switch:
 550        typec_switch_unregister(port->typec_sw);
 551
 552        return ret;
 553}
 554
 555static int is_memory(struct acpi_resource *res, void *data)
 556{
 557        struct resource r;
 558
 559        return !acpi_dev_resource_memory(res, &r);
 560}
 561
 562/* IOM ACPI IDs and IOM_PORT_STATUS_OFFSET */
 563static const struct acpi_device_id iom_acpi_ids[] = {
 564        /* TigerLake */
 565        { "INTC1072", 0x560, },
 566
 567        /* AlderLake */
 568        { "INTC1079", 0x160, },
 569        {}
 570};
 571
 572static int pmc_usb_probe_iom(struct pmc_usb *pmc)
 573{
 574        struct list_head resource_list;
 575        struct resource_entry *rentry;
 576        static const struct acpi_device_id *dev_id;
 577        struct acpi_device *adev = NULL;
 578        int ret;
 579
 580        for (dev_id = &iom_acpi_ids[0]; dev_id->id[0]; dev_id++) {
 581                if (acpi_dev_present(dev_id->id, NULL, -1)) {
 582                        pmc->iom_port_status_offset = (u32)dev_id->driver_data;
 583                        adev = acpi_dev_get_first_match_dev(dev_id->id, NULL, -1);
 584                        break;
 585                }
 586        }
 587
 588        if (!adev)
 589                return -ENODEV;
 590
 591        INIT_LIST_HEAD(&resource_list);
 592        ret = acpi_dev_get_resources(adev, &resource_list, is_memory, NULL);
 593        if (ret < 0)
 594                return ret;
 595
 596        rentry = list_first_entry_or_null(&resource_list, struct resource_entry, node);
 597        if (rentry)
 598                pmc->iom_base = devm_ioremap_resource(pmc->dev, rentry->res);
 599
 600        acpi_dev_free_resource_list(&resource_list);
 601
 602        if (!pmc->iom_base) {
 603                acpi_dev_put(adev);
 604                return -ENOMEM;
 605        }
 606
 607        if (IS_ERR(pmc->iom_base)) {
 608                acpi_dev_put(adev);
 609                return PTR_ERR(pmc->iom_base);
 610        }
 611
 612        pmc->iom_adev = adev;
 613
 614        return 0;
 615}
 616
 617static int pmc_usb_probe(struct platform_device *pdev)
 618{
 619        struct fwnode_handle *fwnode = NULL;
 620        struct pmc_usb *pmc;
 621        int i = 0;
 622        int ret;
 623
 624        pmc = devm_kzalloc(&pdev->dev, sizeof(*pmc), GFP_KERNEL);
 625        if (!pmc)
 626                return -ENOMEM;
 627
 628        device_for_each_child_node(&pdev->dev, fwnode)
 629                pmc->num_ports++;
 630
 631        /* The IOM microcontroller has a limitation of max 4 ports. */
 632        if (pmc->num_ports > 4) {
 633                dev_err(&pdev->dev, "driver limited to 4 ports\n");
 634                return -ERANGE;
 635        }
 636
 637        pmc->port = devm_kcalloc(&pdev->dev, pmc->num_ports,
 638                                 sizeof(struct pmc_usb_port), GFP_KERNEL);
 639        if (!pmc->port)
 640                return -ENOMEM;
 641
 642        pmc->ipc = devm_intel_scu_ipc_dev_get(&pdev->dev);
 643        if (!pmc->ipc)
 644                return -ENODEV;
 645
 646        pmc->dev = &pdev->dev;
 647
 648        ret = pmc_usb_probe_iom(pmc);
 649        if (ret)
 650                return ret;
 651
 652        /*
 653         * For every physical USB connector (USB2 and USB3 combo) there is a
 654         * child ACPI device node under the PMC mux ACPI device object.
 655         */
 656        for (i = 0; i < pmc->num_ports; i++) {
 657                fwnode = device_get_next_child_node(pmc->dev, fwnode);
 658                if (!fwnode)
 659                        break;
 660
 661                ret = pmc_usb_register_port(pmc, i, fwnode);
 662                if (ret) {
 663                        fwnode_handle_put(fwnode);
 664                        goto err_remove_ports;
 665                }
 666        }
 667
 668        platform_set_drvdata(pdev, pmc);
 669
 670        return 0;
 671
 672err_remove_ports:
 673        for (i = 0; i < pmc->num_ports; i++) {
 674                typec_switch_unregister(pmc->port[i].typec_sw);
 675                typec_mux_unregister(pmc->port[i].typec_mux);
 676                usb_role_switch_unregister(pmc->port[i].usb_sw);
 677        }
 678
 679        acpi_dev_put(pmc->iom_adev);
 680
 681        return ret;
 682}
 683
 684static int pmc_usb_remove(struct platform_device *pdev)
 685{
 686        struct pmc_usb *pmc = platform_get_drvdata(pdev);
 687        int i;
 688
 689        for (i = 0; i < pmc->num_ports; i++) {
 690                typec_switch_unregister(pmc->port[i].typec_sw);
 691                typec_mux_unregister(pmc->port[i].typec_mux);
 692                usb_role_switch_unregister(pmc->port[i].usb_sw);
 693        }
 694
 695        acpi_dev_put(pmc->iom_adev);
 696
 697        return 0;
 698}
 699
 700static const struct acpi_device_id pmc_usb_acpi_ids[] = {
 701        { "INTC105C", },
 702        { }
 703};
 704MODULE_DEVICE_TABLE(acpi, pmc_usb_acpi_ids);
 705
 706static struct platform_driver pmc_usb_driver = {
 707        .driver = {
 708                .name = "intel_pmc_usb",
 709                .acpi_match_table = ACPI_PTR(pmc_usb_acpi_ids),
 710        },
 711        .probe = pmc_usb_probe,
 712        .remove = pmc_usb_remove,
 713};
 714
 715module_platform_driver(pmc_usb_driver);
 716
 717MODULE_AUTHOR("Heikki Krogerus <heikki.krogerus@linux.intel.com>");
 718MODULE_LICENSE("GPL v2");
 719MODULE_DESCRIPTION("Intel PMC USB mux control");
 720