drivers/gpu/drm/msm/hdmi/hdmi.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (c) 2014 The Linux Foundation. All rights reserved.
   4  * Copyright (C) 2013 Red Hat
   5  * Author: Rob Clark <[email protected]>
   6  */
   7
   8 #include <linux/of_irq.h>
   9 #include <linux/of_gpio.h>
  10
  11 #include <drm/drm_bridge_connector.h>
  12
  13 #include <sound/hdmi-codec.h>
  14 #include "hdmi.h"
  15
  16 void msm_hdmi_set_mode(struct hdmi *hdmi, bool power_on)
  17 {
  18         uint32_t ctrl = 0;
  19         unsigned long flags;
  20
  21         spin_lock_irqsave(&hdmi->reg_lock, flags);
  22         if (power_on) {
  23                 ctrl |= HDMI_CTRL_ENABLE;
  24                 if (!hdmi->hdmi_mode) {
  25                         ctrl |= HDMI_CTRL_HDMI;
  26                         hdmi_write(hdmi, REG_HDMI_CTRL, ctrl);
  27                         ctrl &= ~HDMI_CTRL_HDMI;
  28                 } else {
  29                         ctrl |= HDMI_CTRL_HDMI;
  30                 }
  31         } else {
  32                 ctrl = HDMI_CTRL_HDMI;
  33         }
  34
  35         hdmi_write(hdmi, REG_HDMI_CTRL, ctrl);
  36         spin_unlock_irqrestore(&hdmi->reg_lock, flags);
  37         DBG("HDMI Core: %s, HDMI_CTRL=0x%08x",
  38                         power_on ? "Enable" : "Disable", ctrl);
  39 }
  40
  41 static irqreturn_t msm_hdmi_irq(int irq, void *dev_id)
  42 {
  43         struct hdmi *hdmi = dev_id;
  44
  45         /* Process HPD: */
  46         msm_hdmi_hpd_irq(hdmi->bridge);
  47
  48         /* Process DDC: */
  49         msm_hdmi_i2c_irq(hdmi->i2c);
  50
  51         /* Process HDCP: */
  52         if (hdmi->hdcp_ctrl)
  53                 msm_hdmi_hdcp_irq(hdmi->hdcp_ctrl);
  54
  55         /* TODO audio.. */
  56
  57         return IRQ_HANDLED;
  58 }
  59
  60 static void msm_hdmi_destroy(struct hdmi *hdmi)
  61 {
  62         /*
  63          * at this point, hpd has been disabled,
  64          * after flush workq, it's safe to deinit hdcp
  65          */
  66         if (hdmi->workq)
  67                 destroy_workqueue(hdmi->workq);
  68         msm_hdmi_hdcp_destroy(hdmi);
  69
  70         if (hdmi->phy_dev) {
  71                 put_device(hdmi->phy_dev);
  72                 hdmi->phy = NULL;
  73                 hdmi->phy_dev = NULL;
  74         }
  75
  76         if (hdmi->i2c)
  77                 msm_hdmi_i2c_destroy(hdmi->i2c);
  78
  79         platform_set_drvdata(hdmi->pdev, NULL);
  80 }
  81
  82 static int msm_hdmi_get_phy(struct hdmi *hdmi)
  83 {
  84         struct platform_device *pdev = hdmi->pdev;
  85         struct platform_device *phy_pdev;
  86         struct device_node *phy_node;
  87
  88         phy_node = of_parse_phandle(pdev->dev.of_node, "phys", 0);
  89         if (!phy_node) {
  90                 DRM_DEV_ERROR(&pdev->dev, "cannot find phy device\n");
  91                 return -ENXIO;
  92         }
  93
  94         phy_pdev = of_find_device_by_node(phy_node);
  95         if (phy_pdev)
  96                 hdmi->phy = platform_get_drvdata(phy_pdev);
  97
  98         of_node_put(phy_node);
  99
 100         if (!phy_pdev || !hdmi->phy) {
 101                 DRM_DEV_ERROR(&pdev->dev, "phy driver is not ready\n");
 102                 return -EPROBE_DEFER;
 103         }
 104
 105         hdmi->phy_dev = get_device(&phy_pdev->dev);
 106
 107         return 0;
 108 }
 109
 110 /* construct hdmi at bind/probe time, grab all the resources.  If
 111  * we are to EPROBE_DEFER we want to do it here, rather than later
 112  * at modeset_init() time
 113  */
 114 static struct hdmi *msm_hdmi_init(struct platform_device *pdev)
 115 {
 116         struct hdmi_platform_config *config = pdev->dev.platform_data;
 117         struct hdmi *hdmi = NULL;
 118         struct resource *res;
 119         int i, ret;
 120
 121         hdmi = devm_kzalloc(&pdev->dev, sizeof(*hdmi), GFP_KERNEL);
 122         if (!hdmi) {
 123                 ret = -ENOMEM;
 124                 goto fail;
 125         }
 126
 127         hdmi->pdev = pdev;
 128         hdmi->config = config;
 129         spin_lock_init(&hdmi->reg_lock);
 130
 131         hdmi->mmio = msm_ioremap(pdev, config->mmio_name, "HDMI");
 132         if (IS_ERR(hdmi->mmio)) {
 133                 ret = PTR_ERR(hdmi->mmio);
 134                 goto fail;
 135         }
 136
 137         /* HDCP needs physical address of hdmi register */
 138         res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
 139                 config->mmio_name);
 140         hdmi->mmio_phy_addr = res->start;
 141
 142         hdmi->qfprom_mmio = msm_ioremap(pdev,
 143                 config->qfprom_mmio_name, "HDMI_QFPROM");
 144         if (IS_ERR(hdmi->qfprom_mmio)) {
 145                 DRM_DEV_INFO(&pdev->dev, "can't find qfprom resource\n");
 146                 hdmi->qfprom_mmio = NULL;
 147         }
 148
 149         hdmi->hpd_regs = devm_kcalloc(&pdev->dev,
 150                                       config->hpd_reg_cnt,
 151                                       sizeof(hdmi->hpd_regs[0]),
 152                                       GFP_KERNEL);
 153         if (!hdmi->hpd_regs) {
 154                 ret = -ENOMEM;
 155                 goto fail;
 156         }
 157         for (i = 0; i < config->hpd_reg_cnt; i++)
 158                 hdmi->hpd_regs[i].supply = config->hpd_reg_names[i];
 159
 160         ret = devm_regulator_bulk_get(&pdev->dev, config->hpd_reg_cnt, hdmi->hpd_regs);
 161         if (ret) {
 162                 DRM_DEV_ERROR(&pdev->dev, "failed to get hpd regulator: %d\n", ret);
 163                 goto fail;
 164         }
 165
 166         hdmi->pwr_regs = devm_kcalloc(&pdev->dev,
 167                                       config->pwr_reg_cnt,
 168                                       sizeof(hdmi->pwr_regs[0]),
 169                                       GFP_KERNEL);
 170         if (!hdmi->pwr_regs) {
 171                 ret = -ENOMEM;
 172                 goto fail;
 173         }
 174
 175         ret = devm_regulator_bulk_get(&pdev->dev, config->pwr_reg_cnt, hdmi->pwr_regs);
 176         if (ret) {
 177                 DRM_DEV_ERROR(&pdev->dev, "failed to get pwr regulator: %d\n", ret);
 178                 goto fail;
 179         }
 180
 181         hdmi->hpd_clks = devm_kcalloc(&pdev->dev,
 182                                       config->hpd_clk_cnt,
 183                                       sizeof(hdmi->hpd_clks[0]),
 184                                       GFP_KERNEL);
 185         if (!hdmi->hpd_clks) {
 186                 ret = -ENOMEM;
 187                 goto fail;
 188         }
 189         for (i = 0; i < config->hpd_clk_cnt; i++) {
 190                 struct clk *clk;
 191
 192                 clk = msm_clk_get(pdev, config->hpd_clk_names[i]);
 193                 if (IS_ERR(clk)) {
 194                         ret = PTR_ERR(clk);
 195                         DRM_DEV_ERROR(&pdev->dev, "failed to get hpd clk: %s (%d)\n",
 196                                         config->hpd_clk_names[i], ret);
 197                         goto fail;
 198                 }
 199
 200                 hdmi->hpd_clks[i] = clk;
 201         }
 202
 203         hdmi->pwr_clks = devm_kcalloc(&pdev->dev,
 204                                       config->pwr_clk_cnt,
 205                                       sizeof(hdmi->pwr_clks[0]),
 206                                       GFP_KERNEL);
 207         if (!hdmi->pwr_clks) {
 208                 ret = -ENOMEM;
 209                 goto fail;
 210         }
 211         for (i = 0; i < config->pwr_clk_cnt; i++) {
 212                 struct clk *clk;
 213
 214                 clk = msm_clk_get(pdev, config->pwr_clk_names[i]);
 215                 if (IS_ERR(clk)) {
 216                         ret = PTR_ERR(clk);
 217                         DRM_DEV_ERROR(&pdev->dev, "failed to get pwr clk: %s (%d)\n",
 218                                         config->pwr_clk_names[i], ret);
 219                         goto fail;
 220                 }
 221
 222                 hdmi->pwr_clks[i] = clk;
 223         }
 224
 225         pm_runtime_enable(&pdev->dev);
 226
 227         hdmi->workq = alloc_ordered_workqueue("msm_hdmi", 0);
 228
 229         hdmi->i2c = msm_hdmi_i2c_init(hdmi);
 230         if (IS_ERR(hdmi->i2c)) {
 231                 ret = PTR_ERR(hdmi->i2c);
 232                 DRM_DEV_ERROR(&pdev->dev, "failed to get i2c: %d\n", ret);
 233                 hdmi->i2c = NULL;
 234                 goto fail;
 235         }
 236
 237         ret = msm_hdmi_get_phy(hdmi);
 238         if (ret) {
 239                 DRM_DEV_ERROR(&pdev->dev, "failed to get phy\n");
 240                 goto fail;
 241         }
 242
 243         hdmi->hdcp_ctrl = msm_hdmi_hdcp_init(hdmi);
 244         if (IS_ERR(hdmi->hdcp_ctrl)) {
 245                 dev_warn(&pdev->dev, "failed to init hdcp: disabled\n");
 246                 hdmi->hdcp_ctrl = NULL;
 247         }
 248
 249         return hdmi;
 250
 251 fail:
 252         if (hdmi)
 253                 msm_hdmi_destroy(hdmi);
 254
 255         return ERR_PTR(ret);
 256 }
 257
 258 /* Second part of initialization, the drm/kms level modeset_init,
 259  * constructs/initializes mode objects, etc, is called from master
 260  * driver (not hdmi sub-device's probe/bind!)
 261  *
 262  * Any resource (regulator/clk/etc) which could be missing at boot
 263  * should be handled in msm_hdmi_init() so that failure happens from
 264  * hdmi sub-device's probe.
 265  */
 266 int msm_hdmi_modeset_init(struct hdmi *hdmi,
 267                 struct drm_device *dev, struct drm_encoder *encoder)
 268 {
 269         struct msm_drm_private *priv = dev->dev_private;
 270         struct platform_device *pdev = hdmi->pdev;
 271         int ret;
 272
 273         hdmi->dev = dev;
 274         hdmi->encoder = encoder;
 275
 276         hdmi_audio_infoframe_init(&hdmi->audio.infoframe);
 277
 278         hdmi->bridge = msm_hdmi_bridge_init(hdmi);
 279         if (IS_ERR(hdmi->bridge)) {
 280                 ret = PTR_ERR(hdmi->bridge);
 281                 DRM_DEV_ERROR(dev->dev, "failed to create HDMI bridge: %d\n", ret);
 282                 hdmi->bridge = NULL;
 283                 goto fail;
 284         }
 285
 286         hdmi->connector = drm_bridge_connector_init(hdmi->dev, encoder);
 287         if (IS_ERR(hdmi->connector)) {
 288                 ret = PTR_ERR(hdmi->connector);
 289                 DRM_DEV_ERROR(dev->dev, "failed to create HDMI connector: %d\n", ret);
 290                 hdmi->connector = NULL;
 291                 goto fail;
 292         }
 293
 294         drm_connector_attach_encoder(hdmi->connector, hdmi->encoder);
 295
 296         hdmi->irq = irq_of_parse_and_map(pdev->dev.of_node, 0);
 297         if (hdmi->irq < 0) {
 298                 ret = hdmi->irq;
 299                 DRM_DEV_ERROR(dev->dev, "failed to get irq: %d\n", ret);
 300                 goto fail;
 301         }
 302
 303         ret = devm_request_irq(&pdev->dev, hdmi->irq,
 304                         msm_hdmi_irq, IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
 305                         "hdmi_isr", hdmi);
 306         if (ret < 0) {
 307                 DRM_DEV_ERROR(dev->dev, "failed to request IRQ%u: %d\n",
 308                                 hdmi->irq, ret);
 309                 goto fail;
 310         }
 311
 312         drm_bridge_connector_enable_hpd(hdmi->connector);
 313
 314         ret = msm_hdmi_hpd_enable(hdmi->bridge);
 315         if (ret < 0) {
 316                 DRM_DEV_ERROR(&hdmi->pdev->dev, "failed to enable HPD: %d\n", ret);
 317                 goto fail;
 318         }
 319
 320         priv->bridges[priv->num_bridges++]       = hdmi->bridge;
 321         priv->connectors[priv->num_connectors++] = hdmi->connector;
 322
 323         platform_set_drvdata(pdev, hdmi);
 324
 325         return 0;
 326
 327 fail:
 328         /* bridge is normally destroyed by drm: */
 329         if (hdmi->bridge) {
 330                 msm_hdmi_bridge_destroy(hdmi->bridge);
 331                 hdmi->bridge = NULL;
 332         }
 333         if (hdmi->connector) {
 334                 hdmi->connector->funcs->destroy(hdmi->connector);
 335                 hdmi->connector = NULL;
 336         }
 337
 338         return ret;
 339 }
 340
 341 /*
 342  * The hdmi device:
 343  */
 344
 345 #define HDMI_CFG(item, entry) \
 346         .item ## _names = item ##_names_ ## entry, \
 347         .item ## _cnt   = ARRAY_SIZE(item ## _names_ ## entry)
 348
 349 static const char *pwr_reg_names_none[] = {};
 350 static const char *hpd_reg_names_none[] = {};
 351
 352 static struct hdmi_platform_config hdmi_tx_8660_config;
 353
 354 static const char *hpd_reg_names_8960[] = {"core-vdda", "hdmi-mux"};
 355 static const char *hpd_clk_names_8960[] = {"core", "master_iface", "slave_iface"};
 356
 357 static struct hdmi_platform_config hdmi_tx_8960_config = {
 358                 HDMI_CFG(hpd_reg, 8960),
 359                 HDMI_CFG(hpd_clk, 8960),
 360 };
 361
 362 static const char *pwr_reg_names_8x74[] = {"core-vdda", "core-vcc"};
 363 static const char *hpd_reg_names_8x74[] = {"hpd-gdsc", "hpd-5v"};
 364 static const char *pwr_clk_names_8x74[] = {"extp", "alt_iface"};
 365 static const char *hpd_clk_names_8x74[] = {"iface", "core", "mdp_core"};
 366 static unsigned long hpd_clk_freq_8x74[] = {0, 19200000, 0};
 367
 368 static struct hdmi_platform_config hdmi_tx_8974_config = {
 369                 HDMI_CFG(pwr_reg, 8x74),
 370                 HDMI_CFG(hpd_reg, 8x74),
 371                 HDMI_CFG(pwr_clk, 8x74),
 372                 HDMI_CFG(hpd_clk, 8x74),
 373                 .hpd_freq      = hpd_clk_freq_8x74,
 374 };
 375
 376 static const char *hpd_reg_names_8084[] = {"hpd-gdsc", "hpd-5v", "hpd-5v-en"};
 377
 378 static struct hdmi_platform_config hdmi_tx_8084_config = {
 379                 HDMI_CFG(pwr_reg, 8x74),
 380                 HDMI_CFG(hpd_reg, 8084),
 381                 HDMI_CFG(pwr_clk, 8x74),
 382                 HDMI_CFG(hpd_clk, 8x74),
 383                 .hpd_freq      = hpd_clk_freq_8x74,
 384 };
 385
 386 static struct hdmi_platform_config hdmi_tx_8994_config = {
 387                 HDMI_CFG(pwr_reg, 8x74),
 388                 HDMI_CFG(hpd_reg, none),
 389                 HDMI_CFG(pwr_clk, 8x74),
 390                 HDMI_CFG(hpd_clk, 8x74),
 391                 .hpd_freq      = hpd_clk_freq_8x74,
 392 };
 393
 394 static struct hdmi_platform_config hdmi_tx_8996_config = {
 395                 HDMI_CFG(pwr_reg, none),
 396                 HDMI_CFG(hpd_reg, none),
 397                 HDMI_CFG(pwr_clk, 8x74),
 398                 HDMI_CFG(hpd_clk, 8x74),
 399                 .hpd_freq      = hpd_clk_freq_8x74,
 400 };
 401
 402 static const struct {
 403         const char *name;
 404         const bool output;
 405         const int value;
 406         const char *label;
 407 } msm_hdmi_gpio_pdata[] = {
 408         { "qcom,hdmi-tx-ddc-clk", true, 1, "HDMI_DDC_CLK" },
 409         { "qcom,hdmi-tx-ddc-data", true, 1, "HDMI_DDC_DATA" },
 410         { "qcom,hdmi-tx-hpd", false, 1, "HDMI_HPD" },
 411         { "qcom,hdmi-tx-mux-en", true, 1, "HDMI_MUX_EN" },
 412         { "qcom,hdmi-tx-mux-sel", true, 0, "HDMI_MUX_SEL" },
 413         { "qcom,hdmi-tx-mux-lpm", true, 1, "HDMI_MUX_LPM" },
 414 };
 415
 416 /*
 417  * HDMI audio codec callbacks
 418  */
 419 static int msm_hdmi_audio_hw_params(struct device *dev, void *data,
 420                                     struct hdmi_codec_daifmt *daifmt,
 421                                     struct hdmi_codec_params *params)
 422 {
 423         struct hdmi *hdmi = dev_get_drvdata(dev);
 424         unsigned int chan;
 425         unsigned int channel_allocation = 0;
 426         unsigned int rate;
 427         unsigned int level_shift  = 0; /* 0dB */
 428         bool down_mix = false;
 429
 430         DRM_DEV_DEBUG(dev, "%u Hz, %d bit, %d channels\n", params->sample_rate,
 431                  params->sample_width, params->cea.channels);
 432
 433         switch (params->cea.channels) {
 434         case 2:
 435                 /* FR and FL speakers */
 436                 channel_allocation  = 0;
 437                 chan = MSM_HDMI_AUDIO_CHANNEL_2;
 438                 break;
 439         case 4:
 440                 /* FC, LFE, FR and FL speakers */
 441                 channel_allocation  = 0x3;
 442                 chan = MSM_HDMI_AUDIO_CHANNEL_4;
 443                 break;
 444         case 6:
 445                 /* RR, RL, FC, LFE, FR and FL speakers */
 446                 channel_allocation  = 0x0B;
 447                 chan = MSM_HDMI_AUDIO_CHANNEL_6;
 448                 break;
 449         case 8:
 450                 /* FRC, FLC, RR, RL, FC, LFE, FR and FL speakers */
 451                 channel_allocation  = 0x1F;
 452                 chan = MSM_HDMI_AUDIO_CHANNEL_8;
 453                 break;
 454         default:
 455                 return -EINVAL;
 456         }
 457
 458         switch (params->sample_rate) {
 459         case 32000:
 460                 rate = HDMI_SAMPLE_RATE_32KHZ;
 461                 break;
 462         case 44100:
 463                 rate = HDMI_SAMPLE_RATE_44_1KHZ;
 464                 break;
 465         case 48000:
 466                 rate = HDMI_SAMPLE_RATE_48KHZ;
 467                 break;
 468         case 88200:
 469                 rate = HDMI_SAMPLE_RATE_88_2KHZ;
 470                 break;
 471         case 96000:
 472                 rate = HDMI_SAMPLE_RATE_96KHZ;
 473                 break;
 474         case 176400:
 475                 rate = HDMI_SAMPLE_RATE_176_4KHZ;
 476                 break;
 477         case 192000:
 478                 rate = HDMI_SAMPLE_RATE_192KHZ;
 479                 break;
 480         default:
 481                 DRM_DEV_ERROR(dev, "rate[%d] not supported!\n",
 482                         params->sample_rate);
 483                 return -EINVAL;
 484         }
 485
 486         msm_hdmi_audio_set_sample_rate(hdmi, rate);
 487         msm_hdmi_audio_info_setup(hdmi, 1, chan, channel_allocation,
 488                               level_shift, down_mix);
 489
 490         return 0;
 491 }
 492
 493 static void msm_hdmi_audio_shutdown(struct device *dev, void *data)
 494 {
 495         struct hdmi *hdmi = dev_get_drvdata(dev);
 496
 497         msm_hdmi_audio_info_setup(hdmi, 0, 0, 0, 0, 0);
 498 }
 499
 500 static const struct hdmi_codec_ops msm_hdmi_audio_codec_ops = {
 501         .hw_params = msm_hdmi_audio_hw_params,
 502         .audio_shutdown = msm_hdmi_audio_shutdown,
 503 };
 504
 505 static struct hdmi_codec_pdata codec_data = {
 506         .ops = &msm_hdmi_audio_codec_ops,
 507         .max_i2s_channels = 8,
 508         .i2s = 1,
 509 };
 510
 511 static int msm_hdmi_register_audio_driver(struct hdmi *hdmi, struct device *dev)
 512 {
 513         hdmi->audio_pdev = platform_device_register_data(dev,
 514                                                          HDMI_CODEC_DRV_NAME,
 515                                                          PLATFORM_DEVID_AUTO,
 516                                                          &codec_data,
 517                                                          sizeof(codec_data));
 518         return PTR_ERR_OR_ZERO(hdmi->audio_pdev);
 519 }
 520
 521 static int msm_hdmi_bind(struct device *dev, struct device *master, void *data)
 522 {
 523         struct msm_drm_private *priv = dev_get_drvdata(master);
 524         struct hdmi_platform_config *hdmi_cfg;
 525         struct hdmi *hdmi;
 526         struct device_node *of_node = dev->of_node;
 527         int i, err;
 528
 529         hdmi_cfg = (struct hdmi_platform_config *)
 530                         of_device_get_match_data(dev);
 531         if (!hdmi_cfg) {
 532                 DRM_DEV_ERROR(dev, "unknown hdmi_cfg: %pOFn\n", of_node);
 533                 return -ENXIO;
 534         }
 535
 536         hdmi_cfg->mmio_name     = "core_physical";
 537         hdmi_cfg->qfprom_mmio_name = "qfprom_physical";
 538
 539         for (i = 0; i < HDMI_MAX_NUM_GPIO; i++) {
 540                 const char *name = msm_hdmi_gpio_pdata[i].name;
 541                 struct gpio_desc *gpiod;
 542
 543                 /*
 544                  * We are fetching the GPIO lines "as is" since the connector
 545                  * code is enabling and disabling the lines. Until that point
 546                  * the power-on default value will be kept.
 547                  */
 548                 gpiod = devm_gpiod_get_optional(dev, name, GPIOD_ASIS);
 549                 /* This will catch e.g. -PROBE_DEFER */
 550                 if (IS_ERR(gpiod))
 551                         return PTR_ERR(gpiod);
 552                 if (!gpiod) {
 553                         /* Try a second time, stripping down the name */
 554                         char name3[32];
 555
 556                         /*
 557                          * Try again after stripping out the "qcom,hdmi-tx"
 558                          * prefix. This is mainly to match "hpd-gpios" used
 559                          * in the upstream bindings.
 560                          */
 561                         if (sscanf(name, "qcom,hdmi-tx-%s", name3))
 562                                 gpiod = devm_gpiod_get_optional(dev, name3, GPIOD_ASIS);
 563                         if (IS_ERR(gpiod))
 564                                 return PTR_ERR(gpiod);
 565                         if (!gpiod)
 566                                 DBG("failed to get gpio: %s", name);
 567                 }
 568                 hdmi_cfg->gpios[i].gpiod = gpiod;
 569                 if (gpiod)
 570                         gpiod_set_consumer_name(gpiod, msm_hdmi_gpio_pdata[i].label);
 571                 hdmi_cfg->gpios[i].output = msm_hdmi_gpio_pdata[i].output;
 572                 hdmi_cfg->gpios[i].value = msm_hdmi_gpio_pdata[i].value;
 573         }
 574
 575         dev->platform_data = hdmi_cfg;
 576
 577         hdmi = msm_hdmi_init(to_platform_device(dev));
 578         if (IS_ERR(hdmi))
 579                 return PTR_ERR(hdmi);
 580         priv->hdmi = hdmi;
 581
 582         err = msm_hdmi_register_audio_driver(hdmi, dev);
 583         if (err) {
 584                 DRM_ERROR("Failed to attach an audio codec %d\n", err);
 585                 hdmi->audio_pdev = NULL;
 586         }
 587
 588         return 0;
 589 }
 590
 591 static void msm_hdmi_unbind(struct device *dev, struct device *master,
 592                 void *data)
 593 {
 594         struct msm_drm_private *priv = dev_get_drvdata(master);
 595
 596         if (priv->hdmi) {
 597                 if (priv->hdmi->audio_pdev)
 598                         platform_device_unregister(priv->hdmi->audio_pdev);
 599
 600                 msm_hdmi_destroy(priv->hdmi);
 601                 priv->hdmi = NULL;
 602         }
 603 }
 604
 605 static const struct component_ops msm_hdmi_ops = {
 606                 .bind   = msm_hdmi_bind,
 607                 .unbind = msm_hdmi_unbind,
 608 };
 609
 610 static int msm_hdmi_dev_probe(struct platform_device *pdev)
 611 {
 612         return component_add(&pdev->dev, &msm_hdmi_ops);
 613 }
 614
 615 static int msm_hdmi_dev_remove(struct platform_device *pdev)
 616 {
 617         component_del(&pdev->dev, &msm_hdmi_ops);
 618         return 0;
 619 }
 620
 621 static const struct of_device_id msm_hdmi_dt_match[] = {
 622         { .compatible = "qcom,hdmi-tx-8996", .data = &hdmi_tx_8996_config },
 623         { .compatible = "qcom,hdmi-tx-8994", .data = &hdmi_tx_8994_config },
 624         { .compatible = "qcom,hdmi-tx-8084", .data = &hdmi_tx_8084_config },
 625         { .compatible = "qcom,hdmi-tx-8974", .data = &hdmi_tx_8974_config },
 626         { .compatible = "qcom,hdmi-tx-8960", .data = &hdmi_tx_8960_config },
 627         { .compatible = "qcom,hdmi-tx-8660", .data = &hdmi_tx_8660_config },
 628         {}
 629 };
 630
 631 static struct platform_driver msm_hdmi_driver = {
 632         .probe = msm_hdmi_dev_probe,
 633         .remove = msm_hdmi_dev_remove,
 634         .driver = {
 635                 .name = "hdmi_msm",
 636                 .of_match_table = msm_hdmi_dt_match,
 637         },
 638 };
 639
 640 void __init msm_hdmi_register(void)
 641 {
 642         msm_hdmi_phy_driver_register();
 643         platform_driver_register(&msm_hdmi_driver);
 644 }
 645
 646 void __exit msm_hdmi_unregister(void)
 647 {
 648         platform_driver_unregister(&msm_hdmi_driver);
 649         msm_hdmi_phy_driver_unregister();
 650 }